📄 usbmpc5200sffdevlib.c
字号:
pBulkDev->bulkCbw.CBD[6] = 0x0;
pBulkDev->bulkCbw.CBD[7] = 0x0;
pBulkDev->bulkCbw.CBD[8] = 0x0;
pBulkDev->bulkCbw.CBD[9] = 0x0;
pBulkDev->bulkCbw.CBD[10] = 0x0;
pBulkDev->bulkCbw.CBD[11] = 0x0;
break;
case USB_SFF_FORMAT_UNIT: /* Format Unit command */
/* issue a FORMAT UNIT command with default parameters */
pBulkDev->bulkCbw.dataXferLength = 0;
pBulkDev->bulkCbw.direction = USB_SFF_CBW_DIR_NONE;
pBulkDev->bulkCbw.length = 0x0C;
pBulkDev->bulkCbw.CBD[0] = USB_SFF_FORMAT_UNIT;
pBulkDev->bulkCbw.CBD[1] = 0x0;
pBulkDev->bulkCbw.CBD[2] = 0x0;
pBulkDev->bulkCbw.CBD[3] = 0x0;
pBulkDev->bulkCbw.CBD[4] = 0x0;
pBulkDev->bulkCbw.CBD[5] = 0x0;
pBulkDev->bulkCbw.CBD[6] = 0x0;
pBulkDev->bulkCbw.CBD[7] = 0x0;
pBulkDev->bulkCbw.CBD[8] = 0x0;
pBulkDev->bulkCbw.CBD[9] = 0x0;
pBulkDev->bulkCbw.CBD[10] = 0x0;
pBulkDev->bulkCbw.CBD[11] = 0x0;
break;
case USB_SFF_READ_CAPACITY: /* Read capacity command */
/*
* Provides a means to request information regarding the capacity
* of the logical unit. The response will consists of number of
* logical blocks present and the size of the block.
*/
pBulkDev->bulkCbw.dataXferLength =
USB_SFF_BULK_SWAP_32(USB_SFF_READ_CAP_LEN);
pBulkDev->bulkCbw.direction = USB_SFF_CBW_DIR_IN;
pBulkDev->bulkCbw.length = 0x0C;
pBulkDev->bulkCbw.CBD[0] = USB_SFF_READ_CAPACITY;
pBulkDev->bulkCbw.CBD[1] = 0x0;
pBulkDev->bulkCbw.CBD[2] = 0x0;
pBulkDev->bulkCbw.CBD[3] = 0x0;
pBulkDev->bulkCbw.CBD[4] = 0x0;
pBulkDev->bulkCbw.CBD[5] = 0x0;
pBulkDev->bulkCbw.CBD[6] = 0x0;
pBulkDev->bulkCbw.CBD[7] = 0x0;
pBulkDev->bulkCbw.CBD[8] = 0x0;
pBulkDev->bulkCbw.CBD[9] = 0x0;
pBulkDev->bulkCbw.CBD[10] = 0x0;
pBulkDev->bulkCbw.CBD[11] = 0x0;
break;
case USB_SFF_PREVENT_REMOVAL: /* Prevent media removal command */
/* Applicable only for removable media. Disables removal of media */
if (pBulkDev->blkDev.bd_removable != TRUE)
{
status = ERROR;
break;
}
pBulkDev->bulkCbw.dataXferLength = 0;
pBulkDev->bulkCbw.direction = USB_SFF_CBW_DIR_NONE;
pBulkDev->bulkCbw.length = 0x0C;
pBulkDev->bulkCbw.CBD[0] = USB_SFF_PREVENT_REMOVAL;
pBulkDev->bulkCbw.CBD[1] = 0x0;
pBulkDev->bulkCbw.CBD[2] = 0x0;
pBulkDev->bulkCbw.CBD[3] = 0x0;
pBulkDev->bulkCbw.CBD[4] = 0x0;
pBulkDev->bulkCbw.CBD[5] = 0x0;
pBulkDev->bulkCbw.CBD[6] = 0x0;
pBulkDev->bulkCbw.CBD[7] = 0x0;
pBulkDev->bulkCbw.CBD[8] = 0x0;
pBulkDev->bulkCbw.CBD[9] = 0x0;
pBulkDev->bulkCbw.CBD[10] = 0x0;
pBulkDev->bulkCbw.CBD[11] = 0x0;
break;
default:
status= ERROR;
}
return (status);
}
LOCAL USB_COMMAND_STATUS usbSFFBulkCmdExecute
(
pUSB_SFF_BULK_DEV pBulkDev /* pointer to bulk device */
)
{
pUSB_SFF_BULK_CSW pCsw ;
if ( pBulkDev->connected == FALSE )
return (USB_INTERNAL_ERROR);
if ( OSS_SEM_TAKE (sffbulkIrpSem, usbSFFBulkIrpTimeOut + 1000) == ERROR )
{
USB_SFF_BULK_DEBUG ("usbSFFBulkCmdExecute: Irp in Use \n", 0, 0, 0, 0, 0, 0);
return (USB_INTERNAL_ERROR);
}
/* Form an IRP to submit the command block on BULK OUT pipe */
memset (&(pBulkDev->outIrp), 0, sizeof (USB_IRP));
pBulkDev->outIrp.irpLen = sizeof (USB_IRP);
pBulkDev->outIrp.userCallback = usbSFFBulkIrpCallback;
pBulkDev->outIrp.timeout = usbSFFBulkIrpTimeOut;
pBulkDev->outIrp.transferLen = USB_SFF_CBW_LENGTH;
pBulkDev->outIrp.bfrCount = 0x01;
pBulkDev->outIrp.bfrList[0].pid = USB_PID_OUT;
pBulkDev->outIrp.bfrList[0].pBfr = (UINT8 *)&(pBulkDev->bulkCbw);
pBulkDev->outIrp.bfrList[0].bfrLen = USB_SFF_CBW_LENGTH;
pBulkDev->outIrp.userPtr = pBulkDev;
/* Submit IRP */
if (usbdTransfer (usbdSFFHandle,
pBulkDev->outPipeHandle,
&(pBulkDev->outIrp))
!= OK)
{
USB_SFF_BULK_ERR ("usbSFFBulkCmdExecute: Unable to submit CBW IRP for transfer\n",
0, 0, 0, 0, 0, 0);
return (USB_INTERNAL_ERROR);
}
/* Wait till the transfer of IRP completes or time out */
if ( OSS_SEM_TAKE (sffbulkIrpSem,
usbSFFBulkIrpTimeOut + USB_SFF_BULK_OFFS)
== ERROR )
{
USB_SFF_BULK_DEBUG ("usbSFFBulkCmdExecute: Irp Time out \n", 0, 0, 0, 0, 0, 0);
OSS_SEM_GIVE (sffbulkIrpSem);
return (USB_INTERNAL_ERROR);
}
if (pBulkDev->outIrp.result == S_usbHcdLib_STALLED)
{
usbSFFBulkDevResetRecovery (pBulkDev);
OSS_SEM_GIVE (sffbulkIrpSem);
return (USB_BULK_IO_ERROR);
}
/*
* Check whether any data is to be transferred to/from the device.
* If yes, form an IRP and submit it.
*/
if (pBulkDev->bulkCbw.dataXferLength > 0)
{
if (pBulkDev->bulkCbw.direction == USB_SFF_CBW_DIR_IN)
{
/* data is expected from the device. read from BULK_IN pipe */
memset (&(pBulkDev->inIrp), 0, sizeof (USB_IRP));
/* form an IRP to read from BULK_IN pipe */
pBulkDev->inIrp.irpLen = sizeof(USB_IRP);
pBulkDev->inIrp.userCallback = usbSFFBulkIrpCallback;
pBulkDev->inIrp.timeout = usbSFFBulkIrpTimeOut;
pBulkDev->inIrp.transferLen = USB_SFF_BULK_SWAP_32(
pBulkDev->bulkCbw.dataXferLength);
pBulkDev->inIrp.bfrCount = 0x01;
pBulkDev->inIrp.bfrList[0].pid = USB_PID_IN;
pBulkDev->inIrp.bfrList[0].pBfr = pBulkDev->bulkInData;
pBulkDev->inIrp.bfrList[0].bfrLen = USB_SFF_BULK_SWAP_32(
pBulkDev->bulkCbw.dataXferLength);
pBulkDev->inIrp.userPtr = pBulkDev;
/* Submit IRP */
if (usbdTransfer (usbdSFFHandle,
pBulkDev->inPipeHandle,
&(pBulkDev->inIrp))
!= OK)
{
USB_SFF_BULK_ERR ("usbSFFBulkCmdExecute: Unable to submit IRP for "\
"BULK_IN data transfer\n", 0, 0, 0, 0, 0, 0);
OSS_SEM_GIVE (sffbulkIrpSem);
return (USB_INTERNAL_ERROR);
}
/*
* wait till the data transfer ends on the bulk in pipe, before
* reading the command status
*/
if ( OSS_SEM_TAKE (sffbulkIrpSem,
usbSFFBulkIrpTimeOut + USB_SFF_BULK_OFFS) == ERROR )
{
USB_SFF_BULK_DEBUG ("usbSFFBulkCmdExecute: Irp time out \n",
0, 0, 0, 0, 0, 0);
OSS_SEM_GIVE (sffbulkIrpSem);
return (USB_INTERNAL_ERROR);
}
}
else
{
/* device is expecting data over BULK_OUT pipe. send it */
memset (&pBulkDev->outIrp, 0, sizeof (USB_IRP));
/* form an IRP to write to BULK_OUT pipe */
pBulkDev->outIrp.irpLen = sizeof(USB_IRP);
pBulkDev->outIrp.userCallback = usbSFFBulkIrpCallback;
pBulkDev->outIrp.timeout = usbSFFBulkIrpTimeOut;
pBulkDev->outIrp.transferLen = USB_SFF_BULK_SWAP_32(
pBulkDev->bulkCbw.dataXferLength);
pBulkDev->outIrp.bfrCount = 0x01;
pBulkDev->outIrp.bfrList[0].pid = USB_PID_OUT;
pBulkDev->outIrp.bfrList[0].pBfr = pBulkDev->bulkOutData;
pBulkDev->outIrp.bfrList[0].bfrLen = USB_SFF_BULK_SWAP_32(
pBulkDev->bulkCbw.dataXferLength);
pBulkDev->outIrp.userPtr = pBulkDev;
/* Submit IRP */
if (usbdTransfer (usbdSFFHandle, pBulkDev->outPipeHandle,
&(pBulkDev->outIrp)) != OK)
{
USB_SFF_BULK_ERR ("usbSFFBulkCmdExecute: Unable to submit IRP for "\
"BULK_OUT data transfer\n", 0, 0, 0, 0, 0, 0);
OSS_SEM_GIVE (sffbulkIrpSem);
return (USB_INTERNAL_ERROR);
}
/*
* wait till the data transfer ends on bulk out pipe before reading
* the command status
*/
if ( OSS_SEM_TAKE (sffbulkIrpSem,
usbSFFBulkIrpTimeOut + USB_SFF_BULK_OFFS) == ERROR )
{
USB_SFF_BULK_DEBUG ("usbSFFBulkCmdExecute: Irp time out \n",
0, 0, 0, 0, 0, 0);
OSS_SEM_GIVE (sffbulkIrpSem);
return (USB_INTERNAL_ERROR);
}
}
}
/* read the command status from the device. */
memset (&pBulkDev->statusIrp, 0, sizeof (USB_IRP));
/* Form an IRP to read the CSW from the BULK_IN pipe */
pBulkDev->statusIrp.irpLen = sizeof( USB_IRP );
pBulkDev->statusIrp.userCallback = usbSFFBulkIrpCallback;
pBulkDev->statusIrp.timeout = usbSFFBulkIrpTimeOut;
pBulkDev->statusIrp.transferLen = USB_SFF_CSW_LENGTH;
pBulkDev->statusIrp.bfrCount = 0x01;
pBulkDev->statusIrp.bfrList[0].pid = USB_PID_IN;
pBulkDev->statusIrp.bfrList[0].pBfr = (UINT8 *)(&pBulkDev->bulkCsw);
pBulkDev->statusIrp.bfrList[0].bfrLen = USB_SFF_CSW_LENGTH;
pBulkDev->statusIrp.userPtr = pBulkDev;
/* Submit IRP */
if (usbdTransfer (usbdSFFHandle,
pBulkDev->inPipeHandle,
&pBulkDev->statusIrp)
!= OK)
{
USB_SFF_BULK_ERR ("usbSFFBulkCmdExecute: Unable to submit Status IRP\n",
0, 0, 0, 0, 0, 0);
OSS_SEM_GIVE (sffbulkIrpSem);
return (USB_INTERNAL_ERROR);
}
if ( OSS_SEM_TAKE (sffbulkIrpSem,
usbSFFBulkIrpTimeOut + USB_SFF_BULK_OFFS)
== ERROR )
{
USB_SFF_BULK_DEBUG ("usbSFFBulkCmdExecute: Irp time out \n",
0, 0, 0, 0, 0, 0);
OSS_SEM_GIVE (sffbulkIrpSem);
return (USB_INTERNAL_ERROR);
}
/* Check whether status IRP was transferred */
if (pBulkDev->statusIrp.result == S_usbHcdLib_STALLED) /* if stalled */
{
/* Clear STALL on the BULK IN endpoint */
if ((usbdFeatureClear (usbdSFFHandle,
pBulkDev->bulkDevId,
USB_RT_ENDPOINT,
USB_FSEL_DEV_ENDPOINT_HALT,
(pBulkDev->inEpAddress & 0x7F)))
!= OK)
{
USB_SFF_BULK_ERR ("usbSFFBulkCmdExecute: Failed to clear HALT feauture "\
"on bulk in Endpoint %x\n", 0, 0, 0, 0, 0, 0);
}
/* Try to read the CSW once again */
if (usbdTransfer (usbdSFFHandle,
pBulkDev->inPipeHandle,
&pBulkDev->statusIrp)
!= OK)
{
USB_SFF_BULK_ERR ("usbSFFBulkCmdExecute: Unable to submit Status IRP\n",
0, 0, 0, 0, 0, 0);
OSS_SEM_GIVE (sffbulkIrpSem);
return (USB_INTERNAL_ERROR);
}
if ( OSS_SEM_TAKE (sffbulkIrpSem,
usbSFFBulkIrpTimeOut + USB_SFF_BULK_OFFS)
== ERROR )
{
USB_SFF_BULK_DEBUG ("usbSFFBulkCmdExecute: Irp time out \n",
0, 0, 0, 0, 0, 0);
OSS_SEM_GIVE (sffbulkIrpSem);
return (USB_INTERNAL_ERROR);
}
/* how about the status this time */
if (pBulkDev->statusIrp.result == S_usbHcdLib_STALLED)
{
/* Failed to read CSW again. Do reset recovery */
OSS_SEM_GIVE (sffbulkIrpSem);
usbSFFBulkDevResetRecovery (pBulkDev);
return (USB_BULK_IO_ERROR);
}
}
OSS_SEM_GIVE (sffbulkIrpSem);
/* If any error other than STALL on Endpoint. */
if ( pBulkDev->statusIrp.result != OK )
{
return (USB_IRP_FAILED);
}
/* If successful in transferring the CSW IRP, check the buffer */
pCsw = (pUSB_SFF_BULK_CSW)(pBulkDev->statusIrp.bfrList[0].pBfr);
/* Check the length of CSW received. If not USB_SFF_CSW_LENGTH, invalid CSW. */
if ( pBulkDev->statusIrp.bfrList[0].actLen != USB_SFF_CSW_LENGTH)
{
USB_SFF_BULK_ERR ("usbSFFBulkCmdExecute: Invalid CSW\n", 0, 0, 0, 0, 0, 0);
usbSFFBulkDevResetRecovery (pBulkDev);
return (USB_INVALID_CSW);
}
/* check the signature/tag/status in command status block */
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -