2 * PROJECT: ReactOS Universal Serial Bus Bulk Storage Driver
3 * LICENSE: GPL - See COPYING in the top level directory
4 * FILE: drivers/usb/usbstor/error.c
5 * PURPOSE: USB block storage device driver.
8 * Michael Martin (michael.martin@reactos.org)
9 * Johannes Anderwald (johannes.anderwald@reactos.org)
15 USBSTOR_GetEndpointStatus(
16 IN PDEVICE_OBJECT DeviceObject
,
17 IN UCHAR bEndpointAddress
,
26 DPRINT("Allocating URB\n");
27 Urb
= (PURB
)AllocateItem(NonPagedPool
, sizeof(struct _URB_CONTROL_VENDOR_OR_CLASS_REQUEST
));
33 DPRINT1("OutofMemory!\n");
34 return STATUS_INSUFFICIENT_RESOURCES
;
40 UsbBuildGetStatusRequest(Urb
, URB_FUNCTION_GET_STATUS_FROM_ENDPOINT
, bEndpointAddress
& 0x0F, Value
, NULL
, NULL
);
45 DPRINT1("Sending Request DeviceObject %p, Urb %p\n", DeviceObject
, Urb
);
46 Status
= USBSTOR_SyncUrbRequest(DeviceObject
, Urb
);
62 USBSTOR_ResetPipeWithHandle(
63 IN PDEVICE_OBJECT DeviceObject
,
64 IN USBD_PIPE_HANDLE PipeHandle
)
72 DPRINT("Allocating URB\n");
73 Urb
= (PURB
)AllocateItem(NonPagedPool
, sizeof(struct _URB_PIPE_REQUEST
));
79 DPRINT1("OutofMemory!\n");
80 return STATUS_INSUFFICIENT_RESOURCES
;
86 Urb
->UrbPipeRequest
.Hdr
.Length
= sizeof(struct _URB_PIPE_REQUEST
);
87 Urb
->UrbPipeRequest
.Hdr
.Function
= URB_FUNCTION_SYNC_RESET_PIPE_AND_CLEAR_STALL
;
88 Urb
->UrbPipeRequest
.PipeHandle
= PipeHandle
;
93 DPRINT1("Sending Request DeviceObject %p, Urb %p\n", DeviceObject
, Urb
);
94 Status
= USBSTOR_SyncUrbRequest(DeviceObject
, Urb
);
109 USBSTOR_HandleTransferError(
110 PDEVICE_OBJECT DeviceObject
,
111 PIRP_CONTEXT Context
)
113 NTSTATUS Status
= STATUS_SUCCESS
;
114 PIO_STACK_LOCATION Stack
;
115 PSCSI_REQUEST_BLOCK Request
;
122 ASSERT(Context
->PDODeviceExtension
);
123 ASSERT(Context
->PDODeviceExtension
->Self
);
124 ASSERT(Context
->Irp
);
127 // first perform a mass storage reset step 1 in 5.3.4 USB Mass Storage Bulk Only Specification
129 Status
= USBSTOR_ResetDevice(Context
->FDODeviceExtension
->LowerDeviceObject
, Context
->FDODeviceExtension
);
130 if (NT_SUCCESS(Status
))
133 // step 2 reset bulk in pipe section 5.3.4
135 Status
= USBSTOR_ResetPipeWithHandle(Context
->FDODeviceExtension
->LowerDeviceObject
, Context
->FDODeviceExtension
->InterfaceInformation
->Pipes
[Context
->FDODeviceExtension
->BulkInPipeIndex
].PipeHandle
);
136 if (NT_SUCCESS(Status
))
139 // finally reset bulk out pipe
141 Status
= USBSTOR_ResetPipeWithHandle(Context
->FDODeviceExtension
->LowerDeviceObject
, Context
->FDODeviceExtension
->InterfaceInformation
->Pipes
[Context
->FDODeviceExtension
->BulkOutPipeIndex
].PipeHandle
);
146 // get next stack location
148 Stack
= IoGetCurrentIrpStackLocation(Context
->Irp
);
153 Request
= (PSCSI_REQUEST_BLOCK
)Stack
->Parameters
.Others
.Argument1
;
157 // obtain request type
159 pCDB
= (PCDB
)Request
->Cdb
;
162 if (Status
!= STATUS_SUCCESS
|| Context
->RetryCount
>= 1)
165 // Complete the master IRP
167 Context
->Irp
->IoStatus
.Status
= Status
;
168 Context
->Irp
->IoStatus
.Information
= 0;
169 USBSTOR_QueueTerminateRequest(Context
->PDODeviceExtension
->LowerDeviceObject
, Context
->Irp
);
170 IoCompleteRequest(Context
->Irp
, IO_NO_INCREMENT
);
173 // Start the next request
175 USBSTOR_QueueNextRequest(Context
->PDODeviceExtension
->LowerDeviceObject
);
178 // srb handling finished
180 Context
->FDODeviceExtension
->SrbErrorHandlingActive
= FALSE
;
185 Context
->FDODeviceExtension
->LastTimerActiveSrb
= NULL
;
189 DPRINT1("Retrying Count %lu %p\n", Context
->RetryCount
, Context
->PDODeviceExtension
->Self
);
192 // re-schedule request
194 USBSTOR_HandleExecuteSCSI(Context
->PDODeviceExtension
->Self
, Context
->Irp
, Context
->RetryCount
+ 1);
197 // srb error handling finished
199 Context
->FDODeviceExtension
->SrbErrorHandlingActive
= FALSE
;
202 // srb error handling finished
204 Context
->FDODeviceExtension
->TimerWorkQueueEnabled
= TRUE
;
209 Context
->FDODeviceExtension
->LastTimerActiveSrb
= NULL
;
213 // cleanup irp context
215 FreeItem(Context
->cbw
);
219 DPRINT1("USBSTOR_HandleTransferError returning with Status %x\n", Status
);
225 USBSTOR_ResetHandlerWorkItemRoutine(
229 PERRORHANDLER_WORKITEM_DATA WorkItemData
= (PERRORHANDLER_WORKITEM_DATA
)Context
;
232 // clear stall on BulkIn pipe
234 Status
= USBSTOR_ResetPipeWithHandle(WorkItemData
->Context
->FDODeviceExtension
->LowerDeviceObject
, WorkItemData
->Context
->FDODeviceExtension
->InterfaceInformation
->Pipes
[WorkItemData
->Context
->FDODeviceExtension
->BulkInPipeIndex
].PipeHandle
);
235 DPRINT1("USBSTOR_ResetPipeWithHandle Status %x\n", Status
);
238 // now resend the csw as the stall got cleared
240 USBSTOR_SendCSW(WorkItemData
->Context
, WorkItemData
->Irp
);
245 ErrorHandlerWorkItemRoutine(
248 PERRORHANDLER_WORKITEM_DATA WorkItemData
= (PERRORHANDLER_WORKITEM_DATA
)Context
;
250 if (WorkItemData
->Context
->ErrorIndex
== 2)
255 USBSTOR_HandleTransferError(WorkItemData
->DeviceObject
, WorkItemData
->Context
);
262 USBSTOR_ResetHandlerWorkItemRoutine(WorkItemData
);
266 // Free Work Item Data
268 ExFreePool(WorkItemData
);
273 USBSTOR_TimerWorkerRoutine(
276 PFDO_DEVICE_EXTENSION FDODeviceExtension
;
278 PERRORHANDLER_WORKITEM_DATA WorkItemData
= (PERRORHANDLER_WORKITEM_DATA
)Context
;
281 // get device extension
283 FDODeviceExtension
= (PFDO_DEVICE_EXTENSION
)WorkItemData
->DeviceObject
->DeviceExtension
;
284 ASSERT(FDODeviceExtension
->Common
.IsFDO
);
287 // first perform a mass storage reset step 1 in 5.3.4 USB Mass Storage Bulk Only Specification
289 Status
= USBSTOR_ResetDevice(FDODeviceExtension
->LowerDeviceObject
, FDODeviceExtension
);
290 if (NT_SUCCESS(Status
))
293 // step 2 reset bulk in pipe section 5.3.4
295 Status
= USBSTOR_ResetPipeWithHandle(FDODeviceExtension
->LowerDeviceObject
, FDODeviceExtension
->InterfaceInformation
->Pipes
[FDODeviceExtension
->BulkInPipeIndex
].PipeHandle
);
296 if (NT_SUCCESS(Status
))
299 // finally reset bulk out pipe
301 Status
= USBSTOR_ResetPipeWithHandle(FDODeviceExtension
->LowerDeviceObject
, FDODeviceExtension
->InterfaceInformation
->Pipes
[FDODeviceExtension
->BulkOutPipeIndex
].PipeHandle
);
304 DPRINT1("Status %x\n", Status
);
309 FDODeviceExtension
->LastTimerActiveSrb
= NULL
;
312 // re-schedule request
314 //USBSTOR_HandleExecuteSCSI(WorkItemData->Context->PDODeviceExtension->Self, WorkItemData->Context->Irp, Context->RetryCount + 1);
319 // do not retry for the same packet again
321 FDODeviceExtension
->TimerWorkQueueEnabled
= FALSE
;
324 // Free Work Item Data
326 ExFreePool(WorkItemData
);
332 USBSTOR_TimerRoutine(
333 PDEVICE_OBJECT DeviceObject
,
336 PFDO_DEVICE_EXTENSION FDODeviceExtension
;
337 BOOLEAN ResetDevice
= FALSE
;
338 PERRORHANDLER_WORKITEM_DATA WorkItemData
;
341 // get device extension
343 FDODeviceExtension
= (PFDO_DEVICE_EXTENSION
)Context
;
344 DPRINT1("[USBSTOR] TimerRoutine entered\n");
345 DPRINT1("[USBSTOR] ActiveSrb %p ResetInProgress %x LastTimerActiveSrb %p\n", FDODeviceExtension
->ActiveSrb
, FDODeviceExtension
->ResetInProgress
, FDODeviceExtension
->LastTimerActiveSrb
);
350 KeAcquireSpinLockAtDpcLevel(&FDODeviceExtension
->IrpListLock
);
353 // is there an active srb and no global reset is in progress
355 if (FDODeviceExtension
->ActiveSrb
&& FDODeviceExtension
->ResetInProgress
== FALSE
&& FDODeviceExtension
->TimerWorkQueueEnabled
)
357 if (FDODeviceExtension
->LastTimerActiveSrb
!= NULL
&& FDODeviceExtension
->LastTimerActiveSrb
== FDODeviceExtension
->ActiveSrb
)
362 DPRINT1("[USBSTOR] ActiveSrb %p hang detected\n", FDODeviceExtension
->ActiveSrb
);
370 FDODeviceExtension
->LastTimerActiveSrb
= FDODeviceExtension
->ActiveSrb
;
378 FDODeviceExtension
->LastTimerActiveSrb
= NULL
;
384 KeReleaseSpinLockFromDpcLevel(&FDODeviceExtension
->IrpListLock
);
387 if (ResetDevice
&& FDODeviceExtension
->TimerWorkQueueEnabled
&& FDODeviceExtension
->SrbErrorHandlingActive
== FALSE
)
389 WorkItemData
= (PERRORHANDLER_WORKITEM_DATA
)ExAllocatePool(NonPagedPool
, sizeof(ERRORHANDLER_WORKITEM_DATA
));
393 // Initialize and queue the work item to handle the error
395 ExInitializeWorkItem(&WorkItemData
->WorkQueueItem
,
396 USBSTOR_TimerWorkerRoutine
,
399 WorkItemData
->DeviceObject
= FDODeviceExtension
->FunctionalDeviceObject
;
401 DPRINT1("[USBSTOR] Queing Timer WorkItem\n");
402 ExQueueWorkItem(&WorkItemData
->WorkQueueItem
, DelayedWorkQueue
);