Ejemplo n.º 1
0
// Process a SCSI command
// input:
//   pdev - pointer to the USB device handle
//   lun - logical unit number
//   params - pointer to the buffer with command parameters
int8_t SCSI_ProcessCmd(USBD_HandleTypeDef *pdev, uint8_t lun, uint8_t *params) {
	switch (params[0]) {
		case SCSI_TEST_UNIT_READY:
			return SCSI_TestUnitReady(pdev,lun,params);
		case SCSI_REQUEST_SENSE:
			return SCSI_RequestSense(pdev,lun,params);
		case SCSI_INQUIRY:
			return SCSI_Inquiry(pdev,lun,params);
		case SCSI_START_STOP_UNIT:
			return SCSI_StartStopUnit(pdev,lun,params);
		case SCSI_ALLOW_MEDIUM_REMOVAL:
			return SCSI_StartStopUnit(pdev,lun,params);
		case SCSI_MODE_SENSE6:
			return SCSI_ModeSense6(pdev,lun,params);
		case SCSI_MODE_SENSE10:
			return SCSI_ModeSense10(pdev,lun,params);
		case SCSI_READ_FORMAT_CAPACITIES:
			return SCSI_ReadFormatCapacity(pdev,lun,params);
		case SCSI_READ_CAPACITY10:
			return SCSI_ReadCapacity10(pdev,lun,params);
		case SCSI_READ10:
			return SCSI_Read10(pdev,lun,params);
		case SCSI_WRITE10:
			return SCSI_Write10(pdev,lun,params);
		case SCSI_VERIFY10:
			return SCSI_Verify10(pdev,lun,params);
		default:
			SCSI_SenseCode(pdev,lun,ILLEGAL_REQUEST,INVALID_CDB);
			return -1;
	}
}
Ejemplo n.º 2
0
/**
* @brief  SCSI_ProcessCmd
*         Process SCSI commands
* @param  pdev: device instance
* @param  lun: Logical unit number
* @param  params: Command parameters
* @retval status
*/
int8_t SCSI_ProcessCmd(USBD_HandleTypeDef  *pdev,
                           uint8_t lun, 
                           uint8_t *params)
{
    /*
    if (params[0] != SCSI_READ10 && params[0] != SCSI_WRITE10) {
        printf("SCSI_ProcessCmd(lun=%d, params=%x, %x)\n", lun, params[0], params[1]);
    }
    */
  
  switch (params[0])
  {
  case SCSI_TEST_UNIT_READY:
    return SCSI_TestUnitReady(pdev, lun, params);
    
  case SCSI_REQUEST_SENSE:
    return SCSI_RequestSense (pdev, lun, params);
  case SCSI_INQUIRY:
    return SCSI_Inquiry(pdev, lun, params);
    
  case SCSI_START_STOP_UNIT:
    return SCSI_StartStopUnit(pdev, lun, params);
    
  case SCSI_ALLOW_MEDIUM_REMOVAL:
    return SCSI_AllowMediumRemoval(pdev, lun, params);
    
  case SCSI_MODE_SENSE6:
    return SCSI_ModeSense6 (pdev, lun, params);
    
  case SCSI_MODE_SENSE10:
    return SCSI_ModeSense10 (pdev, lun, params);
    
  case SCSI_SYNCHRONIZE_CACHE10:
  case SCSI_SYNCHRONIZE_CACHE16:
    return SCSI_SynchronizeCache(pdev, lun, params);

  case SCSI_READ_FORMAT_CAPACITIES:
    return SCSI_ReadFormatCapacity(pdev, lun, params);
    
  case SCSI_READ_CAPACITY10:
    return SCSI_ReadCapacity10(pdev, lun, params);
    
  case SCSI_READ10:
    return SCSI_Read10(pdev, lun, params); 
    
  case SCSI_WRITE10:
    return SCSI_Write10(pdev, lun, params);
    
  case SCSI_VERIFY10:
    return SCSI_Verify10(pdev, lun, params);
    
  default:
    SCSI_SenseCode(pdev, 
                   lun,
                   ILLEGAL_REQUEST, 
                   INVALID_CDB);    
    return -1;
  }
}
Ejemplo n.º 3
0
//----------------------------------------------
// function that processes any ACSI command
void ACSI_ProcessCommand(void)
{
unsigned char a,b,i;
char FromMaster;

//printf("\nCmd: %x %x %x %x %x %x", AcsiCmnd.cmd[0], AcsiCmnd.cmd[1], AcsiCmnd.cmd[2], AcsiCmnd.cmd[3], AcsiCmnd.cmd[4], AcsiCmnd.cmd[5]);
SetBit(ACSI_o,ACSI_INT); 					// INT to H

switch(AcsiCmnd.cmd[1] & 0xE0)		// check the device #
	{
	case 0x00:	FromMaster = 1; break; // device # 0
	case 0x20:	FromMaster = 0; break; // device # 1
	
	default:	SCSI_SK   = SCSI_E_IllegalRequest;		// other devices = error 
				SCSI_ASC  = SCSI_ASC_LU_NOT_SUPPORTED;
				SCSI_ASCQ = SCSI_ASCQ_LU_NOT_SUPPORTED;
			
				ACSI_SendStatus(ACSI_S_ERROR,1); 

				printf("\nError: bad device #: %x %x %x %x %x %x", AcsiCmnd.cmd[0], AcsiCmnd.cmd[1], AcsiCmnd.cmd[2], AcsiCmnd.cmd[3], AcsiCmnd.cmd[4], AcsiCmnd.cmd[5]);
				
				return; 
				break;	
	}

// now check that if the wanted drive is present
if((FromMaster && !Master.Present) || (!FromMaster && !Slave.Present))
	{
	SCSI_SK   = SCSI_E_IllegalRequest;	// the device # is invalid  
	SCSI_ASC  = SCSI_ASC_LU_NOT_SUPPORTED;
	SCSI_ASCQ = SCSI_ASCQ_LU_NOT_SUPPORTED;
	
	ACSI_SendStatus(ACSI_S_ERROR,FromMaster); 
/*
	printf("\nError: Device not present!");
	if(FromMaster)
		{
		if(Master.Present)
			printf("MP");
		else
			printf("MM");
		}	
	else
		{
		if(Slave.Present)
			printf("SP");
		else
			printf("SM");
		}		
*/		
	return;
	} 
//------------------------------------------
switch((AcsiCmnd.cmd[0] & 0x1f))			// get only the command part of byte
	{
	case ACSI_C_DriveReady	: if((FromMaster && Master.Ready) ||
		 					    (!FromMaster && Slave.Ready))
									{
									SCSI_SK   = SCSI_E_NoSense;
									SCSI_ASC  = SCSI_ASC_NO_ADDITIONAL_SENSE;
									SCSI_ASCQ = SCSI_ASCQ_NO_ADDITIONAL_SENSE;
				
									ACSI_SendStatus(ACSI_S_OK,FromMaster);									
									}
							  else
									{
									SCSI_SK   = SCSI_E_NotReady;	// drive not ready  
									SCSI_ASC  = SCSI_ASC_LU_NOT_READY;
									SCSI_ASCQ = SCSI_ASCQ_CAUSE_NOT_REPORTABLE;
		
									ACSI_SendStatus(ACSI_S_BUSY,FromMaster);									
									}

							  if(DEBUG_TXT)
							    printf("\nDr");
									
							  break;
	//----------------------------------------------------
 	case ACSI_C_RestoreTo0	: SCSI_SK   = SCSI_E_NoSense;	// no error
		 					  SCSI_ASC  = SCSI_ASC_NO_ADDITIONAL_SENSE;
							  SCSI_ASCQ = SCSI_ASCQ_NO_ADDITIONAL_SENSE;

		 					  ACSI_SendStatus(ACSI_S_OK,FromMaster); break;
							  
	case ACSI_C_RequestSense: if(AcsiCmnd.cmd[4]==4)				 // if 4 bytes wanted
			 					  ACSI_RequestSense(FromMaster);	 // ACSI RS
							  else
			 					  SCSI_RequestSense(FromMaster);	 // SCSI RS
							   		  
							  if(DEBUG_TXT)
							    printf("\nRs");
		 					  break;

	case ACSI_C_FormatDrive	: 
/*
							  ACSI_LastError = ACSI_E_InvalidCommand; 
		 					  SCSI_ASC  = SCSI_ASC_NO_ADDITIONAL_SENSE;
							  SCSI_ASCQ = SCSI_ASCQ_NO_ADDITIONAL_SENSE;
*/		
//							  printf("\nFmt");
							  
							  SCSI_SK   = SCSI_E_NoSense;	// no error
		 					  SCSI_ASC  = SCSI_ASC_NO_ADDITIONAL_SENSE;
							  SCSI_ASCQ = SCSI_ASCQ_NO_ADDITIONAL_SENSE;

							  ACSI_SendStatus(ACSI_S_OK,FromMaster); 
							  
							  if(FromMaster)		// set a flag that we should be formating
							  	 Master.DoFormat=1;
							  else
							  	 Slave.DoFormat=1;
							  	  
							  break;

	//----------------------------------------------------
	case ACSI_C_ReadSector	: 
		 					  a = IDE_ReadSector(FromMaster, AcsiCmnd.cmd[4], 0, 
		 					      (AcsiCmnd.cmd[1] & 0x1F), AcsiCmnd.cmd[2], AcsiCmnd.cmd[3]);

							  if(a==0)
							  	{
								printf("\nRok");
								
							    SCSI_SK   = SCSI_E_NoSense;	// no error
		 					  	SCSI_ASC  = SCSI_ASC_NO_ADDITIONAL_SENSE;
							  	SCSI_ASCQ = SCSI_ASCQ_NO_ADDITIONAL_SENSE;
							  
		 					  	ACSI_SendStatus(ACSI_S_OK,FromMaster);
								}
							  else
							  	{
								printf("\nRerr");
								
							    SCSI_SK   = SCSI_E_AbortedCommand;	
		 					  	SCSI_ASC  = SCSI_ASC_NO_ADDITIONAL_SENSE;
							  	SCSI_ASCQ = SCSI_ASCQ_NO_ADDITIONAL_SENSE;
							  
		 					  	ACSI_SendStatus(ACSI_S_ERROR,FromMaster);
								}

							  if(DEBUG_TXT)
							  	printf("\nR");

		 					  break;
	//----------------------------------------------------
	case ACSI_C_WriteSector	: 
//							  printf("\nWRITE: %x %x %x %x %x %x", AcsiCmnd.cmd[0], AcsiCmnd.cmd[1], AcsiCmnd.cmd[2], AcsiCmnd.cmd[3], AcsiCmnd.cmd[4], AcsiCmnd.cmd[5]);
		 					  a = IDE_WriteSector(FromMaster, AcsiCmnd.cmd[4], 0, 
		 					      (AcsiCmnd.cmd[1] & 0x1F), AcsiCmnd.cmd[2], AcsiCmnd.cmd[3]);

 							  if(a==0)
							  	{
								printf("\nWok");

							    SCSI_SK   = SCSI_E_NoSense;	// no error
		 					  	SCSI_ASC  = SCSI_ASC_NO_ADDITIONAL_SENSE;
							  	SCSI_ASCQ = SCSI_ASCQ_NO_ADDITIONAL_SENSE;
							  
		 					  	ACSI_SendStatus(ACSI_S_OK,FromMaster);
								}
							  else
							  	{
								printf("\nWerr");

							    SCSI_SK   = SCSI_E_AbortedCommand;	
		 					  	SCSI_ASC  = SCSI_ASC_NO_ADDITIONAL_SENSE;
							  	SCSI_ASCQ = SCSI_ASCQ_NO_ADDITIONAL_SENSE;
							  
		 					  	ACSI_SendStatus(ACSI_S_ERROR,FromMaster);
								}

							  if(DEBUG_TXT)
							     printf("\nW");

		 					  break;
	//----------------------------------------------------
	
	case ACSI_C_SeekBlock	: SCSI_SK   = SCSI_E_NoSense;	// no error
		 					  SCSI_ASC  = SCSI_ASC_NO_ADDITIONAL_SENSE;
							  SCSI_ASCQ = SCSI_ASCQ_NO_ADDITIONAL_SENSE;
	
		 					  ACSI_SendStatus(ACSI_S_OK,FromMaster); break;
							  
	case ACSI_C_ModeSelect	: ACSI_ModeSelect(FromMaster); 		  
							  if(DEBUG_TXT)
							  	 printf("\nMSl");
		 					  break;
	case ACSI_C_ModeSense	: a = ACSI_ModeSense(FromMaster);	
	
		 					  ACSI_SendStatus(a,FromMaster);
							  		  
							  if(DEBUG_TXT)
  							  	 printf("\nMSnc");
		 					  break;
	
	case SCSI_C_INQUIRY		: SCSI_Inquiry(FromMaster); 
							  if(DEBUG_TXT)
  							  	 printf("\nI");
		 					  break;
	
	default					: 
							  printf("\nUnkn: %x %x %x %x %x %x", AcsiCmnd.cmd[0], AcsiCmnd.cmd[1], AcsiCmnd.cmd[2], AcsiCmnd.cmd[3], AcsiCmnd.cmd[4], AcsiCmnd.cmd[5]);

							  SCSI_SK	= SCSI_E_IllegalRequest; 
							  SCSI_ASC  = SCSI_ASC_InvalidCommandOperationCode;
							  SCSI_ASCQ = SCSI_ASCQ_NO_ADDITIONAL_SENSE;

							  ACSI_SendStatus(ACSI_S_ERROR,FromMaster); 
							  
							  break;
	}
}