Sweden-Number/dlls/usbd.sys/usbd.c

238 lines
10 KiB
C
Raw Normal View History

2010-03-18 08:30:43 +01:00
/*
* Copyright (C) 2010 Damjan Jovanovic
*
* This library is free software; you can redistribute it and/or
* modify it under the terms of the GNU Lesser General Public
* License as published by the Free Software Foundation; either
* version 2.1 of the License, or (at your option) any later version.
*
* This library is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
* Lesser General Public License for more details.
*
* You should have received a copy of the GNU Lesser General Public
* License along with this library; if not, write to the Free Software
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA
*/
#include <stdarg.h>
#define NONAMELESSUNION
#define NONAMELESSSTRUCT
#include "ntstatus.h"
#define WIN32_NO_STATUS
#include "windef.h"
#include "winbase.h"
#include "winternl.h"
#include "ddk/wdm.h"
#include "ddk/usb.h"
#include "ddk/usbdlib.h"
2010-03-18 08:30:43 +01:00
#include "wine/debug.h"
WINE_DEFAULT_DEBUG_CHANNEL(usbd);
PURB WINAPI USBD_CreateConfigurationRequest(
PUSB_CONFIGURATION_DESCRIPTOR ConfigurationDescriptor, PUSHORT Siz )
{
URB *urb = NULL;
USBD_INTERFACE_LIST_ENTRY *interfaceList;
ULONG interfaceListSize;
USB_INTERFACE_DESCRIPTOR *interfaceDesc;
int i;
TRACE( "(%p, %p)\n", ConfigurationDescriptor, Siz );
/* http://www.microsoft.com/whdc/archive/usbfaq.mspx
* claims USBD_CreateConfigurationRequest doesn't support > 1 interface,
* but is this on Windows 98 only or all versions?
*/
*Siz = 0;
interfaceListSize = (ConfigurationDescriptor->bNumInterfaces + 1) * sizeof(USBD_INTERFACE_LIST_ENTRY);
interfaceList = ExAllocatePool( NonPagedPool, interfaceListSize );
if (interfaceList)
{
RtlZeroMemory( interfaceList, interfaceListSize );
interfaceDesc = (PUSB_INTERFACE_DESCRIPTOR) USBD_ParseDescriptors(
ConfigurationDescriptor, ConfigurationDescriptor->wTotalLength,
ConfigurationDescriptor, USB_INTERFACE_DESCRIPTOR_TYPE );
for (i = 0; i < ConfigurationDescriptor->bNumInterfaces && interfaceDesc != NULL; i++)
{
interfaceList[i].InterfaceDescriptor = interfaceDesc;
interfaceDesc = (PUSB_INTERFACE_DESCRIPTOR) USBD_ParseDescriptors(
ConfigurationDescriptor, ConfigurationDescriptor->wTotalLength,
interfaceDesc + 1, USB_INTERFACE_DESCRIPTOR_TYPE );
}
urb = USBD_CreateConfigurationRequestEx( ConfigurationDescriptor, interfaceList );
if (urb)
*Siz = urb->u.UrbHeader.Length;
ExFreePool( interfaceList );
}
return urb;
}
PURB WINAPI USBD_CreateConfigurationRequestEx(
PUSB_CONFIGURATION_DESCRIPTOR ConfigurationDescriptor,
PUSBD_INTERFACE_LIST_ENTRY InterfaceList )
{
URB *urb;
ULONG size = 0;
USBD_INTERFACE_LIST_ENTRY *interfaceEntry;
ULONG interfaceCount = 0;
TRACE( "(%p, %p)\n", ConfigurationDescriptor, InterfaceList );
size = sizeof(struct _URB_SELECT_CONFIGURATION);
for (interfaceEntry = InterfaceList; interfaceEntry->InterfaceDescriptor; interfaceEntry++)
{
++interfaceCount;
size += (interfaceEntry->InterfaceDescriptor->bNumEndpoints - 1) *
sizeof(USBD_PIPE_INFORMATION);
}
size += (interfaceCount - 1) * sizeof(USBD_INTERFACE_INFORMATION);
urb = ExAllocatePool( NonPagedPool, size );
if (urb)
{
USBD_INTERFACE_INFORMATION *interfaceInfo;
RtlZeroMemory( urb, size );
urb->u.UrbSelectConfiguration.Hdr.Length = size;
urb->u.UrbSelectConfiguration.Hdr.Function = URB_FUNCTION_SELECT_CONFIGURATION;
urb->u.UrbSelectConfiguration.ConfigurationDescriptor = ConfigurationDescriptor;
interfaceInfo = &urb->u.UrbSelectConfiguration.Interface;
for (interfaceEntry = InterfaceList; interfaceEntry->InterfaceDescriptor; interfaceEntry++)
{
int i;
USB_INTERFACE_DESCRIPTOR *currentInterface;
USB_ENDPOINT_DESCRIPTOR *endpointDescriptor;
interfaceInfo->InterfaceNumber = interfaceEntry->InterfaceDescriptor->bInterfaceNumber;
interfaceInfo->AlternateSetting = interfaceEntry->InterfaceDescriptor->bAlternateSetting;
interfaceInfo->Class = interfaceEntry->InterfaceDescriptor->bInterfaceClass;
interfaceInfo->SubClass = interfaceEntry->InterfaceDescriptor->bInterfaceSubClass;
interfaceInfo->Protocol = interfaceEntry->InterfaceDescriptor->bInterfaceProtocol;
interfaceInfo->NumberOfPipes = interfaceEntry->InterfaceDescriptor->bNumEndpoints;
currentInterface = USBD_ParseConfigurationDescriptorEx(
ConfigurationDescriptor, ConfigurationDescriptor,
interfaceEntry->InterfaceDescriptor->bInterfaceNumber, -1, -1, -1, -1 );
endpointDescriptor = (PUSB_ENDPOINT_DESCRIPTOR) USBD_ParseDescriptors(
ConfigurationDescriptor, ConfigurationDescriptor->wTotalLength,
currentInterface, USB_ENDPOINT_DESCRIPTOR_TYPE );
for (i = 0; i < interfaceInfo->NumberOfPipes && endpointDescriptor; i++)
{
interfaceInfo->Pipes[i].MaximumPacketSize = endpointDescriptor->wMaxPacketSize;
interfaceInfo->Pipes[i].EndpointAddress = endpointDescriptor->bEndpointAddress;
interfaceInfo->Pipes[i].Interval = endpointDescriptor->bInterval;
if (endpointDescriptor->bmAttributes & USB_ENDPOINT_TYPE_CONTROL)
interfaceInfo->Pipes[i].PipeType = UsbdPipeTypeControl;
else if (endpointDescriptor->bmAttributes & USB_ENDPOINT_TYPE_BULK)
interfaceInfo->Pipes[i].PipeType = UsbdPipeTypeBulk;
else if (endpointDescriptor->bmAttributes & USB_ENDPOINT_TYPE_INTERRUPT)
interfaceInfo->Pipes[i].PipeType = UsbdPipeTypeInterrupt;
else if (endpointDescriptor->bmAttributes & USB_ENDPOINT_TYPE_ISOCHRONOUS)
interfaceInfo->Pipes[i].PipeType = UsbdPipeTypeIsochronous;
endpointDescriptor = (PUSB_ENDPOINT_DESCRIPTOR) USBD_ParseDescriptors(
ConfigurationDescriptor, ConfigurationDescriptor->wTotalLength,
endpointDescriptor + 1, USB_ENDPOINT_DESCRIPTOR_TYPE );
}
interfaceInfo->Length = sizeof(USBD_INTERFACE_INFORMATION) +
(i - 1) * sizeof(USBD_PIPE_INFORMATION);
interfaceEntry->Interface = interfaceInfo;
interfaceInfo = (USBD_INTERFACE_INFORMATION*)(((char*)interfaceInfo)+interfaceInfo->Length);
}
}
return urb;
}
VOID WINAPI USBD_GetUSBDIVersion(
PUSBD_VERSION_INFORMATION VersionInformation )
{
TRACE( "(%p)\n", VersionInformation );
/* Emulate Windows 2000 (= 0x300) for now */
VersionInformation->USBDI_Version = 0x300;
VersionInformation->Supported_USB_Version = 0x200;
}
PUSB_INTERFACE_DESCRIPTOR WINAPI USBD_ParseConfigurationDescriptorEx(
PUSB_CONFIGURATION_DESCRIPTOR ConfigurationDescriptor,
PVOID StartPosition, LONG InterfaceNumber,
LONG AlternateSetting, LONG InterfaceClass,
LONG InterfaceSubClass, LONG InterfaceProtocol )
{
/* http://blogs.msdn.com/usbcoreblog/archive/2009/12/12/
* what-is-the-right-way-to-validate-and-parse-configuration-descriptors.aspx
*/
PUSB_INTERFACE_DESCRIPTOR interface;
TRACE( "(%p, %p, %d, %d, %d, %d, %d)\n", ConfigurationDescriptor,
StartPosition, InterfaceNumber, AlternateSetting,
InterfaceClass, InterfaceSubClass, InterfaceProtocol );
interface = (PUSB_INTERFACE_DESCRIPTOR) USBD_ParseDescriptors(
ConfigurationDescriptor, ConfigurationDescriptor->wTotalLength,
StartPosition, USB_INTERFACE_DESCRIPTOR_TYPE );
while (interface != NULL)
{
if ((InterfaceNumber == -1 || interface->bInterfaceNumber == InterfaceNumber) &&
(AlternateSetting == -1 || interface->bAlternateSetting == AlternateSetting) &&
(InterfaceClass == -1 || interface->bInterfaceClass == InterfaceClass) &&
(InterfaceSubClass == -1 || interface->bInterfaceSubClass == InterfaceSubClass) &&
(InterfaceProtocol == -1 || interface->bInterfaceProtocol == InterfaceProtocol))
{
return interface;
}
interface = (PUSB_INTERFACE_DESCRIPTOR) USBD_ParseDescriptors(
ConfigurationDescriptor, ConfigurationDescriptor->wTotalLength,
interface + 1, USB_INTERFACE_DESCRIPTOR_TYPE );
}
return NULL;
}
PUSB_COMMON_DESCRIPTOR WINAPI USBD_ParseDescriptors(
PVOID DescriptorBuffer,
ULONG TotalLength,
PVOID StartPosition,
LONG DescriptorType )
{
PUSB_COMMON_DESCRIPTOR common;
TRACE( "(%p, %u, %p, %d)\n", DescriptorBuffer, TotalLength, StartPosition, DescriptorType );
for (common = (PUSB_COMMON_DESCRIPTOR)DescriptorBuffer;
((char*)common) + sizeof(USB_COMMON_DESCRIPTOR) <= ((char*)DescriptorBuffer) + TotalLength;
common = (PUSB_COMMON_DESCRIPTOR)(((char*)common) + common->bLength))
{
if (StartPosition <= (PVOID)common && common->bDescriptorType == DescriptorType)
return common;
}
return NULL;
}
ULONG WINAPI USBD_GetInterfaceLength(
PUSB_INTERFACE_DESCRIPTOR InterfaceDescriptor,
PUCHAR BufferEnd )
{
PUSB_COMMON_DESCRIPTOR common;
ULONG total = InterfaceDescriptor->bLength;
TRACE( "(%p, %p)\n", InterfaceDescriptor, BufferEnd );
for (common = (PUSB_COMMON_DESCRIPTOR)(InterfaceDescriptor + 1);
(((PUCHAR)common) + sizeof(USB_COMMON_DESCRIPTOR)) <= BufferEnd &&
common->bDescriptorType != USB_INTERFACE_DESCRIPTOR_TYPE;
common = (PUSB_COMMON_DESCRIPTOR)(((char*)common) + common->bLength))
{
total += common->bLength;
}
return total;
}
2010-03-18 08:30:43 +01:00
NTSTATUS WINAPI DriverEntry( DRIVER_OBJECT *driver, UNICODE_STRING *path )
{
TRACE( "(%p, %s)\n", driver, debugstr_w(path->Buffer) );
return STATUS_SUCCESS;
}