2 * PROJECT: ReactOS Universal Serial Bus Bulk Enhanced Host Controller Interface
3 * LICENSE: GPL - See COPYING in the top level directory
4 * FILE: drivers/usb/usbehci/hub_controller.cpp
5 * PURPOSE: USB EHCI device driver.
7 * Michael Martin (michael.martin@reactos.org)
8 * Johannes Anderwald (johannes.anderwald@reactos.org)
14 VOID
StatusChangeEndpointCallBack(
17 class CHubController
: public IHubController
,
21 STDMETHODIMP
QueryInterface( REFIID InterfaceId
, PVOID
* Interface
);
23 STDMETHODIMP_(ULONG
) AddRef()
25 InterlockedIncrement(&m_Ref
);
28 STDMETHODIMP_(ULONG
) Release()
30 InterlockedDecrement(&m_Ref
);
40 // IHubController interface functions
41 virtual NTSTATUS
Initialize(IN PDRIVER_OBJECT DriverObject
, IN PHCDCONTROLLER Controller
, IN PUSBHARDWAREDEVICE Device
, IN BOOLEAN IsRootHubDevice
, IN ULONG DeviceAddress
);
42 virtual NTSTATUS
GetHubControllerDeviceObject(PDEVICE_OBJECT
* HubDeviceObject
);
43 virtual NTSTATUS
GetHubControllerSymbolicLink(ULONG BufferLength
, PVOID Buffer
, PULONG RequiredLength
);
45 // IDispatchIrp interface functions
46 virtual NTSTATUS
HandlePnp(IN PDEVICE_OBJECT DeviceObject
, IN OUT PIRP Irp
);
47 virtual NTSTATUS
HandlePower(IN PDEVICE_OBJECT DeviceObject
, IN OUT PIRP Irp
);
48 virtual NTSTATUS
HandleDeviceControl(IN PDEVICE_OBJECT DeviceObject
, IN OUT PIRP Irp
);
51 NTSTATUS
HandleQueryInterface(PIO_STACK_LOCATION IoStack
);
52 NTSTATUS
SetDeviceInterface(BOOLEAN bEnable
);
53 NTSTATUS
CreatePDO(PDRIVER_OBJECT DriverObject
, PDEVICE_OBJECT
* OutDeviceObject
);
54 PUSBHARDWAREDEVICE
GetUsbHardware();
55 ULONG
AcquireDeviceAddress();
56 VOID
ReleaseDeviceAddress(ULONG DeviceAddress
);
57 BOOLEAN
ValidateUsbDevice(PUSBDEVICE UsbDevice
);
58 NTSTATUS
AddUsbDevice(PUSBDEVICE UsbDevice
);
59 NTSTATUS
RemoveUsbDevice(PUSBDEVICE UsbDevice
);
60 VOID
SetNotification(PVOID CallbackContext
, PRH_INIT_CALLBACK CallbackRoutine
);
61 // internal ioctl routines
62 NTSTATUS
HandleGetDescriptor(IN OUT PIRP Irp
, PURB Urb
);
63 NTSTATUS
HandleGetDescriptorFromInterface(IN OUT PIRP Irp
, PURB Urb
);
64 NTSTATUS
HandleClassDevice(IN OUT PIRP Irp
, PURB Urb
);
65 NTSTATUS
HandleGetStatusFromDevice(IN OUT PIRP Irp
, PURB Urb
);
66 NTSTATUS
HandleSelectConfiguration(IN OUT PIRP Irp
, PURB Urb
);
67 NTSTATUS
HandleSelectInterface(IN OUT PIRP Irp
, PURB Urb
);
68 NTSTATUS
HandleClassOther(IN OUT PIRP Irp
, PURB Urb
);
69 NTSTATUS
HandleClassInterface(IN OUT PIRP Irp
, PURB Urb
);
70 NTSTATUS
HandleClassEndpoint(IN OUT PIRP Irp
, PURB Urb
);
71 NTSTATUS
HandleBulkOrInterruptTransfer(IN OUT PIRP Irp
, PURB Urb
);
72 NTSTATUS
HandleIsochronousTransfer(IN OUT PIRP Irp
, PURB Urb
);
74 friend VOID
StatusChangeEndpointCallBack(PVOID Context
);
76 // constructor / destructor
77 CHubController(IUnknown
*OuterUnknown
){}
78 virtual ~CHubController(){}
82 PHCDCONTROLLER m_Controller
;
83 PUSBHARDWAREDEVICE m_Hardware
;
84 BOOLEAN m_IsRootHubDevice
;
85 ULONG m_DeviceAddress
;
87 BOOLEAN m_InterfaceEnabled
;
88 UNICODE_STRING m_HubDeviceInterfaceString
;
90 PDEVICE_OBJECT m_HubControllerDeviceObject
;
91 PDRIVER_OBJECT m_DriverObject
;
93 PVOID m_HubCallbackContext
;
94 PRH_INIT_CALLBACK m_HubCallbackRoutine
;
96 USB_DEVICE_DESCRIPTOR m_DeviceDescriptor
;
99 RTL_BITMAP m_DeviceAddressBitmap
;
100 PULONG m_DeviceAddressBitmapBuffer
;
101 LIST_ENTRY m_UsbDeviceList
;
102 PIRP m_PendingSCEIrp
;
105 BOOLEAN
QueryStatusChageEndpoint(PIRP Irp
);
112 }USBDEVICE_ENTRY
, *PUSBDEVICE_ENTRY
;
114 /* Lifted from Linux with slight changes */
115 const UCHAR ROOTHUB2_DEVICE_DESCRIPTOR
[] =
118 USB_DEVICE_DESCRIPTOR_TYPE
, /* bDescriptorType; Device */
119 0x00, 0x20, /* bcdUSB; v1.1 */
120 USB_DEVICE_CLASS_HUB
, /* bDeviceClass; HUB_CLASSCODE */
121 0x01, /* bDeviceSubClass; */
122 0x00, /* bDeviceProtocol; [ low/full speeds only ] */
123 0x08, /* bMaxPacketSize0; 8 Bytes */
124 /* Fill Vendor and Product in when init root hub */
125 0x00, 0x00, /* idVendor; */
126 0x00, 0x00, /* idProduct; */
127 0x00, 0x00, /* bcdDevice */
128 0x00, /* iManufacturer; */
129 0x00, /* iProduct; */
130 0x00, /* iSerialNumber; */
131 0x01 /* bNumConfigurations; */
135 const USB_CONFIGURATION_DESCRIPTOR ROOTHUB2_CONFIGURATION_DESCRIPTOR
=
137 sizeof(USB_CONFIGURATION_DESCRIPTOR
),
138 USB_CONFIGURATION_DESCRIPTOR_TYPE
,
139 sizeof(USB_CONFIGURATION_DESCRIPTOR
) + sizeof(USB_INTERFACE_DESCRIPTOR
) + sizeof(USB_ENDPOINT_DESCRIPTOR
),
143 0x40, /* self powered */
147 const USB_INTERFACE_DESCRIPTOR ROOTHUB2_INTERFACE_DESCRIPTOR
=
149 sizeof(USB_INTERFACE_DESCRIPTOR
), /* bLength */
150 USB_INTERFACE_DESCRIPTOR_TYPE
, /* bDescriptorType; Interface */
151 0, /* bInterfaceNumber; */
152 0, /* bAlternateSetting; */
153 0x1, /* bNumEndpoints; */
154 0x09, /* bInterfaceClass; HUB_CLASSCODE */
155 0x01, /* bInterfaceSubClass; */
156 0x00, /* bInterfaceProtocol: */
157 0x00, /* iInterface; */
160 const USB_ENDPOINT_DESCRIPTOR ROOTHUB2_ENDPOINT_DESCRIPTOR
=
162 sizeof(USB_ENDPOINT_DESCRIPTOR
), /* bLength */
163 USB_ENDPOINT_DESCRIPTOR_TYPE
, /* bDescriptorType */
164 0x81, /* bEndPointAddress */
165 USB_ENDPOINT_TYPE_INTERRUPT
, /* bmAttributes */
166 0x01, /* wMaxPacketSize */
170 //----------------------------------------------------------------------------------------
173 CHubController::QueryInterface(
177 return STATUS_UNSUCCESSFUL
;
179 //----------------------------------------------------------------------------------------
181 CHubController::Initialize(
182 IN PDRIVER_OBJECT DriverObject
,
183 IN PHCDCONTROLLER Controller
,
184 IN PUSBHARDWAREDEVICE Device
,
185 IN BOOLEAN IsRootHubDevice
,
186 IN ULONG DeviceAddress
)
189 PCOMMON_DEVICE_EXTENSION DeviceExtension
;
190 USHORT VendorID
, DeviceID
;
193 DPRINT1("CHubController::Initialize\n");
196 // initialize members
198 m_Controller
= Controller
;
200 m_IsRootHubDevice
= IsRootHubDevice
;
201 m_DeviceAddress
= DeviceAddress
;
202 m_DriverObject
= DriverObject
;
203 KeInitializeSpinLock(&m_Lock
);
204 InitializeListHead(&m_UsbDeviceList
);
207 // allocate device address bitmap buffer
209 m_DeviceAddressBitmapBuffer
= (PULONG
)ExAllocatePoolWithTag(NonPagedPool
, 16, TAG_USBEHCI
);
210 if (!m_DeviceAddressBitmapBuffer
)
215 return STATUS_INSUFFICIENT_RESOURCES
;
219 // initialize device address bitmap
221 RtlInitializeBitMap(&m_DeviceAddressBitmap
, m_DeviceAddressBitmapBuffer
, 128);
222 RtlClearAllBits(&m_DeviceAddressBitmap
);
228 Status
= CreatePDO(m_DriverObject
, &m_HubControllerDeviceObject
);
229 if (!NT_SUCCESS(Status
))
232 // failed to create hub device object
238 // get device extension
240 DeviceExtension
= (PCOMMON_DEVICE_EXTENSION
)m_HubControllerDeviceObject
->DeviceExtension
;
243 // initialize device extension
245 DeviceExtension
->IsFDO
= FALSE
;
246 DeviceExtension
->IsHub
= TRUE
; //FIXME
247 DeviceExtension
->Dispatcher
= PDISPATCHIRP(this);
250 // intialize device descriptor
252 C_ASSERT(sizeof(USB_DEVICE_DESCRIPTOR
) == sizeof(ROOTHUB2_DEVICE_DESCRIPTOR
));
253 RtlMoveMemory(&m_DeviceDescriptor
, ROOTHUB2_DEVICE_DESCRIPTOR
, sizeof(USB_DEVICE_DESCRIPTOR
));
255 if (NT_SUCCESS(m_Hardware
->GetDeviceDetails(&VendorID
, &DeviceID
, &Dummy1
, &Dummy1
)))
258 // update device descriptor
260 m_DeviceDescriptor
.idVendor
= VendorID
;
261 m_DeviceDescriptor
.idProduct
= DeviceID
;
262 m_DeviceDescriptor
.bcdUSB
= 0x200; //FIXME
266 // Set the SCE Callback that the Hardware Device will call on port status change
268 Device
->SetStatusChangeEndpointCallBack((PVOID
)StatusChangeEndpointCallBack
, this);
273 m_HubControllerDeviceObject
->Flags
&= ~DO_DEVICE_INITIALIZING
;
275 return STATUS_SUCCESS
;
279 // Queries the ports to see if there has been a device connected or removed.
282 CHubController::QueryStatusChageEndpoint(
285 ULONG PortCount
, PortId
;
286 PIO_STACK_LOCATION IoStack
;
287 USHORT PortStatus
, PortChange
;
289 PUCHAR TransferBuffer
;
290 UCHAR Changed
= FALSE
;
293 // get current stack location
295 IoStack
= IoGetCurrentIrpStackLocation(Irp
);
301 Urb
= (PURB
)IoStack
->Parameters
.Others
.Argument1
;
305 // Get the number of ports and check each one for device connected
307 m_Hardware
->GetDeviceDetails(NULL
, NULL
, &PortCount
, NULL
);
308 DPRINT1("SCE Request %p TransferBufferLength %lu Flags %x MDL %p\n", Urb
->UrbBulkOrInterruptTransfer
.TransferBuffer
, Urb
->UrbBulkOrInterruptTransfer
.TransferBufferLength
, Urb
->UrbBulkOrInterruptTransfer
.TransferFlags
, Urb
->UrbBulkOrInterruptTransfer
.TransferBufferMDL
);
310 TransferBuffer
= (PUCHAR
)Urb
->UrbBulkOrInterruptTransfer
.TransferBuffer
;
315 for (PortId
= 0; PortId
< PortCount
; PortId
++)
317 m_Hardware
->GetPortStatus(PortId
, &PortStatus
, &PortChange
);
319 DPRINT1("Port %d: Status %x, Change %x\n", PortId
, PortStatus
, PortChange
);
323 // If theres a flag in PortChange return TRUE so the SCE Irp will be completed
327 DPRINT1("Change state on port %d\n", PortId
);
328 // Set the value for the port number
329 *TransferBuffer
= 1 << ((PortId
+ 1) & 7);
337 //-----------------------------------------------------------------------------------------
339 CHubController::GetHubControllerDeviceObject(PDEVICE_OBJECT
* HubDeviceObject
)
342 // store controller object
344 *HubDeviceObject
= m_HubControllerDeviceObject
;
346 return STATUS_SUCCESS
;
348 //-----------------------------------------------------------------------------------------
350 CHubController::GetHubControllerSymbolicLink(
353 PULONG RequiredLength
)
355 if (!m_InterfaceEnabled
)
358 // device interface not yet enabled
360 return STATUS_UNSUCCESSFUL
;
363 if (BufferLength
< (ULONG
)m_HubDeviceInterfaceString
.Length
- 8)
367 // length is without '\??\'
369 *RequiredLength
= m_HubDeviceInterfaceString
.Length
- 8;
374 return STATUS_BUFFER_OVERFLOW
;
378 // copy symbolic link
380 RtlCopyMemory(Buffer
, &m_HubDeviceInterfaceString
.Buffer
[4], m_HubDeviceInterfaceString
.Length
- 8);
383 // store length, length is without '\??\'
385 *RequiredLength
= m_HubDeviceInterfaceString
.Length
- 8;
390 return STATUS_SUCCESS
;
393 //-----------------------------------------------------------------------------------------
395 CHubController::HandlePnp(
396 IN PDEVICE_OBJECT DeviceObject
,
399 PIO_STACK_LOCATION IoStack
;
400 PCOMMON_DEVICE_EXTENSION DeviceExtension
;
401 PDEVICE_CAPABILITIES DeviceCapabilities
;
402 PPNP_BUS_INFORMATION BusInformation
;
403 PDEVICE_RELATIONS DeviceRelations
;
405 ULONG Index
= 0, Length
;
406 USHORT VendorID
, DeviceID
;
407 ULONG HiSpeed
, NumPorts
;
412 // get device extension
414 DeviceExtension
= (PCOMMON_DEVICE_EXTENSION
)DeviceObject
->DeviceExtension
;
419 ASSERT(DeviceExtension
->IsFDO
== FALSE
);
422 // get current stack location
424 IoStack
= IoGetCurrentIrpStackLocation(Irp
);
426 switch(IoStack
->MinorFunction
)
428 case IRP_MN_START_DEVICE
:
430 DPRINT1("CHubController::HandlePnp IRP_MN_START_DEVICE\n");
432 // register device interface
434 Status
= SetDeviceInterface(TRUE
);
437 case IRP_MN_QUERY_ID
:
439 DPRINT1("CHubController::HandlePnp IRP_MN_QUERY_ID Type %x\n", IoStack
->Parameters
.QueryId
.IdType
);
441 if (IoStack
->Parameters
.QueryId
.IdType
== BusQueryDeviceID
)
448 Status
= m_Hardware
->GetDeviceDetails(&VendorID
, &DeviceID
, &NumPorts
, &HiSpeed
);
450 if (HiSpeed
== 0x200)
455 swprintf(Buffer
, L
"USB\\ROOT_HUB20");
462 swprintf(Buffer
, L
"USB\\ROOT_HUB");
465 DPRINT1("Name %S\n", Buffer
);
470 Length
= (wcslen(Buffer
) + 1);
475 DeviceName
= (LPWSTR
)ExAllocatePoolWithTag(PagedPool
, Length
* sizeof(WCHAR
), TAG_USBEHCI
);
482 Status
= STATUS_INSUFFICIENT_RESOURCES
;
489 wcscpy(DeviceName
, Buffer
);
494 Irp
->IoStatus
.Information
= (ULONG_PTR
)DeviceName
;
495 Status
= STATUS_SUCCESS
;
498 Status
= STATUS_UNSUCCESSFUL
;
503 if (IoStack
->Parameters
.QueryId
.IdType
== BusQueryHardwareIDs
)
510 Status
= m_Hardware
->GetDeviceDetails(&VendorID
, &DeviceID
, &NumPorts
, &HiSpeed
);
512 if (!NT_SUCCESS(Status
))
514 DPRINT1("CHubController::HandlePnp> failed to get hardware id %x\n", Status
);
519 if (HiSpeed
== 0x200)
524 Index
+= swprintf(&Buffer
[Index
], L
"USB\\ROOT_HUB20&VID%04x&PID%04x&REV0000", VendorID
, DeviceID
) + 1;
525 Index
+= swprintf(&Buffer
[Index
], L
"USB\\ROOT_HUB20&VID%04x&PID%04x", VendorID
, DeviceID
) + 1;
526 Index
+= swprintf(&Buffer
[Index
], L
"USB\\ROOT_HUB20") + 1;
533 Index
+= swprintf(&Buffer
[Index
], L
"USB\\ROOT_HUB&VID%04x&PID%04x&REV0000", VendorID
, DeviceID
) + 1;
534 Index
+= swprintf(&Buffer
[Index
], L
"USB\\ROOT_HUB&VID%04x&PID%04x", VendorID
, DeviceID
) + 1;
535 Index
+= swprintf(&Buffer
[Index
], L
"USB\\ROOT_HUB") + 1;
538 Buffer
[Index
] = UNICODE_NULL
;
542 DPRINT1("Name %S\n", Buffer
);
547 DeviceName
= (LPWSTR
)ExAllocatePoolWithTag(PagedPool
, Index
* sizeof(WCHAR
), TAG_USBEHCI
);
554 Status
= STATUS_INSUFFICIENT_RESOURCES
;
561 RtlMoveMemory(DeviceName
, Buffer
, Index
* sizeof(WCHAR
));
566 Irp
->IoStatus
.Information
= (ULONG_PTR
)DeviceName
;
567 Status
= STATUS_SUCCESS
;
571 Status
= STATUS_SUCCESS
;
574 case IRP_MN_QUERY_CAPABILITIES
:
576 DPRINT1("CHubController::HandlePnp IRP_MN_QUERY_CAPABILITIES\n");
578 DeviceCapabilities
= (PDEVICE_CAPABILITIES
)IoStack
->Parameters
.DeviceCapabilities
.Capabilities
;
580 DeviceCapabilities
->LockSupported
= FALSE
;
581 DeviceCapabilities
->EjectSupported
= FALSE
;
582 DeviceCapabilities
->Removable
= FALSE
;
583 DeviceCapabilities
->DockDevice
= FALSE
;
584 DeviceCapabilities
->UniqueID
= FALSE
;
585 DeviceCapabilities
->SilentInstall
= FALSE
;
586 DeviceCapabilities
->RawDeviceOK
= FALSE
;
587 DeviceCapabilities
->SurpriseRemovalOK
= FALSE
;
588 DeviceCapabilities
->Address
= 0;
589 DeviceCapabilities
->UINumber
= 0;
590 DeviceCapabilities
->DeviceD2
= 1;
593 DeviceCapabilities
->HardwareDisabled
= FALSE
;
594 DeviceCapabilities
->NoDisplayInUI
= FALSE
;
595 DeviceCapabilities
->DeviceState
[0] = PowerDeviceD0
;
596 for (Index
= 1; Index
< PowerSystemMaximum
; Index
++)
597 DeviceCapabilities
->DeviceState
[Index
] = PowerDeviceD3
;
598 DeviceCapabilities
->DeviceWake
= PowerDeviceUnspecified
;
599 DeviceCapabilities
->D1Latency
= 0;
600 DeviceCapabilities
->D2Latency
= 0;
601 DeviceCapabilities
->D3Latency
= 0;
603 Status
= STATUS_SUCCESS
;
606 case IRP_MN_QUERY_INTERFACE
:
608 DPRINT1("CHubController::HandlePnp IRP_MN_QUERY_INTERFACE\n");
611 // handle device interface requests
613 Status
= HandleQueryInterface(IoStack
);
616 case IRP_MN_REMOVE_DEVICE
:
618 DPRINT1("CHubController::HandlePnp IRP_MN_REMOVE_DEVICE\n");
621 // deactivate device interface for BUS PDO
623 SetDeviceInterface(FALSE
);
626 // complete the request first
628 Irp
->IoStatus
.Status
= STATUS_SUCCESS
;
629 IoCompleteRequest(Irp
, IO_NO_INCREMENT
);
634 IoDeleteDevice(m_HubControllerDeviceObject
);
639 m_HubControllerDeviceObject
= 0;
644 return STATUS_SUCCESS
;
646 case IRP_MN_QUERY_DEVICE_RELATIONS
:
648 DPRINT1("CHubController::HandlePnp IRP_MN_QUERY_DEVICE_RELATIONS Type %x\n", IoStack
->Parameters
.QueryDeviceRelations
.Type
);
650 if (IoStack
->Parameters
.QueryDeviceRelations
.Type
== TargetDeviceRelation
)
653 // allocate device relations
655 DeviceRelations
= (PDEVICE_RELATIONS
)ExAllocatePoolWithTag(PagedPool
, sizeof(DEVICE_RELATIONS
), TAG_USBEHCI
);
656 if (!DeviceRelations
)
661 Status
= STATUS_INSUFFICIENT_RESOURCES
;
666 // initialize device relations
668 DeviceRelations
->Count
= 1;
669 DeviceRelations
->Objects
[0] = DeviceObject
;
670 ObReferenceObject(DeviceObject
);
675 Status
= STATUS_SUCCESS
;
676 Irp
->IoStatus
.Information
= (ULONG_PTR
)DeviceRelations
;
683 Status
= Irp
->IoStatus
.Status
;
687 case IRP_MN_QUERY_BUS_INFORMATION
:
689 DPRINT1("CHubController::HandlePnp IRP_MN_QUERY_BUS_INFORMATION\n");
692 // allocate buffer for bus information
694 BusInformation
= (PPNP_BUS_INFORMATION
)ExAllocatePool(PagedPool
, sizeof(PNP_BUS_INFORMATION
));
700 RtlMoveMemory(&BusInformation
->BusTypeGuid
, &GUID_BUS_TYPE_USB
, sizeof(GUID
));
705 BusInformation
->LegacyBusType
= PNPBus
;
706 BusInformation
->BusNumber
= 0;
708 Status
= STATUS_SUCCESS
;
709 Irp
->IoStatus
.Information
= (ULONG_PTR
)BusInformation
;
716 Status
= STATUS_INSUFFICIENT_RESOURCES
;
720 case IRP_MN_STOP_DEVICE
:
722 DPRINT1("CHubController::HandlePnp IRP_MN_STOP_DEVICE\n");
726 Status
= STATUS_SUCCESS
;
732 // ignore request with default status
734 Status
= Irp
->IoStatus
.Status
;
742 Irp
->IoStatus
.Status
= Status
;
743 IoCompleteRequest(Irp
, IO_NO_INCREMENT
);
751 //-----------------------------------------------------------------------------------------
753 CHubController::HandlePower(
754 IN PDEVICE_OBJECT DeviceObject
,
758 Irp
->IoStatus
.Status
= STATUS_NOT_IMPLEMENTED
;
759 IoCompleteRequest(Irp
, IO_NO_INCREMENT
);
760 return STATUS_NOT_IMPLEMENTED
;
763 //-----------------------------------------------------------------------------------------
765 CHubController::HandleIsochronousTransfer(
769 PUSBDEVICE UsbDevice
;
770 PUSB_ENDPOINT_DESCRIPTOR EndPointDesc
= NULL
;
773 // Check PipeHandle to determine if this is a Bulk or Interrupt Transfer Request
775 EndPointDesc
= (PUSB_ENDPOINT_DESCRIPTOR
)Urb
->UrbIsochronousTransfer
.PipeHandle
;
779 DPRINT1("No EndpointDesc\n");
780 Urb
->UrbIsochronousTransfer
.Hdr
.Status
= USBD_STATUS_INVALID_PIPE_HANDLE
;
781 return STATUS_INVALID_PARAMETER
;
787 ASSERT(EndPointDesc
);
788 ASSERT((EndPointDesc
->bmAttributes
& USB_ENDPOINT_TYPE_MASK
) == USB_ENDPOINT_TYPE_ISOCHRONOUS
);
791 // check if this is a valid usb device handle
793 PC_ASSERT(ValidateUsbDevice(PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
)));
798 UsbDevice
= PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
);
800 return UsbDevice
->SubmitIrp(Irp
);
803 //-----------------------------------------------------------------------------------------
805 CHubController::HandleBulkOrInterruptTransfer(
809 PUSBDEVICE UsbDevice
;
810 PUSB_ENDPOINT_DESCRIPTOR EndPointDesc
= NULL
;
812 // First check if the request is for the Status Change Endpoint
816 // Is the Request for the root hub
818 if (Urb
->UrbHeader
.UsbdDeviceHandle
== 0)
820 ASSERT(m_PendingSCEIrp
== NULL
);
821 if (QueryStatusChageEndpoint(Irp
))
823 StatusChangeEndpointCallBack(this);
824 return STATUS_SUCCESS
;
828 // Else pend the IRP, to be completed when a device connects or disconnects.
830 DPRINT1("Pending SCE Irp\n");;
831 m_PendingSCEIrp
= Irp
;
832 IoMarkIrpPending(Irp
);
833 return STATUS_PENDING
;
837 // Check PipeHandle to determine if this is a Bulk or Interrupt Transfer Request
839 EndPointDesc
= (PUSB_ENDPOINT_DESCRIPTOR
)Urb
->UrbBulkOrInterruptTransfer
.PipeHandle
;
844 ASSERT(EndPointDesc
);
845 ASSERT((EndPointDesc
->bmAttributes
& USB_ENDPOINT_TYPE_MASK
) == USB_ENDPOINT_TYPE_BULK
|| (EndPointDesc
->bmAttributes
& USB_ENDPOINT_TYPE_MASK
) == USB_ENDPOINT_TYPE_INTERRUPT
);
848 // check if this is a valid usb device handle
850 PC_ASSERT(ValidateUsbDevice(PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
)));
855 UsbDevice
= PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
);
857 return UsbDevice
->SubmitIrp(Irp
);
860 //-----------------------------------------------------------------------------------------
862 CHubController::HandleClassOther(
866 NTSTATUS Status
= STATUS_NOT_IMPLEMENTED
;
867 USHORT PortStatus
= 0, PortChange
= 0;
872 DPRINT("CHubController::HandleClassOther> Request %x Value %x\n", Urb
->UrbControlVendorClassRequest
.Request
, Urb
->UrbControlVendorClassRequest
.Value
);
875 // get number of ports available
877 Status
= m_Hardware
->GetDeviceDetails(NULL
, NULL
, &NumPort
, NULL
);
878 PC_ASSERT(Status
== STATUS_SUCCESS
);
883 PC_ASSERT(Urb
->UrbControlVendorClassRequest
.Index
- 1 < (USHORT
)NumPort
);
886 // port range reported start from 1 -n
887 // convert back port id so it matches the hardware
889 PortId
= Urb
->UrbControlVendorClassRequest
.Index
- 1;
892 // check request code
894 switch(Urb
->UrbControlVendorClassRequest
.Request
)
896 case USB_REQUEST_GET_STATUS
:
901 PC_ASSERT(Urb
->UrbControlVendorClassRequest
.TransferBufferLength
== sizeof(USHORT
) * 2);
902 PC_ASSERT(Urb
->UrbControlVendorClassRequest
.TransferBuffer
);
907 Status
= m_Hardware
->GetPortStatus(PortId
, &PortStatus
, &PortChange
);
909 if (NT_SUCCESS(Status
))
912 // request contains buffer of 2 ushort which are used from submitting port status and port change status
914 DPRINT("PortId %x PortStatus %x PortChange %x\n", PortId
, PortStatus
, PortChange
);
915 Buffer
= (PUSHORT
)Urb
->UrbControlVendorClassRequest
.TransferBuffer
;
918 // store status, then port change
920 *Buffer
= PortStatus
;
922 *Buffer
= PortChange
;
930 case USB_REQUEST_CLEAR_FEATURE
:
932 switch (Urb
->UrbControlVendorClassRequest
.Value
)
934 case C_PORT_CONNECTION
:
935 Status
= m_Hardware
->ClearPortStatus(PortId
, C_PORT_CONNECTION
);
938 Status
= m_Hardware
->ClearPortStatus(PortId
, C_PORT_RESET
);
941 DPRINT("Unknown Value for Clear Feature %x \n", Urb
->UrbControlVendorClassRequest
.Value
);
945 Status
= STATUS_SUCCESS
;
948 case USB_REQUEST_SET_FEATURE
:
951 // request set feature
953 switch(Urb
->UrbControlVendorClassRequest
.Value
)
958 // port enable is a no-op for EHCI
960 Status
= STATUS_SUCCESS
;
967 // set suspend port feature
969 Status
= m_Hardware
->SetPortFeature(PortId
, PORT_SUSPEND
);
975 // set power feature on port
977 Status
= m_Hardware
->SetPortFeature(PortId
, PORT_POWER
);
984 // reset port feature
986 Status
= m_Hardware
->SetPortFeature(PortId
, PORT_RESET
);
987 PC_ASSERT(Status
== STATUS_SUCCESS
);
991 DPRINT1("Unsupported request id %x\n", Urb
->UrbControlVendorClassRequest
.Value
);
997 DPRINT1("CHubController::HandleClassOther Unknown request code %x\n", Urb
->UrbControlVendorClassRequest
.Request
);
999 Status
= STATUS_INVALID_DEVICE_REQUEST
;
1004 //-----------------------------------------------------------------------------------------
1006 CHubController::HandleSelectConfiguration(
1010 PUSBDEVICE UsbDevice
;
1011 PUSBD_INTERFACE_INFORMATION InterfaceInfo
;
1014 // is the request for the Root Hub
1016 if (Urb
->UrbHeader
.UsbdDeviceHandle
== NULL
)
1019 // FIXME: support setting device to unconfigured state
1021 PC_ASSERT(Urb
->UrbSelectConfiguration
.ConfigurationDescriptor
);
1024 // set device handle
1026 Urb
->UrbSelectConfiguration
.ConfigurationHandle
= (PVOID
)&ROOTHUB2_CONFIGURATION_DESCRIPTOR
;
1029 // copy interface info
1031 InterfaceInfo
= &Urb
->UrbSelectConfiguration
.Interface
;
1033 InterfaceInfo
->InterfaceHandle
= (USBD_INTERFACE_HANDLE
)&ROOTHUB2_INTERFACE_DESCRIPTOR
;
1034 InterfaceInfo
->Class
= ROOTHUB2_INTERFACE_DESCRIPTOR
.bInterfaceClass
;
1035 InterfaceInfo
->SubClass
= ROOTHUB2_INTERFACE_DESCRIPTOR
.bInterfaceSubClass
;
1036 InterfaceInfo
->Protocol
= ROOTHUB2_INTERFACE_DESCRIPTOR
.bInterfaceProtocol
;
1037 InterfaceInfo
->Reserved
= 0;
1042 PC_ASSERT(InterfaceInfo
->NumberOfPipes
== 1);
1047 InterfaceInfo
->Pipes
[0].MaximumPacketSize
= ROOTHUB2_ENDPOINT_DESCRIPTOR
.wMaxPacketSize
;
1048 InterfaceInfo
->Pipes
[0].EndpointAddress
= ROOTHUB2_ENDPOINT_DESCRIPTOR
.bEndpointAddress
;
1049 InterfaceInfo
->Pipes
[0].Interval
= ROOTHUB2_ENDPOINT_DESCRIPTOR
.bInterval
;
1050 InterfaceInfo
->Pipes
[0].PipeType
= (USBD_PIPE_TYPE
)(ROOTHUB2_ENDPOINT_DESCRIPTOR
.bmAttributes
& USB_ENDPOINT_TYPE_MASK
);
1051 InterfaceInfo
->Pipes
[0].PipeHandle
= (PVOID
)&ROOTHUB2_ENDPOINT_DESCRIPTOR
;
1053 return STATUS_SUCCESS
;
1058 // check if this is a valid usb device handle
1060 PC_ASSERT(ValidateUsbDevice(PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
)));
1065 UsbDevice
= PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
);
1068 // select configuration
1070 return UsbDevice
->SelectConfiguration(Urb
->UrbSelectConfiguration
.ConfigurationDescriptor
, &Urb
->UrbSelectConfiguration
.Interface
, &Urb
->UrbSelectConfiguration
.ConfigurationHandle
);
1074 //-----------------------------------------------------------------------------------------
1076 CHubController::HandleSelectInterface(
1080 PUSBDEVICE UsbDevice
;
1085 PC_ASSERT(Urb
->UrbSelectInterface
.ConfigurationHandle
);
1088 // is the request for the Root Hub
1090 if (Urb
->UrbHeader
.UsbdDeviceHandle
== NULL
)
1093 // no op for root hub
1095 return STATUS_SUCCESS
;
1100 // check if this is a valid usb device handle
1102 PC_ASSERT(ValidateUsbDevice(PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
)));
1107 UsbDevice
= PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
);
1112 return UsbDevice
->SelectInterface(Urb
->UrbSelectInterface
.ConfigurationHandle
, &Urb
->UrbSelectInterface
.Interface
);
1116 //-----------------------------------------------------------------------------------------
1118 CHubController::HandleGetStatusFromDevice(
1122 PUSHORT DeviceStatus
;
1123 USB_DEFAULT_PIPE_SETUP_PACKET CtrlSetup
;
1125 PUSBDEVICE UsbDevice
;
1130 PC_ASSERT(Urb
->UrbControlGetStatusRequest
.Index
== 0);
1131 PC_ASSERT(Urb
->UrbControlGetStatusRequest
.TransferBufferLength
>= sizeof(USHORT
));
1132 PC_ASSERT(Urb
->UrbControlGetStatusRequest
.TransferBuffer
);
1135 // get status buffer
1137 DeviceStatus
= (PUSHORT
)Urb
->UrbControlGetStatusRequest
.TransferBuffer
;
1140 if (Urb
->UrbHeader
.UsbdDeviceHandle
== NULL
)
1143 // FIXME need more flags ?
1145 *DeviceStatus
= USB_PORT_STATUS_CONNECT
;
1146 return STATUS_SUCCESS
;
1150 // check if this is a valid usb device handle
1152 ASSERT(ValidateUsbDevice(PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
)));
1157 UsbDevice
= PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
);
1161 // generate setup packet
1163 CtrlSetup
.bRequest
= USB_REQUEST_GET_STATUS
;
1164 CtrlSetup
.wValue
.LowByte
= 0;
1165 CtrlSetup
.wValue
.HiByte
= 0;
1166 CtrlSetup
.wIndex
.W
= Urb
->UrbControlGetStatusRequest
.Index
;
1167 CtrlSetup
.wLength
= (USHORT
)Urb
->UrbControlGetStatusRequest
.TransferBufferLength
;
1168 CtrlSetup
.bmRequestType
.B
= 0x80;
1171 // submit setup packet
1173 Status
= UsbDevice
->SubmitSetupPacket(&CtrlSetup
, Urb
->UrbControlDescriptorRequest
.TransferBufferLength
, Urb
->UrbControlDescriptorRequest
.TransferBuffer
);
1174 ASSERT(Status
== STATUS_SUCCESS
);
1175 DPRINT1("CHubController::HandleGetStatusFromDevice Status %x Length %lu DeviceStatus %x\n", Status
, Urb
->UrbControlDescriptorRequest
.TransferBufferLength
, *DeviceStatus
);
1183 //-----------------------------------------------------------------------------------------
1185 CHubController::HandleClassDevice(
1189 NTSTATUS Status
= STATUS_NOT_IMPLEMENTED
;
1190 PUSB_HUB_DESCRIPTOR UsbHubDescriptor
;
1191 ULONG PortCount
, Dummy2
;
1193 PUSBDEVICE UsbDevice
;
1194 USB_DEFAULT_PIPE_SETUP_PACKET CtrlSetup
;
1196 DPRINT("CHubController::HandleClassDevice Request %x Class %x\n", Urb
->UrbControlVendorClassRequest
.Request
, Urb
->UrbControlVendorClassRequest
.Value
>> 8);
1199 // check class request type
1201 switch(Urb
->UrbControlVendorClassRequest
.Request
)
1203 case USB_REQUEST_GET_STATUS
:
1206 // check if this is a valid usb device handle
1208 ASSERT(ValidateUsbDevice(PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
)));
1213 UsbDevice
= PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
);
1217 // generate setup packet
1219 CtrlSetup
.bRequest
= USB_REQUEST_GET_STATUS
;
1220 CtrlSetup
.wValue
.LowByte
= Urb
->UrbControlVendorClassRequest
.Index
;
1221 CtrlSetup
.wValue
.W
= Urb
->UrbControlVendorClassRequest
.Value
;
1222 CtrlSetup
.wIndex
.W
= Urb
->UrbControlVendorClassRequest
.Index
;
1223 CtrlSetup
.wLength
= (USHORT
)Urb
->UrbControlGetStatusRequest
.TransferBufferLength
;
1224 CtrlSetup
.bmRequestType
.B
= 0xA0;
1227 // submit setup packet
1229 Status
= UsbDevice
->SubmitSetupPacket(&CtrlSetup
, Urb
->UrbControlDescriptorRequest
.TransferBufferLength
, Urb
->UrbControlDescriptorRequest
.TransferBuffer
);
1230 ASSERT(Status
== STATUS_SUCCESS
);
1233 case USB_REQUEST_GET_DESCRIPTOR
:
1235 switch (Urb
->UrbControlVendorClassRequest
.Value
>> 8)
1237 case USB_DEVICE_CLASS_RESERVED
: // FALL THROUGH
1238 case USB_DEVICE_CLASS_HUB
:
1243 PC_ASSERT(Urb
->UrbControlVendorClassRequest
.TransferBuffer
);
1244 PC_ASSERT(Urb
->UrbControlVendorClassRequest
.TransferBufferLength
>= sizeof(USB_HUB_DESCRIPTOR
));
1247 // get hub descriptor
1249 UsbHubDescriptor
= (PUSB_HUB_DESCRIPTOR
)Urb
->UrbControlVendorClassRequest
.TransferBuffer
;
1252 // one hub is handled
1254 UsbHubDescriptor
->bDescriptorLength
= sizeof(USB_HUB_DESCRIPTOR
);
1255 Urb
->UrbControlVendorClassRequest
.TransferBufferLength
= sizeof(USB_HUB_DESCRIPTOR
);
1258 // type should 0x29 according to msdn
1260 UsbHubDescriptor
->bDescriptorType
= 0x29;
1265 Status
= m_Hardware
->GetDeviceDetails(&Dummy1
, &Dummy1
, &PortCount
, &Dummy2
);
1266 PC_ASSERT(Status
== STATUS_SUCCESS
);
1269 // FIXME: retrieve values
1271 UsbHubDescriptor
->bNumberOfPorts
= (UCHAR
)PortCount
;
1272 UsbHubDescriptor
->wHubCharacteristics
= 0x00;
1273 UsbHubDescriptor
->bPowerOnToPowerGood
= 0x01;
1274 UsbHubDescriptor
->bHubControlCurrent
= 0x00;
1279 Status
= STATUS_SUCCESS
;
1283 DPRINT1("CHubController::HandleClassDevice Class %x not implemented\n", Urb
->UrbControlVendorClassRequest
.Value
>> 8);
1289 DPRINT1("CHubController::HandleClassDevice Type %x not implemented\n", Urb
->UrbControlVendorClassRequest
.Request
);
1295 //-----------------------------------------------------------------------------------------
1297 CHubController::HandleGetDescriptorFromInterface(
1301 PUSBDEVICE UsbDevice
;
1302 USB_DEFAULT_PIPE_SETUP_PACKET CtrlSetup
;
1308 ASSERT(Urb
->UrbControlDescriptorRequest
.TransferBufferLength
);
1309 ASSERT(Urb
->UrbControlDescriptorRequest
.TransferBuffer
);
1312 // check if this is a valid usb device handle
1314 ASSERT(ValidateUsbDevice(PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
)));
1319 UsbDevice
= PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
);
1322 // generate setup packet
1324 CtrlSetup
.bRequest
= USB_REQUEST_GET_DESCRIPTOR
;
1325 CtrlSetup
.wValue
.LowByte
= Urb
->UrbControlDescriptorRequest
.Index
;
1326 CtrlSetup
.wValue
.HiByte
= Urb
->UrbControlDescriptorRequest
.DescriptorType
;
1327 CtrlSetup
.wIndex
.W
= Urb
->UrbControlDescriptorRequest
.LanguageId
;
1328 CtrlSetup
.wLength
= (USHORT
)Urb
->UrbControlDescriptorRequest
.TransferBufferLength
;
1329 CtrlSetup
.bmRequestType
.B
= 0x81;
1332 // submit setup packet
1334 Status
= UsbDevice
->SubmitSetupPacket(&CtrlSetup
, Urb
->UrbControlDescriptorRequest
.TransferBufferLength
, Urb
->UrbControlDescriptorRequest
.TransferBuffer
);
1335 ASSERT(Status
== STATUS_SUCCESS
);
1343 //-----------------------------------------------------------------------------------------
1345 CHubController::HandleGetDescriptor(
1349 NTSTATUS Status
= STATUS_NOT_IMPLEMENTED
;
1350 PUSB_CONFIGURATION_DESCRIPTOR ConfigurationDescriptor
;
1351 USB_DEFAULT_PIPE_SETUP_PACKET CtrlSetup
;
1353 PUSBDEVICE UsbDevice
;
1356 DPRINT("CHubController::HandleGetDescriptor\n");
1359 // check descriptor type
1361 switch(Urb
->UrbControlDescriptorRequest
.DescriptorType
)
1363 case USB_DEVICE_DESCRIPTOR_TYPE
:
1368 PC_ASSERT(Urb
->UrbControlDescriptorRequest
.TransferBufferLength
>= sizeof(USB_DEVICE_DESCRIPTOR
));
1369 PC_ASSERT(Urb
->UrbControlDescriptorRequest
.TransferBuffer
);
1371 if (Urb
->UrbHeader
.UsbdDeviceHandle
== NULL
)
1374 // copy root hub device descriptor
1376 RtlCopyMemory((PUCHAR
)Urb
->UrbControlDescriptorRequest
.TransferBuffer
, &m_DeviceDescriptor
, sizeof(USB_DEVICE_DESCRIPTOR
));
1377 Status
= STATUS_SUCCESS
;
1382 // check if this is a valid usb device handle
1384 PC_ASSERT(ValidateUsbDevice(PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
)));
1389 UsbDevice
= PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
);
1392 // retrieve device descriptor from device
1394 UsbDevice
->GetDeviceDescriptor((PUSB_DEVICE_DESCRIPTOR
)Urb
->UrbControlDescriptorRequest
.TransferBuffer
);
1395 Status
= STATUS_SUCCESS
;
1399 case USB_CONFIGURATION_DESCRIPTOR_TYPE
:
1404 PC_ASSERT(Urb
->UrbControlDescriptorRequest
.TransferBuffer
);
1405 PC_ASSERT(Urb
->UrbControlDescriptorRequest
.TransferBufferLength
>= sizeof(USB_CONFIGURATION_DESCRIPTOR
));
1407 if (Urb
->UrbHeader
.UsbdDeviceHandle
== NULL
)
1410 // request is for the root bus controller
1412 RtlCopyMemory(Urb
->UrbControlDescriptorRequest
.TransferBuffer
, &ROOTHUB2_CONFIGURATION_DESCRIPTOR
, sizeof(USB_CONFIGURATION_DESCRIPTOR
));
1415 // get configuration descriptor, very retarded!
1417 ConfigurationDescriptor
= (PUSB_CONFIGURATION_DESCRIPTOR
)Urb
->UrbControlDescriptorRequest
.TransferBuffer
;
1420 // check if buffer can hold interface and endpoint descriptor
1422 if (ConfigurationDescriptor
->wTotalLength
> Urb
->UrbControlDescriptorRequest
.TransferBufferLength
)
1427 Status
= STATUS_SUCCESS
;
1433 // copy interface descriptor template
1435 Buffer
= (PUCHAR
)(ConfigurationDescriptor
+ 1);
1436 RtlCopyMemory(Buffer
, &ROOTHUB2_INTERFACE_DESCRIPTOR
, sizeof(USB_INTERFACE_DESCRIPTOR
));
1439 // copy end point descriptor template
1441 Buffer
+= sizeof(USB_INTERFACE_DESCRIPTOR
);
1442 RtlCopyMemory(Buffer
, &ROOTHUB2_ENDPOINT_DESCRIPTOR
, sizeof(USB_ENDPOINT_DESCRIPTOR
));
1447 Status
= STATUS_SUCCESS
;
1453 // check if this is a valid usb device handle
1455 PC_ASSERT(ValidateUsbDevice(PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
)));
1460 UsbDevice
= PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
);
1462 if (sizeof(USB_CONFIGURATION_DESCRIPTOR
) > Urb
->UrbControlDescriptorRequest
.TransferBufferLength
)
1467 Urb
->UrbControlDescriptorRequest
.TransferBufferLength
= UsbDevice
->GetConfigurationDescriptorsLength();
1472 Status
= STATUS_SUCCESS
;
1477 // perform work in IUSBDevice
1479 UsbDevice
->GetConfigurationDescriptors((PUSB_CONFIGURATION_DESCRIPTOR
)Urb
->UrbControlDescriptorRequest
.TransferBuffer
, Urb
->UrbControlDescriptorRequest
.TransferBufferLength
, &Length
);
1484 PC_ASSERT(Urb
->UrbControlDescriptorRequest
.TransferBufferLength
>= Length
);
1487 // store result size
1489 Urb
->UrbControlDescriptorRequest
.TransferBufferLength
= Length
;
1490 Status
= STATUS_SUCCESS
;
1494 case USB_STRING_DESCRIPTOR_TYPE
:
1499 PC_ASSERT(Urb
->UrbControlDescriptorRequest
.TransferBuffer
);
1500 PC_ASSERT(Urb
->UrbControlDescriptorRequest
.TransferBufferLength
);
1504 // check if this is a valid usb device handle
1506 PC_ASSERT(ValidateUsbDevice(PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
)));
1511 UsbDevice
= PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
);
1514 // generate setup packet
1516 CtrlSetup
.bRequest
= USB_REQUEST_GET_DESCRIPTOR
;
1517 CtrlSetup
.wValue
.LowByte
= Urb
->UrbControlDescriptorRequest
.Index
;
1518 CtrlSetup
.wValue
.HiByte
= Urb
->UrbControlDescriptorRequest
.DescriptorType
;
1519 CtrlSetup
.wIndex
.W
= Urb
->UrbControlDescriptorRequest
.LanguageId
;
1520 CtrlSetup
.wLength
= (USHORT
)Urb
->UrbControlDescriptorRequest
.TransferBufferLength
;
1521 CtrlSetup
.bmRequestType
.B
= 0x80;
1524 // submit setup packet
1526 Status
= UsbDevice
->SubmitSetupPacket(&CtrlSetup
, Urb
->UrbControlDescriptorRequest
.TransferBufferLength
, Urb
->UrbControlDescriptorRequest
.TransferBuffer
);
1530 DPRINT1("CHubController::HandleGetDescriptor DescriptorType %x unimplemented\n", Urb
->UrbControlDescriptorRequest
.DescriptorType
);
1540 //-----------------------------------------------------------------------------------------
1542 CHubController::HandleClassEndpoint(
1546 USB_DEFAULT_PIPE_SETUP_PACKET CtrlSetup
;
1548 PUSBDEVICE UsbDevice
;
1553 PC_ASSERT(Urb
->UrbControlVendorClassRequest
.TransferBuffer
);
1554 PC_ASSERT(Urb
->UrbControlVendorClassRequest
.TransferBufferLength
);
1555 PC_ASSERT(Urb
->UrbHeader
.UsbdDeviceHandle
);
1558 // check if this is a valid usb device handle
1560 PC_ASSERT(ValidateUsbDevice(PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
)));
1565 UsbDevice
= PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
);
1568 DPRINT1("URB_FUNCTION_CLASS_ENDPOINT\n");
1569 DPRINT1("TransferFlags %x\n", Urb
->UrbControlVendorClassRequest
.TransferFlags
);
1570 DPRINT1("TransferBufferLength %x\n", Urb
->UrbControlVendorClassRequest
.TransferBufferLength
);
1571 DPRINT1("TransferBuffer %x\n", Urb
->UrbControlVendorClassRequest
.TransferBuffer
);
1572 DPRINT1("TransferBufferMDL %x\n", Urb
->UrbControlVendorClassRequest
.TransferBufferMDL
);
1573 DPRINT1("RequestTypeReservedBits %x\n", Urb
->UrbControlVendorClassRequest
.RequestTypeReservedBits
);
1574 DPRINT1("Request %x\n", Urb
->UrbControlVendorClassRequest
.Request
);
1575 DPRINT1("Value %x\n", Urb
->UrbControlVendorClassRequest
.Value
);
1576 DPRINT1("Index %x\n", Urb
->UrbControlVendorClassRequest
.Index
);
1579 // initialize setup packet
1581 CtrlSetup
.bmRequestType
.B
= 0xa2; //FIXME: Const.
1582 CtrlSetup
.bRequest
= Urb
->UrbControlVendorClassRequest
.Request
;
1583 CtrlSetup
.wValue
.W
= Urb
->UrbControlVendorClassRequest
.Value
;
1584 CtrlSetup
.wIndex
.W
= Urb
->UrbControlVendorClassRequest
.Index
;
1585 CtrlSetup
.wLength
= Urb
->UrbControlVendorClassRequest
.TransferBufferLength
;
1590 Status
= UsbDevice
->SubmitSetupPacket(&CtrlSetup
, Urb
->UrbControlVendorClassRequest
.TransferBufferLength
, Urb
->UrbControlVendorClassRequest
.TransferBuffer
);
1593 // assert on failure
1595 PC_ASSERT(NT_SUCCESS(Status
));
1604 //-----------------------------------------------------------------------------------------
1606 CHubController::HandleClassInterface(
1610 USB_DEFAULT_PIPE_SETUP_PACKET CtrlSetup
;
1612 PUSBDEVICE UsbDevice
;
1617 //ASSERT(Urb->UrbControlVendorClassRequest.TransferBuffer || Urb->UrbControlVendorClassRequest.TransferBufferMDL);
1618 //ASSERT(Urb->UrbControlVendorClassRequest.TransferBufferLength);
1619 PC_ASSERT(Urb
->UrbHeader
.UsbdDeviceHandle
);
1622 // check if this is a valid usb device handle
1624 PC_ASSERT(ValidateUsbDevice(PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
)));
1629 UsbDevice
= PUSBDEVICE(Urb
->UrbHeader
.UsbdDeviceHandle
);
1632 DPRINT1("URB_FUNCTION_CLASS_INTERFACE\n");
1633 DPRINT1("TransferFlags %x\n", Urb
->UrbControlVendorClassRequest
.TransferFlags
);
1634 DPRINT1("TransferBufferLength %x\n", Urb
->UrbControlVendorClassRequest
.TransferBufferLength
);
1635 DPRINT1("TransferBuffer %x\n", Urb
->UrbControlVendorClassRequest
.TransferBuffer
);
1636 DPRINT1("TransferBufferMDL %x\n", Urb
->UrbControlVendorClassRequest
.TransferBufferMDL
);
1637 DPRINT1("RequestTypeReservedBits %x\n", Urb
->UrbControlVendorClassRequest
.RequestTypeReservedBits
);
1638 DPRINT1("Request %x\n", Urb
->UrbControlVendorClassRequest
.Request
);
1639 DPRINT1("Value %x\n", Urb
->UrbControlVendorClassRequest
.Value
);
1640 DPRINT1("Index %x\n", Urb
->UrbControlVendorClassRequest
.Index
);
1643 // initialize setup packet
1645 CtrlSetup
.bmRequestType
.B
= 0xa1; //FIXME: Const.
1646 CtrlSetup
.bRequest
= Urb
->UrbControlVendorClassRequest
.Request
;
1647 CtrlSetup
.wValue
.W
= Urb
->UrbControlVendorClassRequest
.Value
;
1648 CtrlSetup
.wIndex
.W
= Urb
->UrbControlVendorClassRequest
.Index
;
1649 CtrlSetup
.wLength
= Urb
->UrbControlVendorClassRequest
.TransferBufferLength
;
1654 Status
= UsbDevice
->SubmitSetupPacket(&CtrlSetup
, Urb
->UrbControlVendorClassRequest
.TransferBufferLength
, Urb
->UrbControlVendorClassRequest
.TransferBuffer
);
1657 // assert on failure
1659 PC_ASSERT(NT_SUCCESS(Status
));
1668 //-----------------------------------------------------------------------------------------
1670 CHubController::HandleDeviceControl(
1671 IN PDEVICE_OBJECT DeviceObject
,
1674 PIO_STACK_LOCATION IoStack
;
1675 PCOMMON_DEVICE_EXTENSION DeviceExtension
;
1677 NTSTATUS Status
= STATUS_NOT_IMPLEMENTED
;
1680 // get current stack location
1682 IoStack
= IoGetCurrentIrpStackLocation(Irp
);
1685 // get device extension
1687 DeviceExtension
= (PCOMMON_DEVICE_EXTENSION
)DeviceObject
->DeviceExtension
;
1690 // determine which request should be performed
1692 switch(IoStack
->Parameters
.DeviceIoControl
.IoControlCode
)
1694 case IOCTL_INTERNAL_USB_SUBMIT_URB
:
1699 Urb
= (PURB
)IoStack
->Parameters
.Others
.Argument1
;
1702 switch (Urb
->UrbHeader
.Function
)
1704 case URB_FUNCTION_GET_DESCRIPTOR_FROM_INTERFACE
:
1705 Status
= HandleGetDescriptorFromInterface(Irp
, Urb
);
1707 case URB_FUNCTION_GET_DESCRIPTOR_FROM_DEVICE
:
1708 Status
= HandleGetDescriptor(Irp
, Urb
);
1710 case URB_FUNCTION_CLASS_DEVICE
:
1711 Status
= HandleClassDevice(Irp
, Urb
);
1713 case URB_FUNCTION_GET_STATUS_FROM_DEVICE
:
1714 Status
= HandleGetStatusFromDevice(Irp
, Urb
);
1716 case URB_FUNCTION_SELECT_CONFIGURATION
:
1717 Status
= HandleSelectConfiguration(Irp
, Urb
);
1719 case URB_FUNCTION_SELECT_INTERFACE
:
1720 Status
= HandleSelectInterface(Irp
, Urb
);
1722 case URB_FUNCTION_CLASS_OTHER
:
1723 Status
= HandleClassOther(Irp
, Urb
);
1725 case URB_FUNCTION_BULK_OR_INTERRUPT_TRANSFER
:
1726 Status
= HandleBulkOrInterruptTransfer(Irp
, Urb
);
1728 case URB_FUNCTION_ISOCH_TRANSFER
:
1729 Status
= HandleIsochronousTransfer(Irp
, Urb
);
1731 case URB_FUNCTION_CLASS_INTERFACE
:
1732 Status
= HandleClassInterface(Irp
, Urb
);
1734 case URB_FUNCTION_CLASS_ENDPOINT
:
1735 Status
= HandleClassEndpoint(Irp
, Urb
);
1738 DPRINT1("IOCTL_INTERNAL_USB_SUBMIT_URB Function %x NOT IMPLEMENTED\n", Urb
->UrbHeader
.Function
);
1742 // request completed
1746 case IOCTL_INTERNAL_USB_GET_DEVICE_HANDLE
:
1748 DPRINT("IOCTL_INTERNAL_USB_GET_DEVICE_HANDLE %p\n", this);
1750 if (IoStack
->Parameters
.Others
.Argument1
)
1753 // store object as device handle
1755 *(PVOID
*)IoStack
->Parameters
.Others
.Argument1
= (PVOID
)this;
1756 Status
= STATUS_SUCCESS
;
1761 // mis-behaving hub driver
1763 Status
= STATUS_INVALID_DEVICE_REQUEST
;
1767 // request completed
1771 case IOCTL_INTERNAL_USB_GET_ROOTHUB_PDO
:
1773 DPRINT("IOCTL_INTERNAL_USB_GET_ROOTHUB_PDO\n");
1776 // this is the first request send, it delivers the PDO to the caller
1778 if (IoStack
->Parameters
.Others
.Argument1
)
1781 // store root hub pdo object
1783 *(PVOID
*)IoStack
->Parameters
.Others
.Argument1
= DeviceObject
;
1786 if (IoStack
->Parameters
.Others
.Argument2
)
1789 // documentation claims to deliver the hcd controller object, although it is wrong
1791 *(PVOID
*)IoStack
->Parameters
.Others
.Argument2
= DeviceObject
;
1795 // request completed
1797 Status
= STATUS_SUCCESS
;
1800 case IOCTL_INTERNAL_USB_GET_HUB_COUNT
:
1802 DPRINT("IOCTL_INTERNAL_USB_GET_HUB_COUNT\n");
1805 // after IOCTL_INTERNAL_USB_GET_ROOTHUB_PDO is delivered, the usbhub driver
1806 // requests this ioctl to deliver the number of presents.
1808 if (IoStack
->Parameters
.Others
.Argument1
)
1811 // FIXME / verify: there is only one hub
1813 *(PULONG
)IoStack
->Parameters
.Others
.Argument1
= 1;
1817 // request completed
1819 Status
= STATUS_SUCCESS
;
1820 Irp
->IoStatus
.Information
= sizeof(ULONG
);
1823 case IOCTL_INTERNAL_USB_SUBMIT_IDLE_NOTIFICATION
:
1825 DPRINT1("IOCTL_INTERNAL_USB_SUBMIT_IDLE_NOTIFICATION UNIMPLEMENTED\n");
1826 Status
= STATUS_SUCCESS
;
1831 DPRINT1("HandleDeviceControl>Type: IoCtl %x InputBufferLength %lu OutputBufferLength %lu NOT IMPLEMENTED\n",
1832 IoStack
->Parameters
.DeviceIoControl
.IoControlCode
,
1833 IoStack
->Parameters
.DeviceIoControl
.InputBufferLength
,
1834 IoStack
->Parameters
.DeviceIoControl
.OutputBufferLength
);
1838 if (Status
!= STATUS_PENDING
)
1840 Irp
->IoStatus
.Status
= Status
;
1841 IoCompleteRequest(Irp
, IO_NO_INCREMENT
);
1847 //-----------------------------------------------------------------------------------------
1849 CHubController::GetUsbHardware()
1854 //-----------------------------------------------------------------------------------------
1856 CHubController::AcquireDeviceAddress()
1859 ULONG DeviceAddress
;
1862 // acquire device lock
1864 KeAcquireSpinLock(&m_Lock
, &OldLevel
);
1869 DeviceAddress
= RtlFindClearBits(&m_DeviceAddressBitmap
, 1, 0);
1870 if (DeviceAddress
!= MAXULONG
)
1875 RtlSetBits(&m_DeviceAddressBitmap
, DeviceAddress
, 1);
1878 // device addresses start from 0x1 - 0xFF
1884 // release spin lock
1886 KeReleaseSpinLock(&m_Lock
, OldLevel
);
1889 // return device address
1891 return DeviceAddress
;
1893 //-----------------------------------------------------------------------------------------
1895 CHubController::ReleaseDeviceAddress(
1896 ULONG DeviceAddress
)
1901 // acquire device lock
1903 KeAcquireSpinLock(&m_Lock
, &OldLevel
);
1908 PC_ASSERT(DeviceAddress
!= 0);
1911 // convert back to bit number
1918 RtlClearBits(&m_DeviceAddressBitmap
, DeviceAddress
, 1);
1923 KeReleaseSpinLock(&m_Lock
, OldLevel
);
1925 //-----------------------------------------------------------------------------------------
1927 CHubController::RemoveUsbDevice(
1928 PUSBDEVICE UsbDevice
)
1930 PUSBDEVICE_ENTRY DeviceEntry
;
1932 NTSTATUS Status
= STATUS_UNSUCCESSFUL
;
1938 KeAcquireSpinLock(&m_Lock
, &OldLevel
);
1941 // point to first entry
1943 Entry
= m_UsbDeviceList
.Flink
;
1946 // find matching entry
1948 while(Entry
!= &m_UsbDeviceList
)
1953 DeviceEntry
= (PUSBDEVICE_ENTRY
)CONTAINING_RECORD(Entry
, USBDEVICE_ENTRY
, Entry
);
1956 // is it current entry
1958 if (DeviceEntry
->Device
== UsbDevice
)
1963 RemoveEntryList(Entry
);
1968 ExFreePoolWithTag(DeviceEntry
, TAG_USBEHCI
);
1973 Status
= STATUS_SUCCESS
;
1980 Entry
= Entry
->Flink
;
1986 KeReleaseSpinLock(&m_Lock
, OldLevel
);
1993 //-----------------------------------------------------------------------------------------
1995 CHubController::ValidateUsbDevice(PUSBDEVICE UsbDevice
)
1997 PUSBDEVICE_ENTRY DeviceEntry
;
2000 BOOLEAN Result
= FALSE
;
2005 KeAcquireSpinLock(&m_Lock
, &OldLevel
);
2008 // point to first entry
2010 Entry
= m_UsbDeviceList
.Flink
;
2013 // find matching entry
2015 while(Entry
!= &m_UsbDeviceList
)
2020 DeviceEntry
= (PUSBDEVICE_ENTRY
)CONTAINING_RECORD(Entry
, USBDEVICE_ENTRY
, Entry
);
2023 // is it current entry
2025 if (DeviceEntry
->Device
== UsbDevice
)
2037 Entry
= Entry
->Flink
;
2043 KeReleaseSpinLock(&m_Lock
, OldLevel
);
2052 //-----------------------------------------------------------------------------------------
2054 CHubController::AddUsbDevice(
2055 PUSBDEVICE UsbDevice
)
2057 PUSBDEVICE_ENTRY DeviceEntry
;
2061 // allocate device entry
2063 DeviceEntry
= (PUSBDEVICE_ENTRY
)ExAllocatePoolWithTag(NonPagedPool
, sizeof(USBDEVICE_ENTRY
), TAG_USBEHCI
);
2069 return STATUS_INSUFFICIENT_RESOURCES
;
2075 DeviceEntry
->Device
= UsbDevice
;
2080 KeAcquireSpinLock(&m_Lock
, &OldLevel
);
2085 InsertTailList(&m_UsbDeviceList
, &DeviceEntry
->Entry
);
2088 // release spin lock
2090 KeReleaseSpinLock(&m_Lock
, OldLevel
);
2095 return STATUS_SUCCESS
;
2098 //-----------------------------------------------------------------------------------------
2100 CHubController::SetNotification(
2101 PVOID CallbackContext
,
2102 PRH_INIT_CALLBACK CallbackRoutine
)
2107 // acquire hub controller lock
2109 KeAcquireSpinLock(&m_Lock
, &OldLevel
);
2112 // now set the callback routine and context of the hub
2114 m_HubCallbackContext
= CallbackContext
;
2115 m_HubCallbackRoutine
= CallbackRoutine
;
2118 // release hub controller lock
2120 KeReleaseSpinLock(&m_Lock
, OldLevel
);
2123 //=================================================================================================
2125 // Generic Interface functions
2129 USBI_InterfaceReference(
2132 CHubController
* Controller
= (CHubController
*)BusContext
;
2134 DPRINT1("USBH_InterfaceReference\n");
2139 Controller
->AddRef();
2144 USBI_InterfaceDereference(
2147 CHubController
* Controller
= (CHubController
*)BusContext
;
2149 DPRINT1("USBH_InterfaceDereference\n");
2154 Controller
->Release();
2156 //=================================================================================================
2158 // USB Hub Interface functions
2162 USBHI_CreateUsbDevice(
2164 PUSB_DEVICE_HANDLE
*NewDevice
,
2165 PUSB_DEVICE_HANDLE HubDeviceHandle
,
2169 PUSBDEVICE NewUsbDevice
;
2170 CHubController
* Controller
;
2173 DPRINT1("USBHI_CreateUsbDevice\n");
2176 // first get hub controller
2178 Controller
= (CHubController
*)BusContext
;
2183 PC_ASSERT(Controller
);
2184 PC_ASSERT(BusContext
== HubDeviceHandle
);
2187 // now allocate usb device
2189 Status
= CreateUSBDevice(&NewUsbDevice
);
2192 // check for success
2194 if (!NT_SUCCESS(Status
))
2197 // release controller
2199 Controller
->Release();
2200 DPRINT1("USBHI_CreateUsbDevice: failed to create usb device %x\n", Status
);
2205 // now initialize device
2207 Status
= NewUsbDevice
->Initialize(PHUBCONTROLLER(Controller
), Controller
->GetUsbHardware(),PVOID(Controller
), PortNumber
, PortStatus
);
2210 // check for success
2212 if (!NT_SUCCESS(Status
))
2215 // release usb device
2217 NewUsbDevice
->Release();
2218 DPRINT1("USBHI_CreateUsbDevice: failed to initialize usb device %x\n", Status
);
2225 Status
= Controller
->AddUsbDevice(NewUsbDevice
);
2227 // check for success
2229 if (!NT_SUCCESS(Status
))
2232 // release usb device
2234 NewUsbDevice
->Release();
2236 DPRINT1("USBHI_CreateUsbDevice: failed to add usb device %x\n", Status
);
2243 *NewDevice
= NewUsbDevice
;
2248 return STATUS_SUCCESS
;
2253 USBHI_InitializeUsbDevice(
2255 PUSB_DEVICE_HANDLE DeviceHandle
)
2257 PUSBDEVICE UsbDevice
;
2258 CHubController
* Controller
;
2259 ULONG DeviceAddress
;
2263 DPRINT1("USBHI_InitializeUsbDevice\n");
2266 // first get controller
2268 Controller
= (CHubController
*)BusContext
;
2269 PC_ASSERT(Controller
);
2272 // get device object
2274 UsbDevice
= (PUSBDEVICE
)DeviceHandle
;
2275 PC_ASSERT(UsbDevice
);
2278 // validate device handle
2280 if (!Controller
->ValidateUsbDevice(UsbDevice
))
2282 DPRINT1("USBHI_InitializeUsbDevice invalid device handle %p\n", DeviceHandle
);
2285 // invalid device handle
2287 return STATUS_DEVICE_NOT_CONNECTED
;
2291 // now reserve an address
2293 DeviceAddress
= Controller
->AcquireDeviceAddress();
2296 // is the device address valid
2298 if (DeviceAddress
== MAXULONG
)
2301 // failed to get an device address from the device address pool
2303 DPRINT1("USBHI_InitializeUsbDevice failed to get device address\n");
2304 return STATUS_DEVICE_DATA_ERROR
;
2310 // now set the device address
2312 Status
= UsbDevice
->SetDeviceAddress((UCHAR
)DeviceAddress
);
2314 if (NT_SUCCESS(Status
))
2317 }while(Index
++ < 3 );
2320 // check for failure
2322 if (!NT_SUCCESS(Status
))
2325 // failed to set device address
2327 DPRINT1("USBHI_InitializeUsbDevice failed to set address with %x\n", Status
);
2332 Controller
->ReleaseDeviceAddress(DeviceAddress
);
2337 return STATUS_DEVICE_DATA_ERROR
;
2343 return STATUS_SUCCESS
;
2348 USBHI_GetUsbDescriptors(
2350 PUSB_DEVICE_HANDLE DeviceHandle
,
2351 PUCHAR DeviceDescriptorBuffer
,
2352 PULONG DeviceDescriptorBufferLength
,
2353 PUCHAR ConfigDescriptorBuffer
,
2354 PULONG ConfigDescriptorBufferLength
)
2356 PUSBDEVICE UsbDevice
;
2357 CHubController
* Controller
;
2359 DPRINT1("USBHI_GetUsbDescriptors\n");
2364 PC_ASSERT(DeviceDescriptorBuffer
);
2365 PC_ASSERT(DeviceDescriptorBufferLength
);
2366 PC_ASSERT(*DeviceDescriptorBufferLength
>= sizeof(USB_DEVICE_DESCRIPTOR
));
2367 PC_ASSERT(ConfigDescriptorBufferLength
);
2368 PC_ASSERT(*ConfigDescriptorBufferLength
>= sizeof(USB_CONFIGURATION_DESCRIPTOR
));
2371 // first get controller
2373 Controller
= (CHubController
*)BusContext
;
2374 PC_ASSERT(Controller
);
2378 // get device object
2380 UsbDevice
= (PUSBDEVICE
)DeviceHandle
;
2381 PC_ASSERT(UsbDevice
);
2384 // validate device handle
2386 if (!Controller
->ValidateUsbDevice(UsbDevice
))
2388 DPRINT1("USBHI_GetUsbDescriptors invalid device handle %p\n", DeviceHandle
);
2391 // invalid device handle
2393 return STATUS_DEVICE_NOT_CONNECTED
;
2397 // get device descriptor
2399 UsbDevice
->GetDeviceDescriptor((PUSB_DEVICE_DESCRIPTOR
)DeviceDescriptorBuffer
);
2402 // store result length
2404 *DeviceDescriptorBufferLength
= sizeof(USB_DEVICE_DESCRIPTOR
);
2407 // get configuration descriptor
2409 UsbDevice
->GetConfigurationDescriptors((PUSB_CONFIGURATION_DESCRIPTOR
)ConfigDescriptorBuffer
, *ConfigDescriptorBufferLength
, ConfigDescriptorBufferLength
);
2412 // complete the request
2414 return STATUS_SUCCESS
;
2419 USBHI_RemoveUsbDevice(
2421 PUSB_DEVICE_HANDLE DeviceHandle
,
2424 PUSBDEVICE UsbDevice
;
2425 CHubController
* Controller
;
2428 DPRINT1("USBHI_RemoveUsbDevice\n");
2431 // first get controller
2433 Controller
= (CHubController
*)BusContext
;
2434 PC_ASSERT(Controller
);
2437 // get device object
2439 UsbDevice
= (PUSBDEVICE
)DeviceHandle
;
2440 PC_ASSERT(UsbDevice
);
2443 // validate device handle
2445 if (!Controller
->ValidateUsbDevice(UsbDevice
))
2447 DPRINT1("USBHI_RemoveUsbDevice invalid device handle %p\n", DeviceHandle
);
2450 // invalid device handle
2452 return STATUS_DEVICE_NOT_CONNECTED
;
2456 // check if there were flags passed
2458 if (Flags
& USBD_KEEP_DEVICE_DATA
|| Flags
& USBD_MARK_DEVICE_BUSY
)
2461 // ignore flags for now
2463 return STATUS_SUCCESS
;
2469 Status
= Controller
->RemoveUsbDevice(UsbDevice
);
2470 if (!NT_SUCCESS(Status
))
2473 // invalid device handle
2475 DPRINT1("USBHI_RemoveUsbDevice Invalid device handle %p\n", UsbDevice
);
2477 return STATUS_DEVICE_NOT_CONNECTED
;
2481 // release usb device
2483 UsbDevice
->Release();
2488 return STATUS_SUCCESS
;
2493 USBHI_RestoreUsbDevice(
2495 PUSB_DEVICE_HANDLE OldDeviceHandle
,
2496 PUSB_DEVICE_HANDLE NewDeviceHandle
)
2498 PUSBDEVICE OldUsbDevice
, NewUsbDevice
;
2499 CHubController
* Controller
;
2501 DPRINT1("USBHI_RestoreUsbDevice\n");
2504 // first get controller
2506 Controller
= (CHubController
*)BusContext
;
2507 PC_ASSERT(Controller
);
2510 // get device object
2512 OldUsbDevice
= (PUSBDEVICE
)OldDeviceHandle
;
2513 NewUsbDevice
= (PUSBDEVICE
)NewDeviceHandle
;
2514 PC_ASSERT(OldUsbDevice
);
2515 PC_ASSERT(NewDeviceHandle
);
2518 // validate device handle
2520 PC_ASSERT(Controller
->ValidateUsbDevice(NewUsbDevice
));
2521 PC_ASSERT(Controller
->ValidateUsbDevice(OldUsbDevice
));
2523 DPRINT1("NewUsbDevice: DeviceAddress %x\n", NewUsbDevice
->GetDeviceAddress());
2524 DPRINT1("OldUsbDevice: DeviceAddress %x\n", OldUsbDevice
->GetDeviceAddress());
2527 // remove old device handle
2529 USBHI_RemoveUsbDevice(BusContext
, OldDeviceHandle
, 0);
2531 return STATUS_SUCCESS
;
2536 USBHI_QueryDeviceInformation(
2538 PUSB_DEVICE_HANDLE DeviceHandle
,
2539 PVOID DeviceInformationBuffer
,
2540 ULONG DeviceInformationBufferLength
,
2541 PULONG LengthReturned
)
2543 PUSB_DEVICE_INFORMATION_0 DeviceInfo
;
2544 PUSBDEVICE UsbDevice
;
2545 CHubController
* Controller
;
2547 DPRINT1("USBHI_QueryDeviceInformation %p\n", BusContext
);
2552 PC_ASSERT(DeviceInformationBufferLength
>= sizeof(USB_DEVICE_INFORMATION_0
));
2553 PC_ASSERT(DeviceInformationBuffer
);
2554 PC_ASSERT(LengthReturned
);
2557 // get controller object
2559 Controller
= (CHubController
*)BusContext
;
2560 PC_ASSERT(Controller
);
2563 // get device object
2565 UsbDevice
= (PUSBDEVICE
)DeviceHandle
;
2566 PC_ASSERT(UsbDevice
);
2568 if (BusContext
!= DeviceHandle
)
2571 // validate device handle
2573 if (!Controller
->ValidateUsbDevice(UsbDevice
))
2575 DPRINT1("USBHI_QueryDeviceInformation invalid device handle %p\n", DeviceHandle
);
2578 // invalid device handle
2580 return STATUS_DEVICE_NOT_CONNECTED
;
2584 // access information buffer
2586 DeviceInfo
= (PUSB_DEVICE_INFORMATION_0
)DeviceInformationBuffer
;
2589 // initialize with default values
2591 DeviceInfo
->InformationLevel
= 0;
2592 DeviceInfo
->ActualLength
= sizeof(USB_DEVICE_INFORMATION_0
);
2593 DeviceInfo
->PortNumber
= UsbDevice
->GetPort();
2594 DeviceInfo
->CurrentConfigurationValue
= UsbDevice
->GetConfigurationValue();
2595 DeviceInfo
->DeviceAddress
= UsbDevice
->GetDeviceAddress();
2596 DeviceInfo
->HubAddress
= 0; //FIXME
2597 DeviceInfo
->DeviceSpeed
= UsbDevice
->GetSpeed();
2598 DeviceInfo
->DeviceType
= UsbDevice
->GetType();
2599 DeviceInfo
->NumberOfOpenPipes
= 0; //FIXME
2602 // get device descriptor
2604 UsbDevice
->GetDeviceDescriptor(&DeviceInfo
->DeviceDescriptor
);
2607 // FIXME return pipe information
2611 // store result length
2613 *LengthReturned
= sizeof(USB_DEVICE_INFORMATION_0
);
2615 return STATUS_SUCCESS
;
2619 // access information buffer
2621 DeviceInfo
= (PUSB_DEVICE_INFORMATION_0
)DeviceInformationBuffer
;
2624 // initialize with default values
2626 DeviceInfo
->InformationLevel
= 0;
2627 DeviceInfo
->ActualLength
= sizeof(USB_DEVICE_INFORMATION_0
);
2628 DeviceInfo
->PortNumber
= 0;
2629 DeviceInfo
->CurrentConfigurationValue
= 0; //FIXME;
2630 DeviceInfo
->DeviceAddress
= 0;
2631 DeviceInfo
->HubAddress
= 0; //FIXME
2632 DeviceInfo
->DeviceSpeed
= UsbHighSpeed
; //FIXME
2633 DeviceInfo
->DeviceType
= Usb20Device
; //FIXME
2634 DeviceInfo
->NumberOfOpenPipes
= 0; //FIXME
2637 // get device descriptor
2639 RtlMoveMemory(&DeviceInfo
->DeviceDescriptor
, ROOTHUB2_DEVICE_DESCRIPTOR
, sizeof(USB_DEVICE_DESCRIPTOR
));
2642 // FIXME return pipe information
2646 // store result length
2649 *LengthReturned
= FIELD_OFFSET(USB_DEVICE_INFORMATION_0
, PipeList
[DeviceInfo
->NumberOfOpenPipes
]);
2651 *LengthReturned
= sizeof(USB_DEVICE_INFORMATION_0
) + (DeviceInfo
->NumberOfOpenPipes
> 1 ? (DeviceInfo
->NumberOfOpenPipes
- 1) * sizeof(USB_PIPE_INFORMATION_0
) : 0);
2656 return STATUS_SUCCESS
;
2661 USBHI_GetControllerInformation(
2663 PVOID ControllerInformationBuffer
,
2664 ULONG ControllerInformationBufferLength
,
2665 PULONG LengthReturned
)
2667 PUSB_CONTROLLER_INFORMATION_0 ControllerInfo
;
2669 DPRINT1("USBHI_GetControllerInformation\n");
2674 PC_ASSERT(ControllerInformationBuffer
);
2675 PC_ASSERT(ControllerInformationBufferLength
>= sizeof(USB_CONTROLLER_INFORMATION_0
));
2678 // get controller info buffer
2680 ControllerInfo
= (PUSB_CONTROLLER_INFORMATION_0
)ControllerInformationBuffer
;
2683 // FIXME only version 0 is supported for now
2685 PC_ASSERT(ControllerInfo
->InformationLevel
== 0);
2688 // fill in information
2690 ControllerInfo
->ActualLength
= sizeof(USB_CONTROLLER_INFORMATION_0
);
2691 ControllerInfo
->SelectiveSuspendEnabled
= FALSE
; //FIXME
2692 ControllerInfo
->IsHighSpeedController
= TRUE
;
2695 // set length returned
2697 *LengthReturned
= ControllerInfo
->ActualLength
;
2702 return STATUS_SUCCESS
;
2707 USBHI_ControllerSelectiveSuspend(
2712 return STATUS_NOT_IMPLEMENTED
;
2717 USBHI_GetExtendedHubInformation(
2719 PDEVICE_OBJECT HubPhysicalDeviceObject
,
2720 PVOID HubInformationBuffer
,
2721 ULONG HubInformationBufferLength
,
2722 PULONG LengthReturned
)
2724 PUSB_EXTHUB_INFORMATION_0 HubInfo
;
2725 CHubController
* Controller
;
2726 PUSBHARDWAREDEVICE Hardware
;
2728 ULONG NumPort
, Dummy2
;
2732 DPRINT1("USBHI_GetExtendedHubInformation\n");
2737 PC_ASSERT(HubInformationBuffer
);
2738 PC_ASSERT(HubInformationBufferLength
== sizeof(USB_EXTHUB_INFORMATION_0
));
2739 PC_ASSERT(LengthReturned
);
2742 // get hub controller
2744 Controller
= (CHubController
*)BusContext
;
2745 PC_ASSERT(Controller
);
2748 // get usb hardware device
2750 Hardware
= Controller
->GetUsbHardware();
2753 // retrieve number of ports
2755 Status
= Hardware
->GetDeviceDetails(&Dummy1
, &Dummy1
, &NumPort
, &Dummy2
);
2756 if (!NT_SUCCESS(Status
))
2759 // failed to get hardware details, ouch ;)
2761 DPRINT1("USBHI_GetExtendedHubInformation failed to get hardware details with %x\n", Status
);
2766 // get hub information buffer
2768 HubInfo
= (PUSB_EXTHUB_INFORMATION_0
)HubInformationBuffer
;
2771 // initialize hub information
2773 HubInfo
->InformationLevel
= 0;
2778 HubInfo
->NumberOfPorts
= NumPort
;
2781 // initialize port information
2783 for(Index
= 0; Index
< NumPort
; Index
++)
2785 HubInfo
->Port
[Index
].PhysicalPortNumber
= Index
+ 1;
2786 HubInfo
->Port
[Index
].PortLabelNumber
= Index
+ 1;
2787 HubInfo
->Port
[Index
].VidOverride
= 0;
2788 HubInfo
->Port
[Index
].PidOverride
= 0;
2789 HubInfo
->Port
[Index
].PortAttributes
= USB_PORTATTR_SHARED_USB2
; //FIXME
2793 // store result length
2796 *LengthReturned
= FIELD_OFFSET(USB_EXTHUB_INFORMATION_0
, Port
[HubInfo
->NumberOfPorts
]);
2798 *LengthReturned
= FIELD_OFFSET(USB_EXTHUB_INFORMATION_0
, Port
) + sizeof(USB_EXTPORT_INFORMATION_0
) * HubInfo
->NumberOfPorts
;
2804 return STATUS_SUCCESS
;
2809 USBHI_GetRootHubSymbolicName(
2811 PVOID HubSymNameBuffer
,
2812 ULONG HubSymNameBufferLength
,
2813 PULONG HubSymNameActualLength
)
2816 return STATUS_NOT_IMPLEMENTED
;
2821 USBHI_GetDeviceBusContext(
2822 PVOID HubBusContext
,
2831 USBHI_Initialize20Hub(
2833 PUSB_DEVICE_HANDLE HubDeviceHandle
,
2836 DPRINT("USBHI_Initialize20Hub HubDeviceHandle %p UNIMPLEMENTED TtCount %lu\n", HubDeviceHandle
, TtCount
);
2837 return STATUS_SUCCESS
;
2842 USBHI_RootHubInitNotification(
2844 PVOID CallbackContext
,
2845 PRH_INIT_CALLBACK CallbackRoutine
)
2847 CHubController
* Controller
;
2849 DPRINT("USBHI_RootHubInitNotification %p \n", CallbackContext
);
2852 // get controller object
2854 Controller
= (CHubController
*)BusContext
;
2855 PC_ASSERT(Controller
);
2858 // set notification routine
2860 Controller
->SetNotification(CallbackContext
, CallbackRoutine
);
2863 // FIXME: determine when to perform callback
2865 CallbackRoutine(CallbackContext
);
2870 return STATUS_SUCCESS
;
2875 USBHI_FlushTransfers(
2884 USBHI_SetDeviceHandleData(
2887 PDEVICE_OBJECT UsbDevicePdo
)
2889 PUSBDEVICE UsbDevice
;
2890 CHubController
* Controller
;
2895 Controller
= (CHubController
*)BusContext
;
2896 PC_ASSERT(Controller
);
2899 // get device handle
2901 UsbDevice
= (PUSBDEVICE
)DeviceHandle
;
2904 // validate device handle
2906 if (!Controller
->ValidateUsbDevice(UsbDevice
))
2908 DPRINT1("USBHI_SetDeviceHandleData DeviceHandle %p is invalid\n", DeviceHandle
);
2918 // usbhub sends this request as a part of the Pnp startup sequence
2919 // looks like we need apply a dragon voodoo to fixup the device stack
2920 // otherwise usbhub will cause a bugcheck
2922 DPRINT1("USBHI_SetDeviceHandleData %p\n", UsbDevicePdo
);
2927 PC_ASSERT(UsbDevicePdo
->AttachedDevice
);
2930 // should be usbstor
2931 // fixup device stack voodoo part #2
2933 UsbDevicePdo
->AttachedDevice
->StackSize
++;
2936 // set device handle data
2938 UsbDevice
->SetDeviceHandleData(UsbDevicePdo
);
2942 //=================================================================================================
2944 // USB Device Interface functions
2949 USBDI_GetUSBDIVersion(
2951 PUSBD_VERSION_INFORMATION VersionInformation
,
2952 PULONG HcdCapabilites
)
2954 CHubController
* Controller
;
2955 PUSBHARDWAREDEVICE Device
;
2956 ULONG Speed
, Dummy2
;
2959 DPRINT1("USBDI_GetUSBDIVersion\n");
2964 Controller
= (CHubController
*)BusContext
;
2969 Device
= Controller
->GetUsbHardware();
2972 if (VersionInformation
)
2975 // windows xp supported
2977 VersionInformation
->USBDI_Version
= 0x00000500;
2982 Device
->GetDeviceDetails(&Dummy1
, &Dummy1
, &Dummy2
, &Speed
);
2985 // store speed details
2987 VersionInformation
->Supported_USB_Version
= Speed
;
2991 // no flags supported
2993 *HcdCapabilites
= 0;
3000 PULONG CurrentFrame
)
3003 return STATUS_NOT_IMPLEMENTED
;
3008 USBDI_SubmitIsoOutUrb(
3013 return STATUS_NOT_IMPLEMENTED
;
3018 USBDI_QueryBusInformation(
3021 PVOID BusInformationBuffer
,
3022 PULONG BusInformationBufferLength
,
3023 PULONG BusInformationActualLength
)
3026 return STATUS_NOT_IMPLEMENTED
;
3031 USBDI_IsDeviceHighSpeed(
3034 CHubController
* Controller
;
3035 PUSBHARDWAREDEVICE Device
;
3036 ULONG Speed
, Dummy2
;
3039 DPRINT1("USBDI_IsDeviceHighSpeed\n");
3044 Controller
= (CHubController
*)BusContext
;
3049 Device
= Controller
->GetUsbHardware();
3055 Device
->GetDeviceDetails(&Dummy1
, &Dummy1
, &Dummy2
, &Speed
);
3058 // USB 2.0 equals 0x200
3060 return (Speed
== 0x200);
3073 return STATUS_NOT_IMPLEMENTED
;
3077 CHubController::HandleQueryInterface(
3078 PIO_STACK_LOCATION IoStack
)
3080 PUSB_BUS_INTERFACE_HUB_V5 InterfaceHub
;
3081 PUSB_BUS_INTERFACE_USBDI_V2 InterfaceDI
;
3082 UNICODE_STRING GuidBuffer
;
3085 if (IsEqualGUIDAligned(*IoStack
->Parameters
.QueryInterface
.InterfaceType
, USB_BUS_INTERFACE_HUB_GUID
))
3088 // get request parameters
3090 InterfaceHub
= (PUSB_BUS_INTERFACE_HUB_V5
)IoStack
->Parameters
.QueryInterface
.Interface
;
3091 InterfaceHub
->Version
= IoStack
->Parameters
.QueryInterface
.Version
;
3096 if (IoStack
->Parameters
.QueryInterface
.Version
>= 6)
3098 DPRINT1("USB_BUS_INTERFACE_HUB_GUID version %x not supported!\n", IoStack
->Parameters
.QueryInterface
.Version
);
3101 // version not supported
3103 return STATUS_NOT_SUPPORTED
;
3107 // Interface version 0
3109 if (IoStack
->Parameters
.QueryInterface
.Version
>= 0)
3111 InterfaceHub
->Size
= IoStack
->Parameters
.QueryInterface
.Size
;
3112 InterfaceHub
->BusContext
= PVOID(this);
3113 InterfaceHub
->InterfaceReference
= USBI_InterfaceReference
;
3114 InterfaceHub
->InterfaceDereference
= USBI_InterfaceDereference
;
3118 // Interface version 1
3120 if (IoStack
->Parameters
.QueryInterface
.Version
>= 1)
3122 InterfaceHub
->CreateUsbDevice
= USBHI_CreateUsbDevice
;
3123 InterfaceHub
->InitializeUsbDevice
= USBHI_InitializeUsbDevice
;
3124 InterfaceHub
->GetUsbDescriptors
= USBHI_GetUsbDescriptors
;
3125 InterfaceHub
->RemoveUsbDevice
= USBHI_RemoveUsbDevice
;
3126 InterfaceHub
->RestoreUsbDevice
= USBHI_RestoreUsbDevice
;
3127 InterfaceHub
->QueryDeviceInformation
= USBHI_QueryDeviceInformation
;
3131 // Interface version 2
3133 if (IoStack
->Parameters
.QueryInterface
.Version
>= 2)
3135 InterfaceHub
->GetControllerInformation
= USBHI_GetControllerInformation
;
3136 InterfaceHub
->ControllerSelectiveSuspend
= USBHI_ControllerSelectiveSuspend
;
3137 InterfaceHub
->GetExtendedHubInformation
= USBHI_GetExtendedHubInformation
;
3138 InterfaceHub
->GetRootHubSymbolicName
= USBHI_GetRootHubSymbolicName
;
3139 InterfaceHub
->GetDeviceBusContext
= USBHI_GetDeviceBusContext
;
3140 InterfaceHub
->Initialize20Hub
= USBHI_Initialize20Hub
;
3145 // Interface version 3
3147 if (IoStack
->Parameters
.QueryInterface
.Version
>= 3)
3149 InterfaceHub
->RootHubInitNotification
= USBHI_RootHubInitNotification
;
3153 // Interface version 4
3155 if (IoStack
->Parameters
.QueryInterface
.Version
>= 4)
3157 InterfaceHub
->FlushTransfers
= USBHI_FlushTransfers
;
3161 // Interface version 5
3163 if (IoStack
->Parameters
.QueryInterface
.Version
>= 5)
3165 InterfaceHub
->SetDeviceHandleData
= USBHI_SetDeviceHandleData
;
3169 // request completed
3171 return STATUS_SUCCESS
;
3173 else if (IsEqualGUIDAligned(*IoStack
->Parameters
.QueryInterface
.InterfaceType
, USB_BUS_INTERFACE_USBDI_GUID
))
3176 // get request parameters
3178 InterfaceDI
= (PUSB_BUS_INTERFACE_USBDI_V2
) IoStack
->Parameters
.QueryInterface
.Interface
;
3179 InterfaceDI
->Version
= IoStack
->Parameters
.QueryInterface
.Version
;
3184 if (IoStack
->Parameters
.QueryInterface
.Version
>= 3)
3186 DPRINT1("USB_BUS_INTERFACE_USBDI_GUID version %x not supported!\n", IoStack
->Parameters
.QueryInterface
.Version
);
3189 // version not supported
3191 return STATUS_NOT_SUPPORTED
;
3195 // interface version 0
3197 if (IoStack
->Parameters
.QueryInterface
.Version
>= 0)
3199 InterfaceDI
->Size
= IoStack
->Parameters
.QueryInterface
.Size
;
3200 InterfaceDI
->BusContext
= PVOID(this);
3201 InterfaceDI
->InterfaceReference
= USBI_InterfaceReference
;
3202 InterfaceDI
->InterfaceDereference
= USBI_InterfaceDereference
;
3203 InterfaceDI
->GetUSBDIVersion
= USBDI_GetUSBDIVersion
;
3204 InterfaceDI
->QueryBusTime
= USBDI_QueryBusTime
;
3205 InterfaceDI
->SubmitIsoOutUrb
= USBDI_SubmitIsoOutUrb
;
3206 InterfaceDI
->QueryBusInformation
= USBDI_QueryBusInformation
;
3210 // interface version 1
3212 if (IoStack
->Parameters
.QueryInterface
.Version
>= 1)
3214 InterfaceDI
->IsDeviceHighSpeed
= USBDI_IsDeviceHighSpeed
;
3218 // interface version 2
3220 if (IoStack
->Parameters
.QueryInterface
.Version
>= 2)
3222 InterfaceDI
->EnumLogEntry
= USBDI_EnumLogEntry
;
3226 // request completed
3228 return STATUS_SUCCESS
;
3233 // convert guid to string
3235 Status
= RtlStringFromGUID(*IoStack
->Parameters
.QueryInterface
.InterfaceType
, &GuidBuffer
);
3236 if (NT_SUCCESS(Status
))
3241 DPRINT1("HandleQueryInterface UNKNOWN INTERFACE GUID: %wZ Version %x\n", &GuidBuffer
, IoStack
->Parameters
.QueryInterface
.Version
);
3246 RtlFreeUnicodeString(&GuidBuffer
);
3249 return STATUS_NOT_SUPPORTED
;
3253 CHubController::SetDeviceInterface(
3256 NTSTATUS Status
= STATUS_SUCCESS
;
3261 // register device interface
3263 Status
= IoRegisterDeviceInterface(m_HubControllerDeviceObject
, &GUID_DEVINTERFACE_USB_HUB
, 0, &m_HubDeviceInterfaceString
);
3265 if (NT_SUCCESS(Status
))
3268 // now enable the device interface
3270 Status
= IoSetDeviceInterfaceState(&m_HubDeviceInterfaceString
, TRUE
);
3275 m_InterfaceEnabled
= TRUE
;
3278 else if (m_InterfaceEnabled
)
3281 // disable device interface
3283 Status
= IoSetDeviceInterfaceState(&m_HubDeviceInterfaceString
, FALSE
);
3285 if (NT_SUCCESS(Status
))
3288 // now delete interface string
3290 RtlFreeUnicodeString(&m_HubDeviceInterfaceString
);
3294 // disable interface
3296 m_InterfaceEnabled
= FALSE
;
3302 return STATUS_SUCCESS
;
3306 CHubController::CreatePDO(
3307 PDRIVER_OBJECT DriverObject
,
3308 PDEVICE_OBJECT
* OutDeviceObject
)
3310 WCHAR CharDeviceName
[64];
3312 ULONG UsbDeviceNumber
= 0;
3313 UNICODE_STRING DeviceName
;
3318 // construct device name
3320 swprintf(CharDeviceName
, L
"\\Device\\USBPDO-%d", UsbDeviceNumber
);
3323 // initialize device name
3325 RtlInitUnicodeString(&DeviceName
, CharDeviceName
);
3330 Status
= IoCreateDevice(DriverObject
,
3331 sizeof(COMMON_DEVICE_EXTENSION
),
3333 FILE_DEVICE_CONTROLLER
,
3338 /* check for success */
3339 if (NT_SUCCESS(Status
))
3343 // is there a device object with that same name
3345 if ((Status
== STATUS_OBJECT_NAME_EXISTS
) || (Status
== STATUS_OBJECT_NAME_COLLISION
))
3348 // Try the next name
3355 // bail out on other errors
3357 if (!NT_SUCCESS(Status
))
3359 DPRINT1("CreatePDO: Failed to create %wZ, Status %x\n", &DeviceName
, Status
);
3364 DPRINT1("CHubController::CreatePDO: DeviceName %wZ\n", &DeviceName
);
3367 // fixup device stack voodoo part #1
3369 (*OutDeviceObject
)->StackSize
++;
3378 CreateHubController(
3379 PHUBCONTROLLER
*OutHcdController
)
3381 PHUBCONTROLLER This
;
3384 // allocate controller
3386 This
= new(NonPagedPool
, TAG_USBEHCI
) CHubController(0);
3390 // failed to allocate
3392 return STATUS_INSUFFICIENT_RESOURCES
;
3396 // add reference count
3403 *OutHcdController
= (PHUBCONTROLLER
)This
;
3408 return STATUS_SUCCESS
;
3411 VOID
StatusChangeEndpointCallBack(PVOID Context
)
3413 CHubController
* This
;
3415 This
= (CHubController
*)Context
;
3419 Irp
= This
->m_PendingSCEIrp
;
3422 DPRINT1("There was no pending IRP for SCE. Did the usb hub 2.0 driver (usbhub2) load?\n");
3426 This
->m_PendingSCEIrp
= NULL
;
3427 This
->QueryStatusChageEndpoint(Irp
);
3429 Irp
->IoStatus
.Status
= STATUS_SUCCESS
;
3430 Irp
->IoStatus
.Information
= 0;
3432 IoCompleteRequest(Irp
, IO_NO_INCREMENT
);