3 * - By John Hodge (thePowersGang)
6 * - USB Device Initialisation
14 #include "usb_proto.h"
15 #include "usb_lowlevel.h"
18 void USB_DeviceConnected(tUSBHub *Hub, int Port);
19 void USB_DeviceDisconnected(tUSBHub *Hub, int Port);
20 void *USB_GetDeviceDataPtr(tUSBInterface *Dev);
21 void USB_SetDeviceDataPtr(tUSBInterface *Dev, void *Ptr);
22 int USB_int_AllocateAddress(tUSBHost *Host);
25 void USB_DeviceConnected(tUSBHub *Hub, int Port)
28 tUSBDevice *dev = &tmpdev;
29 if( Port >= Hub->nPorts ) return ;
30 if( Hub->Devices[Port] ) return ;
32 ENTER("pHub iPort", Hub, Port);
34 // Device should be in 'Default' state
38 dev->Host = Hub->Interface->Dev->Host;
41 // 1. Assign an address
42 dev->Address = USB_int_AllocateAddress(dev->Host);
43 if(dev->Address == 0) {
44 Log_Error("USB", "No addresses avaliable on host %p", dev->Host);
49 USB_int_SendSetupSetAddress(dev->Host, dev->Address);
50 LOG("Assigned address %i", dev->Address);
52 // 2. Get device information
54 struct sDescriptor_Device desc;
55 LOG("Getting device descriptor");
56 // Endpoint 0, Desc Type 1, Index 0
57 USB_int_ReadDescriptor(dev, 0, 1, 0, sizeof(desc), &desc);
59 LOG("Device Descriptor = {");
60 LOG(" .Length = %i", desc.Length);
61 LOG(" .Type = %i", desc.Type);
62 LOG(" .USBVersion = 0x%04x", desc.USBVersion);
63 LOG(" .DeviceClass = 0x%02x", desc.DeviceClass);
64 LOG(" .DeviceSubClass = 0x%02x", desc.DeviceSubClass);
65 LOG(" .DeviceProtocol = 0x%02x", desc.DeviceProtocol);
66 LOG(" .MaxPacketSize = 0x%02x", desc.MaxPacketSize);
67 LOG(" .VendorID = 0x%04x", desc.VendorID);
68 LOG(" .ProductID = 0x%04x", desc.ProductID);
69 LOG(" .DeviceID = 0x%04x", desc.DeviceID);
70 LOG(" .ManufacturerStr = Str %i", desc.ManufacturerStr);
71 LOG(" .ProductStr = Str %i", desc.ProductStr);
72 LOG(" .SerialNumberStr = Str %i", desc.SerialNumberStr);
73 LOG(" .NumConfigurations = %i", desc.SerialNumberStr);
76 if( desc.ManufacturerStr )
78 char *tmp = USB_int_GetDeviceString(dev, 0, desc.ManufacturerStr);
79 LOG("ManufacturerStr = '%s'", tmp);
84 char *tmp = USB_int_GetDeviceString(dev, 0, desc.ProductStr);
85 LOG("ProductStr = '%s'", tmp);
88 if( desc.SerialNumberStr )
90 char *tmp = USB_int_GetDeviceString(dev, 0, desc.SerialNumberStr);
91 LOG("SerialNumbertStr = '%s'", tmp);
96 // TODO: Support alternate configurations
98 // 3. Get configurations
99 for( int i = 0; i < 1; i ++ )
101 struct sDescriptor_Configuration desc;
105 USB_int_ReadDescriptor(dev, 0, 2, i, sizeof(desc), &desc);
106 LOG("Configuration Descriptor %i = {", i);
107 LOG(" .Length = %i", desc.Length);
108 LOG(" .Type = %i", desc.Type);
109 LOG(" .TotalLength = 0x%x", LittleEndian16(desc.TotalLength));
110 LOG(" .NumInterfaces = %i", desc.NumInterfaces);
111 LOG(" .ConfigurationValue = %i", desc.ConfigurationValue);
112 LOG(" .ConfigurationStr = %i", desc.ConfigurationStr);
113 LOG(" .AttributesBmp = 0b%b", desc.AttributesBmp);
114 LOG(" .MaxPower = %i (*2mA)", desc.MaxPower);
116 if( desc.ConfigurationStr ) {
117 char *tmp = USB_int_GetDeviceString(dev, 0, desc.ConfigurationStr);
118 LOG("ConfigurationStr = '%s'", tmp);
122 // TODO: Split here and allow some method of selection
124 // Allocate device now that we have the configuration
125 dev = malloc(sizeof(tUSBDevice) + desc.NumInterfaces * sizeof(void*));
126 memcpy(dev, &tmpdev, sizeof(tUSBDevice));
127 dev->nInterfaces = desc.NumInterfaces;
129 // Allocate a temp buffer for config info
130 cur_ptr = full_buf = malloc( LittleEndian16(desc.TotalLength) );
131 USB_int_ReadDescriptor(dev, 0, 2, i, desc.TotalLength, full_buf);
133 cur_ptr += desc.Length;
136 for( int j = 0; j < desc.NumInterfaces; j ++ )
138 struct sDescriptor_Interface *iface;
139 tUSBInterface *dev_if;
140 iface = (void*)cur_ptr;
141 // TODO: Sanity check with remaining space
142 cur_ptr += sizeof(*iface);
144 LOG("Interface %i/%i = {", i, j);
145 LOG(" .InterfaceNum = %i", iface->InterfaceNum);
146 LOG(" .NumEndpoints = %i", iface->NumEndpoints);
147 LOG(" .InterfaceClass = 0x%x", iface->InterfaceClass);
148 LOG(" .InterfaceSubClass = 0x%x", iface->InterfaceSubClass);
149 LOG(" .InterfaceProcol = 0x%x", iface->InterfaceProtocol);
151 if( iface->InterfaceStr ) {
152 char *tmp = USB_int_GetDeviceString(dev, 0, iface->InterfaceStr);
153 LOG(" .InterfaceStr = %i '%s'", iface->InterfaceStr, tmp);
158 dev_if = malloc(sizeof(tUSBInterface) + iface->NumEndpoints*sizeof(dev_if->Endpoints[0]));
160 dev_if->Driver = NULL;
162 dev_if->nEndpoints = iface->NumEndpoints;
163 dev->Interfaces[j] = dev_if;
165 // Copy interface data
166 for( int k = 0; k < iface->NumEndpoints; k ++ )
168 struct sDescriptor_Endpoint *endpt;
169 endpt = (void*)cur_ptr;
170 // TODO: Sanity check with remaining space
171 cur_ptr += sizeof(*endpt);
173 LOG("Endpoint %i/%i/%i = {", i, j, k);
174 LOG(" .Address = 0x%2x", endpt->Address);
175 LOG(" .Attributes = 0b%8b", endpt->Attributes);
176 LOG(" .MaxPacketSize = %i", LittleEndian16(endpt->MaxPacketSize));
177 LOG(" .PollingInterval = %i", endpt->PollingInterval);
180 dev_if->Endpoints[k].Next = NULL;
181 dev_if->Endpoints[k].Interface = dev_if;
182 dev_if->Endpoints[k].EndpointIdx = k;
183 dev_if->Endpoints[k].EndpointNum = endpt->Address & 0x7F;
184 dev_if->Endpoints[k].PollingPeriod = endpt->PollingInterval;
185 dev_if->Endpoints[k].MaxPacketSize = LittleEndian16(endpt->MaxPacketSize);
186 dev_if->Endpoints[k].Type = endpt->Attributes | (endpt->Address & 0x80);
187 dev_if->Endpoints[k].PollingAtoms = 0;
188 dev_if->Endpoints[k].InputData = NULL;
192 dev_if->Driver = USB_int_FindDriverByClass(
193 ((int)iface->InterfaceClass << 16)
194 |((int)iface->InterfaceSubClass << 8)
195 |((int)iface->InterfaceProtocol << 0)
197 if(!dev_if->Driver) {
198 Log_Notice("USB", "No driver for Class %02x:%02x:%02x",
199 iface->InterfaceClass, iface->InterfaceSubClass, iface->InterfaceProtocol
203 dev_if->Driver->Connected( dev_if );
214 void USB_DeviceDisconnected(tUSBHub *Hub, int Port)
219 void *USB_GetDeviceDataPtr(tUSBInterface *Dev) { return Dev->Data; }
220 void USB_SetDeviceDataPtr(tUSBInterface *Dev, void *Ptr) { Dev->Data = Ptr; }
222 int USB_int_AllocateAddress(tUSBHost *Host)
225 for( i = 1; i < 128; i ++ )
227 if(Host->AddressBitmap[i/8] & (1 << (i%8)))
229 Host->AddressBitmap[i/8] |= 1 << (i%8);
235 void USB_int_DeallocateAddress(tUSBHost *Host, int Address)
237 Host->AddressBitmap[Address/8] &= ~(1 << (Address%8));