+/**\r
+ Internal helper notify function in which determine whether retry of a SCSI\r
+ Read/Write command is needed and signal the event passed from Block I/O(2) if\r
+ the SCSI I/O operation completes.\r
+\r
+ @param Event The instance of EFI_EVENT.\r
+ @param Context The parameter passed in.\r
+\r
+**/\r
+VOID\r
+EFIAPI\r
+ScsiDiskNotify (\r
+ IN EFI_EVENT Event,\r
+ IN VOID *Context\r
+ )\r
+{\r
+ EFI_STATUS Status;\r
+ SCSI_ASYNC_RW_REQUEST *Request;\r
+ SCSI_DISK_DEV *ScsiDiskDevice;\r
+ EFI_BLOCK_IO2_TOKEN *Token;\r
+ UINTN Action;\r
+ UINT32 OldDataLength;\r
+ UINT32 OldSectorCount;\r
+ UINT8 MaxRetry;\r
+\r
+ gBS->CloseEvent (Event);\r
+\r
+ Request = (SCSI_ASYNC_RW_REQUEST *) Context;\r
+ ScsiDiskDevice = Request->ScsiDiskDevice;\r
+ Token = Request->BlkIo2Req->Token;\r
+ OldDataLength = Request->DataLength;\r
+ OldSectorCount = Request->SectorCount;\r
+ MaxRetry = 2;\r
+\r
+ //\r
+ // If previous sub-tasks already fails, no need to process this sub-task.\r
+ //\r
+ if (Token->TransactionStatus != EFI_SUCCESS) {\r
+ goto Exit;\r
+ }\r
+\r
+ //\r
+ // Check HostAdapterStatus and TargetStatus\r
+ // (EFI_TIMEOUT, EFI_DEVICE_ERROR, EFI_WARN_BUFFER_TOO_SMALL)\r
+ //\r
+ Status = CheckHostAdapterStatus (Request->HostAdapterStatus);\r
+ if ((Status == EFI_TIMEOUT) || (Status == EFI_NOT_READY)) {\r
+ if (++Request->TimesRetry > MaxRetry) {\r
+ Token->TransactionStatus = EFI_DEVICE_ERROR;\r
+ goto Exit;\r
+ } else {\r
+ goto Retry;\r
+ }\r
+ } else if (Status == EFI_DEVICE_ERROR) {\r
+ //\r
+ // reset the scsi channel\r
+ //\r
+ ScsiDiskDevice->ScsiIo->ResetBus (ScsiDiskDevice->ScsiIo);\r
+ Token->TransactionStatus = EFI_DEVICE_ERROR;\r
+ goto Exit;\r
+ }\r
+\r
+ Status = CheckTargetStatus (Request->TargetStatus);\r
+ if (Status == EFI_NOT_READY) {\r
+ //\r
+ // reset the scsi device\r
+ //\r
+ ScsiDiskDevice->ScsiIo->ResetDevice (ScsiDiskDevice->ScsiIo);\r
+ if (++Request->TimesRetry > MaxRetry) {\r
+ Token->TransactionStatus = EFI_DEVICE_ERROR;\r
+ goto Exit;\r
+ } else {\r
+ goto Retry;\r
+ }\r
+ } else if (Status == EFI_DEVICE_ERROR) {\r
+ Token->TransactionStatus = EFI_DEVICE_ERROR;\r
+ goto Exit;\r
+ }\r
+\r
+ if (Request->TargetStatus == EFI_EXT_SCSI_STATUS_TARGET_CHECK_CONDITION) {\r
+ DEBUG ((EFI_D_ERROR, "ScsiDiskNotify: Check Condition happened!\n"));\r
+\r
+ Status = DetectMediaParsingSenseKeys (\r
+ ScsiDiskDevice,\r
+ Request->SenseData,\r
+ Request->SenseDataLength / sizeof (EFI_SCSI_SENSE_DATA),\r
+ &Action\r
+ );\r
+ if (Action == ACTION_RETRY_COMMAND_LATER) {\r
+ if (++Request->TimesRetry > MaxRetry) {\r
+ Token->TransactionStatus = EFI_DEVICE_ERROR;\r
+ goto Exit;\r
+ } else {\r
+ goto Retry;\r
+ }\r
+ } else if (Action == ACTION_RETRY_WITH_BACKOFF_ALGO) {\r
+ if (Request->SectorCount <= 1) {\r
+ //\r
+ // Jump out if the operation still fails with one sector transfer\r
+ // length.\r
+ //\r
+ Token->TransactionStatus = EFI_DEVICE_ERROR;\r
+ goto Exit;\r
+ }\r
+ //\r
+ // Try again with two half length request if the sense data shows we need\r
+ // to retry.\r
+ //\r
+ Request->SectorCount >>= 1;\r
+ Request->DataLength = Request->SectorCount * ScsiDiskDevice->BlkIo.Media->BlockSize;\r
+ Request->TimesRetry = 0;\r
+\r
+ goto Retry;\r
+ } else {\r
+ Token->TransactionStatus = EFI_DEVICE_ERROR;\r
+ goto Exit;\r
+ }\r
+ }\r
+\r
+ //\r
+ // This sub-task succeeds, no need to retry.\r
+ //\r
+ goto Exit;\r
+\r
+Retry:\r
+ if (Request->InBuffer != NULL) {\r
+ //\r
+ // SCSI read command\r
+ //\r
+ if (!ScsiDiskDevice->Cdb16Byte) {\r
+ Status = ScsiDiskAsyncRead10 (\r
+ ScsiDiskDevice,\r
+ Request->Timeout,\r
+ Request->InBuffer,\r
+ Request->DataLength,\r
+ (UINT32) Request->StartLba,\r
+ Request->SectorCount,\r
+ Request->BlkIo2Req,\r
+ Token\r
+ );\r
+ } else {\r
+ Status = ScsiDiskAsyncRead16 (\r
+ ScsiDiskDevice,\r
+ Request->Timeout,\r
+ Request->InBuffer,\r
+ Request->DataLength,\r
+ Request->StartLba,\r
+ Request->SectorCount,\r
+ Request->BlkIo2Req,\r
+ Token\r
+ );\r
+ }\r
+\r
+ if (EFI_ERROR (Status)) {\r
+ Token->TransactionStatus = EFI_DEVICE_ERROR;\r
+ goto Exit;\r
+ } else if (OldSectorCount != Request->SectorCount) {\r
+ //\r
+ // Original sub-task will be split into two new sub-tasks with smaller\r
+ // DataLength\r
+ //\r
+ if (!ScsiDiskDevice->Cdb16Byte) {\r
+ Status = ScsiDiskAsyncRead10 (\r
+ ScsiDiskDevice,\r
+ Request->Timeout,\r
+ Request->InBuffer + Request->SectorCount * ScsiDiskDevice->BlkIo.Media->BlockSize,\r
+ OldDataLength - Request->DataLength,\r
+ (UINT32) Request->StartLba + Request->SectorCount,\r
+ OldSectorCount - Request->SectorCount,\r
+ Request->BlkIo2Req,\r
+ Token\r
+ );\r
+ } else {\r
+ Status = ScsiDiskAsyncRead16 (\r
+ ScsiDiskDevice,\r
+ Request->Timeout,\r
+ Request->InBuffer + Request->SectorCount * ScsiDiskDevice->BlkIo.Media->BlockSize,\r
+ OldDataLength - Request->DataLength,\r
+ Request->StartLba + Request->SectorCount,\r
+ OldSectorCount - Request->SectorCount,\r
+ Request->BlkIo2Req,\r
+ Token\r
+ );\r
+ }\r
+ if (EFI_ERROR (Status)) {\r
+ Token->TransactionStatus = EFI_DEVICE_ERROR;\r
+ goto Exit;\r
+ }\r
+ }\r
+ } else {\r
+ //\r
+ // SCSI write command\r
+ //\r
+ if (!ScsiDiskDevice->Cdb16Byte) {\r
+ Status = ScsiDiskAsyncWrite10 (\r
+ ScsiDiskDevice,\r
+ Request->Timeout,\r
+ Request->OutBuffer,\r
+ Request->DataLength,\r
+ (UINT32) Request->StartLba,\r
+ Request->SectorCount,\r
+ Request->BlkIo2Req,\r
+ Token\r
+ );\r
+ } else {\r
+ Status = ScsiDiskAsyncWrite16 (\r
+ ScsiDiskDevice,\r
+ Request->Timeout,\r
+ Request->OutBuffer,\r
+ Request->DataLength,\r
+ Request->StartLba,\r
+ Request->SectorCount,\r
+ Request->BlkIo2Req,\r
+ Token\r
+ );\r
+ }\r
+\r
+ if (EFI_ERROR (Status)) {\r
+ Token->TransactionStatus = EFI_DEVICE_ERROR;\r
+ goto Exit;\r
+ } else if (OldSectorCount != Request->SectorCount) {\r
+ //\r
+ // Original sub-task will be split into two new sub-tasks with smaller\r
+ // DataLength\r
+ //\r
+ if (!ScsiDiskDevice->Cdb16Byte) {\r
+ Status = ScsiDiskAsyncWrite10 (\r
+ ScsiDiskDevice,\r
+ Request->Timeout,\r
+ Request->OutBuffer + Request->SectorCount * ScsiDiskDevice->BlkIo.Media->BlockSize,\r
+ OldDataLength - Request->DataLength,\r
+ (UINT32) Request->StartLba + Request->SectorCount,\r
+ OldSectorCount - Request->SectorCount,\r
+ Request->BlkIo2Req,\r
+ Token\r
+ );\r
+ } else {\r
+ Status = ScsiDiskAsyncWrite16 (\r
+ ScsiDiskDevice,\r
+ Request->Timeout,\r
+ Request->OutBuffer + Request->SectorCount * ScsiDiskDevice->BlkIo.Media->BlockSize,\r
+ OldDataLength - Request->DataLength,\r
+ Request->StartLba + Request->SectorCount,\r
+ OldSectorCount - Request->SectorCount,\r
+ Request->BlkIo2Req,\r
+ Token\r
+ );\r
+ }\r
+ if (EFI_ERROR (Status)) {\r
+ Token->TransactionStatus = EFI_DEVICE_ERROR;\r
+ goto Exit;\r
+ }\r
+ }\r
+ }\r
+\r
+Exit:\r
+ RemoveEntryList (&Request->Link);\r
+ if (IsListEmpty (&Request->BlkIo2Req->ScsiRWQueue)) {\r
+ //\r
+ // The last SCSI R/W command of a BlockIo2 request completes\r
+ //\r
+ RemoveEntryList (&Request->BlkIo2Req->Link);\r
+ FreePool (Request->BlkIo2Req); // Should be freed only once\r
+ gBS->SignalEvent (Token->Event);\r
+ }\r
+\r
+ FreePool (Request->SenseData);\r
+ FreePool (Request);\r
+}\r
+\r
+\r
+/**\r
+ Submit Async Read(10) command.\r
+\r
+ @param ScsiDiskDevice The pointer of ScsiDiskDevice.\r
+ @param Timeout The time to complete the command.\r
+ @param DataBuffer The buffer to fill with the read out data.\r
+ @param DataLength The length of buffer.\r
+ @param StartLba The start logic block address.\r
+ @param SectorCount The number of blocks to read.\r
+ @param BlkIo2Req The upstream BlockIo2 request.\r
+ @param Token The pointer to the token associated with the\r
+ non-blocking read request.\r
+\r
+ @retval EFI_OUT_OF_RESOURCES The request could not be completed due to a\r
+ lack of resources.\r
+ @return others Status returned by calling\r
+ ScsiRead10CommandEx().\r
+\r
+**/\r
+EFI_STATUS\r
+ScsiDiskAsyncRead10 (\r
+ IN SCSI_DISK_DEV *ScsiDiskDevice,\r
+ IN UINT64 Timeout,\r
+ OUT UINT8 *DataBuffer,\r
+ IN UINT32 DataLength,\r
+ IN UINT32 StartLba,\r
+ IN UINT32 SectorCount,\r
+ IN OUT SCSI_BLKIO2_REQUEST *BlkIo2Req,\r
+ IN EFI_BLOCK_IO2_TOKEN *Token\r
+ )\r
+{\r
+ EFI_STATUS Status;\r
+ SCSI_ASYNC_RW_REQUEST *Request;\r
+ EFI_EVENT AsyncIoEvent;\r
+\r
+ Request = AllocateZeroPool (sizeof (SCSI_ASYNC_RW_REQUEST));\r
+ if (Request == NULL) {\r
+ return EFI_OUT_OF_RESOURCES;\r
+ }\r
+ InsertTailList (&BlkIo2Req->ScsiRWQueue, &Request->Link);\r
+\r
+ Request->SenseDataLength = (UINT8) (6 * sizeof (EFI_SCSI_SENSE_DATA));\r
+ Request->SenseData = AllocateZeroPool (Request->SenseDataLength);\r
+ if (Request->SenseData == NULL) {\r
+ Status = EFI_OUT_OF_RESOURCES;\r
+ goto ErrorExit;\r
+ }\r
+\r
+ Request->ScsiDiskDevice = ScsiDiskDevice;\r
+ Request->Timeout = Timeout;\r
+ Request->InBuffer = DataBuffer;\r
+ Request->DataLength = DataLength;\r
+ Request->StartLba = StartLba;\r
+ Request->SectorCount = SectorCount;\r
+ Request->BlkIo2Req = BlkIo2Req;\r
+\r
+ //\r
+ // Create Event\r
+ //\r
+ Status = gBS->CreateEvent (\r
+ EVT_NOTIFY_SIGNAL,\r
+ TPL_CALLBACK,\r
+ ScsiDiskNotify,\r
+ Request,\r
+ &AsyncIoEvent\r
+ );\r
+ if (EFI_ERROR(Status)) {\r
+ goto ErrorExit;\r
+ }\r
+\r
+ Status = ScsiRead10CommandEx (\r
+ ScsiDiskDevice->ScsiIo,\r
+ Request->Timeout,\r
+ Request->SenseData,\r
+ &Request->SenseDataLength,\r
+ &Request->HostAdapterStatus,\r
+ &Request->TargetStatus,\r
+ Request->InBuffer,\r
+ &Request->DataLength,\r
+ (UINT32) Request->StartLba,\r
+ Request->SectorCount,\r
+ AsyncIoEvent\r
+ );\r
+ if (EFI_ERROR(Status)) {\r
+ goto ErrorExit;\r
+ }\r
+\r
+ return EFI_SUCCESS;\r
+\r
+ErrorExit:\r
+ if (Request != NULL) {\r
+ if (Request->SenseData != NULL) {\r
+ FreePool (Request->SenseData);\r
+ }\r
+\r
+ RemoveEntryList (&Request->Link);\r
+ FreePool (Request);\r
+ }\r
+\r
+ return Status;\r
+}\r
+\r
+\r
+/**\r
+ Submit Async Write(10) command.\r
+\r
+ @param ScsiDiskDevice The pointer of ScsiDiskDevice.\r
+ @param Timeout The time to complete the command.\r
+ @param DataBuffer The buffer contains the data to write.\r
+ @param DataLength The length of buffer.\r
+ @param StartLba The start logic block address.\r
+ @param SectorCount The number of blocks to write.\r
+ @param BlkIo2Req The upstream BlockIo2 request.\r
+ @param Token The pointer to the token associated with the\r
+ non-blocking read request.\r
+\r
+ @retval EFI_OUT_OF_RESOURCES The request could not be completed due to a\r
+ lack of resources.\r
+ @return others Status returned by calling\r
+ ScsiWrite10CommandEx().\r
+\r
+**/\r
+EFI_STATUS\r
+ScsiDiskAsyncWrite10 (\r
+ IN SCSI_DISK_DEV *ScsiDiskDevice,\r
+ IN UINT64 Timeout,\r
+ IN UINT8 *DataBuffer,\r
+ IN UINT32 DataLength,\r
+ IN UINT32 StartLba,\r
+ IN UINT32 SectorCount,\r
+ IN OUT SCSI_BLKIO2_REQUEST *BlkIo2Req,\r
+ IN EFI_BLOCK_IO2_TOKEN *Token\r
+ )\r
+{\r
+ EFI_STATUS Status;\r
+ SCSI_ASYNC_RW_REQUEST *Request;\r
+ EFI_EVENT AsyncIoEvent;\r
+\r
+ Request = AllocateZeroPool (sizeof (SCSI_ASYNC_RW_REQUEST));\r
+ if (Request == NULL) {\r
+ return EFI_OUT_OF_RESOURCES;\r
+ }\r
+ InsertTailList (&BlkIo2Req->ScsiRWQueue, &Request->Link);\r
+\r
+ Request->SenseDataLength = (UINT8) (6 * sizeof (EFI_SCSI_SENSE_DATA));\r
+ Request->SenseData = AllocateZeroPool (Request->SenseDataLength);\r
+ if (Request->SenseData == NULL) {\r
+ Status = EFI_OUT_OF_RESOURCES;\r
+ goto ErrorExit;\r
+ }\r
+\r
+ Request->ScsiDiskDevice = ScsiDiskDevice;\r
+ Request->Timeout = Timeout;\r
+ Request->OutBuffer = DataBuffer;\r
+ Request->DataLength = DataLength;\r
+ Request->StartLba = StartLba;\r
+ Request->SectorCount = SectorCount;\r
+ Request->BlkIo2Req = BlkIo2Req;\r
+\r
+ //\r
+ // Create Event\r
+ //\r
+ Status = gBS->CreateEvent (\r
+ EVT_NOTIFY_SIGNAL,\r
+ TPL_CALLBACK,\r
+ ScsiDiskNotify,\r
+ Request,\r
+ &AsyncIoEvent\r
+ );\r
+ if (EFI_ERROR(Status)) {\r
+ goto ErrorExit;\r
+ }\r
+\r
+ Status = ScsiWrite10CommandEx (\r
+ ScsiDiskDevice->ScsiIo,\r
+ Request->Timeout,\r
+ Request->SenseData,\r
+ &Request->SenseDataLength,\r
+ &Request->HostAdapterStatus,\r
+ &Request->TargetStatus,\r
+ Request->OutBuffer,\r
+ &Request->DataLength,\r
+ (UINT32) Request->StartLba,\r
+ Request->SectorCount,\r
+ AsyncIoEvent\r
+ );\r
+ if (EFI_ERROR(Status)) {\r
+ goto ErrorExit;\r
+ }\r
+\r
+ return EFI_SUCCESS;\r
+\r
+ErrorExit:\r
+ if (Request != NULL) {\r
+ if (Request->SenseData != NULL) {\r
+ FreePool (Request->SenseData);\r
+ }\r
+\r
+ RemoveEntryList (&Request->Link);\r
+ FreePool (Request);\r
+ }\r
+\r
+ return Status;\r
+}\r
+\r
+\r
+/**\r
+ Submit Async Read(16) command.\r
+\r
+ @param ScsiDiskDevice The pointer of ScsiDiskDevice.\r
+ @param Timeout The time to complete the command.\r
+ @param DataBuffer The buffer to fill with the read out data.\r
+ @param DataLength The length of buffer.\r
+ @param StartLba The start logic block address.\r
+ @param SectorCount The number of blocks to read.\r
+ @param BlkIo2Req The upstream BlockIo2 request.\r
+ @param Token The pointer to the token associated with the\r
+ non-blocking read request.\r
+\r
+ @retval EFI_OUT_OF_RESOURCES The request could not be completed due to a\r
+ lack of resources.\r
+ @return others Status returned by calling\r
+ ScsiRead16CommandEx().\r
+\r
+**/\r
+EFI_STATUS\r
+ScsiDiskAsyncRead16 (\r
+ IN SCSI_DISK_DEV *ScsiDiskDevice,\r
+ IN UINT64 Timeout,\r
+ OUT UINT8 *DataBuffer,\r
+ IN UINT32 DataLength,\r
+ IN UINT64 StartLba,\r
+ IN UINT32 SectorCount,\r
+ IN OUT SCSI_BLKIO2_REQUEST *BlkIo2Req,\r
+ IN EFI_BLOCK_IO2_TOKEN *Token\r
+ )\r
+{\r
+ EFI_STATUS Status;\r
+ SCSI_ASYNC_RW_REQUEST *Request;\r
+ EFI_EVENT AsyncIoEvent;\r
+\r
+ Request = AllocateZeroPool (sizeof (SCSI_ASYNC_RW_REQUEST));\r
+ if (Request == NULL) {\r
+ return EFI_OUT_OF_RESOURCES;\r
+ }\r
+ InsertTailList (&BlkIo2Req->ScsiRWQueue, &Request->Link);\r
+\r
+ Request->SenseDataLength = (UINT8) (6 * sizeof (EFI_SCSI_SENSE_DATA));\r
+ Request->SenseData = AllocateZeroPool (Request->SenseDataLength);\r
+ if (Request->SenseData == NULL) {\r
+ Status = EFI_OUT_OF_RESOURCES;\r
+ goto ErrorExit;\r
+ }\r
+\r
+ Request->ScsiDiskDevice = ScsiDiskDevice;\r
+ Request->Timeout = Timeout;\r
+ Request->InBuffer = DataBuffer;\r
+ Request->DataLength = DataLength;\r
+ Request->StartLba = StartLba;\r
+ Request->SectorCount = SectorCount;\r
+ Request->BlkIo2Req = BlkIo2Req;\r
+\r
+ //\r
+ // Create Event\r
+ //\r
+ Status = gBS->CreateEvent (\r
+ EVT_NOTIFY_SIGNAL,\r
+ TPL_CALLBACK,\r
+ ScsiDiskNotify,\r
+ Request,\r
+ &AsyncIoEvent\r
+ );\r
+ if (EFI_ERROR(Status)) {\r
+ goto ErrorExit;\r
+ }\r
+\r
+ Status = ScsiRead16CommandEx (\r
+ ScsiDiskDevice->ScsiIo,\r
+ Request->Timeout,\r
+ Request->SenseData,\r
+ &Request->SenseDataLength,\r
+ &Request->HostAdapterStatus,\r
+ &Request->TargetStatus,\r
+ Request->InBuffer,\r
+ &Request->DataLength,\r
+ Request->StartLba,\r
+ Request->SectorCount,\r
+ AsyncIoEvent\r
+ );\r
+ if (EFI_ERROR(Status)) {\r
+ goto ErrorExit;\r
+ }\r
+\r
+ return EFI_SUCCESS;\r
+\r
+ErrorExit:\r
+ if (Request != NULL) {\r
+ if (Request->SenseData != NULL) {\r
+ FreePool (Request->SenseData);\r
+ }\r
+\r
+ RemoveEntryList (&Request->Link);\r
+ FreePool (Request);\r
+ }\r
+\r
+ return Status;\r
+}\r
+\r
+\r
+/**\r
+ Submit Async Write(16) command.\r
+\r
+ @param ScsiDiskDevice The pointer of ScsiDiskDevice.\r
+ @param Timeout The time to complete the command.\r
+ @param DataBuffer The buffer contains the data to write.\r
+ @param DataLength The length of buffer.\r
+ @param StartLba The start logic block address.\r
+ @param SectorCount The number of blocks to write.\r
+ @param BlkIo2Req The upstream BlockIo2 request.\r
+ @param Token The pointer to the token associated with the\r
+ non-blocking read request.\r
+\r
+ @retval EFI_OUT_OF_RESOURCES The request could not be completed due to a\r
+ lack of resources.\r
+ @return others Status returned by calling\r
+ ScsiWrite16CommandEx().\r
+\r
+**/\r
+EFI_STATUS\r
+ScsiDiskAsyncWrite16 (\r
+ IN SCSI_DISK_DEV *ScsiDiskDevice,\r
+ IN UINT64 Timeout,\r
+ IN UINT8 *DataBuffer,\r
+ IN UINT32 DataLength,\r
+ IN UINT64 StartLba,\r
+ IN UINT32 SectorCount,\r
+ IN OUT SCSI_BLKIO2_REQUEST *BlkIo2Req,\r
+ IN EFI_BLOCK_IO2_TOKEN *Token\r
+ )\r
+{\r
+ EFI_STATUS Status;\r
+ SCSI_ASYNC_RW_REQUEST *Request;\r
+ EFI_EVENT AsyncIoEvent;\r
+\r
+ Request = AllocateZeroPool (sizeof (SCSI_ASYNC_RW_REQUEST));\r
+ if (Request == NULL) {\r
+ return EFI_OUT_OF_RESOURCES;\r
+ }\r
+ InsertTailList (&BlkIo2Req->ScsiRWQueue, &Request->Link);\r
+\r
+ Request->SenseDataLength = (UINT8) (6 * sizeof (EFI_SCSI_SENSE_DATA));\r
+ Request->SenseData = AllocateZeroPool (Request->SenseDataLength);\r
+ if (Request->SenseData == NULL) {\r
+ Status = EFI_OUT_OF_RESOURCES;\r
+ goto ErrorExit;\r
+ }\r
+\r
+ Request->ScsiDiskDevice = ScsiDiskDevice;\r
+ Request->Timeout = Timeout;\r
+ Request->OutBuffer = DataBuffer;\r
+ Request->DataLength = DataLength;\r
+ Request->StartLba = StartLba;\r
+ Request->SectorCount = SectorCount;\r
+ Request->BlkIo2Req = BlkIo2Req;\r
+\r
+ //\r
+ // Create Event\r
+ //\r
+ Status = gBS->CreateEvent (\r
+ EVT_NOTIFY_SIGNAL,\r
+ TPL_CALLBACK,\r
+ ScsiDiskNotify,\r
+ Request,\r
+ &AsyncIoEvent\r
+ );\r
+ if (EFI_ERROR(Status)) {\r
+ goto ErrorExit;\r
+ }\r
+\r
+ Status = ScsiWrite16CommandEx (\r
+ ScsiDiskDevice->ScsiIo,\r
+ Request->Timeout,\r
+ Request->SenseData,\r
+ &Request->SenseDataLength,\r
+ &Request->HostAdapterStatus,\r
+ &Request->TargetStatus,\r
+ Request->OutBuffer,\r
+ &Request->DataLength,\r
+ Request->StartLba,\r
+ Request->SectorCount,\r
+ AsyncIoEvent\r
+ );\r
+ if (EFI_ERROR(Status)) {\r
+ goto ErrorExit;\r
+ }\r
+\r
+ return EFI_SUCCESS;\r
+\r
+ErrorExit:\r
+ if (Request != NULL) {\r
+ if (Request->SenseData != NULL) {\r
+ FreePool (Request->SenseData);\r
+ }\r
+\r
+ RemoveEntryList (&Request->Link);\r
+ FreePool (Request);\r
+ }\r
+\r
+ return Status;\r
+}\r
+\r
+\r