3 * - By John Hodge (thePowersGang)
6 * - USB Device Initialisation
13 #include "usb_proto.h"
14 #include "usb_lowlevel.h"
16 #define DUMP_DESCRIPTORS 1
19 void USB_DeviceConnected(tUSBHub *Hub, int Port);
20 void USB_DeviceDisconnected(tUSBHub *Hub, int Port);
21 void *USB_GetDeviceDataPtr(tUSBInterface *Dev);
22 void USB_SetDeviceDataPtr(tUSBInterface *Dev, void *Ptr);
23 int USB_int_AllocateAddress(tUSBHost *Host);
26 void USB_DeviceConnected(tUSBHub *Hub, int Port)
29 tUSBDevice *dev = &tmpdev;
30 if( Port >= Hub->nPorts ) return ;
31 if( Hub->Devices[Port] ) return ;
33 ENTER("pHub iPort", Hub, Port);
35 // Device should be in 'Default' state
39 dev->Host = Hub->Interface->Dev->Host;
42 // 1. Assign an address
43 dev->Address = USB_int_AllocateAddress(dev->Host);
44 if(dev->Address == 0) {
45 Log_Error("USB", "No addresses avaliable on host %p", dev->Host);
50 USB_int_SendSetupSetAddress(dev->Host, dev->Address);
51 LOG("Assigned address %i", dev->Address);
53 // 2. Get device information
55 struct sDescriptor_Device desc;
56 LOG("Getting device descriptor");
57 // Endpoint 0, Desc Type 1, Index 0
58 USB_int_ReadDescriptor(dev, 0, 1, 0, sizeof(desc), &desc);
61 LOG("Device Descriptor = {");
62 LOG(" .Length = %i", desc.Length);
63 LOG(" .Type = %i", desc.Type);
64 LOG(" .USBVersion = 0x%04x", desc.USBVersion);
65 LOG(" .DeviceClass = 0x%02x", desc.DeviceClass);
66 LOG(" .DeviceSubClass = 0x%02x", desc.DeviceSubClass);
67 LOG(" .DeviceProtocol = 0x%02x", desc.DeviceProtocol);
68 LOG(" .MaxPacketSize = 0x%02x", desc.MaxPacketSize);
69 LOG(" .VendorID = 0x%04x", desc.VendorID);
70 LOG(" .ProductID = 0x%04x", desc.ProductID);
71 LOG(" .DeviceID = 0x%04x", desc.DeviceID);
72 LOG(" .ManufacturerStr = Str %i", desc.ManufacturerStr);
73 LOG(" .ProductStr = Str %i", desc.ProductStr);
74 LOG(" .SerialNumberStr = Str %i", desc.SerialNumberStr);
75 LOG(" .NumConfigurations = %i", desc.SerialNumberStr);
79 if( desc.ManufacturerStr )
81 char *tmp = USB_int_GetDeviceString(dev, 0, desc.ManufacturerStr);
83 LOG("ManufacturerStr = '%s'", tmp);
89 char *tmp = USB_int_GetDeviceString(dev, 0, desc.ProductStr);
91 LOG("ProductStr = '%s'", tmp);
95 if( desc.SerialNumberStr )
97 char *tmp = USB_int_GetDeviceString(dev, 0, desc.SerialNumberStr);
99 LOG("SerialNumbertStr = '%s'", tmp);
106 memcpy(&dev->DevDesc, &desc, sizeof(desc));
109 // TODO: Support alternate configurations
111 // 3. Get configurations
112 for( int i = 0; i < 1; i ++ )
114 struct sDescriptor_Configuration desc;
119 USB_int_ReadDescriptor(dev, 0, 2, i, sizeof(desc), &desc);
120 // TODO: Check return length? (Do we get a length?)
122 LOG("Configuration Descriptor %i = {", i);
123 LOG(" .Length = %i", desc.Length);
124 LOG(" .Type = %i", desc.Type);
125 LOG(" .TotalLength = 0x%x", LittleEndian16(desc.TotalLength));
126 LOG(" .NumInterfaces = %i", desc.NumInterfaces);
127 LOG(" .ConfigurationValue = %i", desc.ConfigurationValue);
128 LOG(" .ConfigurationStr = %i", desc.ConfigurationStr);
129 LOG(" .AttributesBmp = 0b%b", desc.AttributesBmp);
130 LOG(" .MaxPower = %i (*2mA)", desc.MaxPower);
132 if( desc.ConfigurationStr ) {
133 char *tmp = USB_int_GetDeviceString(dev, 0, desc.ConfigurationStr);
134 LOG("ConfigurationStr = '%s'", tmp);
139 if( desc.NumInterfaces == 0 ) {
140 Log_Notice("USB", "Device does not have any interfaces");
144 // TODO: Split here and allow some method of selection
146 // Allocate device now that we have the configuration
147 dev = malloc(sizeof(tUSBDevice) + desc.NumInterfaces * sizeof(void*));
148 memcpy(dev, &tmpdev, sizeof(tUSBDevice));
149 dev->nInterfaces = desc.NumInterfaces;
151 // Allocate a temp buffer for config info
152 total_length = LittleEndian16(desc.TotalLength);
153 full_buf = malloc( total_length );
154 USB_int_ReadDescriptor(dev, 0, 2, i, total_length, full_buf);
155 ptr_ofs += desc.Length;
159 for( int j = 0; ptr_ofs < total_length && j < desc.NumInterfaces; j ++ )
161 struct sDescriptor_Interface *iface;
162 tUSBInterface *dev_if;
163 size_t iface_base_ofs;
165 iface = (void*)(full_buf + ptr_ofs);
166 if( iface->Length == 0 ) {
167 Log_Warning("USB", "Bad USB descriptor (length = 0)");
170 ptr_ofs += iface->Length;
171 if( ptr_ofs > total_length ) {
175 iface_base_ofs = ptr_ofs;
177 if( iface->Type != 4 ) {
178 LOG("Not an interface (type = %i)", iface->Type);
179 j --; // Counteract j++ in loop
184 LOG("Interface %i/%i = {", i, j);
185 LOG(" .InterfaceNum = %i", iface->InterfaceNum);
186 LOG(" .NumEndpoints = %i", iface->NumEndpoints);
187 LOG(" .InterfaceClass = 0x%x", iface->InterfaceClass);
188 LOG(" .InterfaceSubClass = 0x%x", iface->InterfaceSubClass);
189 LOG(" .InterfaceProcol = 0x%x", iface->InterfaceProtocol);
190 if( iface->InterfaceStr ) {
191 char *tmp = USB_int_GetDeviceString(dev, 0, iface->InterfaceStr);
192 LOG(" .InterfaceStr = %i '%s'", iface->InterfaceStr, tmp);
199 sizeof(tUSBInterface)
200 + iface->NumEndpoints*sizeof(dev_if->Endpoints[0])
203 dev_if->Driver = NULL;
205 dev_if->nEndpoints = iface->NumEndpoints;
206 memcpy(&dev_if->IfaceDesc, iface, sizeof(*iface));
207 dev->Interfaces[j] = dev_if;
209 // Copy interface data
210 for( int k = 0; ptr_ofs < total_length && k < iface->NumEndpoints; k ++ )
212 struct sDescriptor_Endpoint *endpt;
214 endpt = (void*)(full_buf + ptr_ofs);
215 ptr_ofs += endpt->Length;
216 if( ptr_ofs > total_length ) {
222 if( endpt->Type != 5 ) {
224 LOG("Not endpoint, Type = %i", endpt->Type);
229 LOG("Endpoint %i/%i/%i = {", i, j, k);
230 LOG(" .Address = 0x%2x", endpt->Address);
231 LOG(" .Attributes = 0b%8b", endpt->Attributes);
232 LOG(" .MaxPacketSize = %i", LittleEndian16(endpt->MaxPacketSize));
233 LOG(" .PollingInterval = %i", endpt->PollingInterval);
236 dev_if->Endpoints[k].Next = NULL;
237 dev_if->Endpoints[k].Interface = dev_if;
238 dev_if->Endpoints[k].EndpointIdx = k;
239 dev_if->Endpoints[k].EndpointNum = endpt->Address & 0x7F;
240 dev_if->Endpoints[k].PollingPeriod = endpt->PollingInterval;
241 dev_if->Endpoints[k].MaxPacketSize = LittleEndian16(endpt->MaxPacketSize);
242 dev_if->Endpoints[k].Type = endpt->Attributes | (endpt->Address & 0x80);
243 dev_if->Endpoints[k].PollingAtoms = 0;
244 dev_if->Endpoints[k].InputData = NULL;
248 dev_if->Driver = USB_int_FindDriverByClass(
249 ((int)iface->InterfaceClass << 16)
250 |((int)iface->InterfaceSubClass << 8)
251 |((int)iface->InterfaceProtocol << 0)
253 if(!dev_if->Driver) {
254 Log_Notice("USB", "No driver for Class %02x:%02x:%02x",
255 iface->InterfaceClass, iface->InterfaceSubClass, iface->InterfaceProtocol
259 LOG("Driver '%s' in use", dev_if->Driver->Name);
260 dev_if->Driver->Connected(
262 full_buf + iface_base_ofs, ptr_ofs - iface_base_ofs
274 void USB_DeviceDisconnected(tUSBHub *Hub, int Port)
279 void *USB_GetDeviceDataPtr(tUSBInterface *Dev) { return Dev->Data; }
280 void USB_SetDeviceDataPtr(tUSBInterface *Dev, void *Ptr) { Dev->Data = Ptr; }
282 int USB_int_AllocateAddress(tUSBHost *Host)
285 for( i = 1; i < 128; i ++ )
287 if(Host->AddressBitmap[i/8] & (1 << (i%8)))
289 Host->AddressBitmap[i/8] |= 1 << (i%8);
295 void USB_int_DeallocateAddress(tUSBHost *Host, int Address)
297 Host->AddressBitmap[Address/8] &= ~(1 << (Address%8));