Modules/USB/Core/usb_devinit.c

   1 /*
   2  * Acess 2 USB Stack
   3  * - By John Hodge (thePowersGang)
   4  *
   5  * usb_devinit.c
   6  * - USB Device Initialisation
   7  */
   8 #define DEBUG   1
   9
  10 #include <acess.h>
  11 #include <vfs.h>
  12 #include <drv_pci.h>
  13 #include "usb.h"
  14 #include "usb_proto.h"
  15 #include "usb_lowlevel.h"
  16
  17 // === PROTOTYPES ===
  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);
  23
  24 // === CODE ===
  25 void USB_DeviceConnected(tUSBHub *Hub, int Port)
  26 {
  27         tUSBDevice      *dev;
  28         if( Port >= Hub->nPorts )       return ;
  29         if( Hub->Devices[Port] )        return ;
  30
  31         ENTER("pHub iPort", Hub, Port);
  32
  33         // Device should be in 'Default' state
  34
  35         // Create structure
  36         dev = malloc(sizeof(tUSBDevice));
  37         dev->ParentHub = Hub;
  38         dev->Host = Hub->Interface->Dev->Host;
  39         dev->Address = 0;
  40
  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);
  45                 free(dev);
  46                 LEAVE('-');
  47                 return ;
  48         }
  49         USB_int_SendSetupSetAddress(dev->Host, dev->Address);
  50         LOG("Assigned address %i", dev->Address);
  51
  52         // 2. Get device information
  53         {
  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);
  58
  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);
  74                 LOG("}");
  75
  76                 if( desc.ManufacturerStr )
  77                 {
  78                         char    *tmp = USB_int_GetDeviceString(dev, 0, desc.ManufacturerStr);
  79                         LOG("ManufacturerStr = '%s'", tmp);
  80                         free(tmp);
  81                 }
  82                 if( desc.ProductStr )
  83                 {
  84                         char    *tmp = USB_int_GetDeviceString(dev, 0, desc.ProductStr);
  85                         LOG("ProductStr = '%s'", tmp);
  86                         free(tmp);
  87                 }
  88                 if( desc.SerialNumberStr )
  89                 {
  90                         char    *tmp = USB_int_GetDeviceString(dev, 0, desc.SerialNumberStr);
  91                         LOG("SerialNumbertStr = '%s'", tmp);
  92                         free(tmp);
  93                 }
  94         }
  95
  96         // 3. Get configurations
  97         for( int i = 0; i < 1; i ++ )
  98         {
  99                 struct sDescriptor_Configuration        desc;
 100                 void    *full_buf;
 101                 char    *cur_ptr;
 102
 103                 USB_int_ReadDescriptor(dev, 0, 2, i, sizeof(desc), &desc);
 104                 LOG("Configuration Descriptor %i = {", i);
 105                 LOG(" .Length = %i", desc.Length);
 106                 LOG(" .Type = %i", desc.Type);
 107                 LOG(" .TotalLength = 0x%x", LittleEndian16(desc.TotalLength));
 108                 LOG(" .NumInterfaces = %i", desc.NumInterfaces);
 109                 LOG(" .ConfigurationValue = %i", desc.ConfigurationValue);
 110                 LOG(" .ConfigurationStr = %i", desc.ConfigurationStr);
 111                 LOG(" .AttributesBmp = 0b%b", desc.AttributesBmp);
 112                 LOG(" .MaxPower = %i (*2mA)", desc.MaxPower);
 113                 LOG("}");
 114                 if( desc.ConfigurationStr ) {
 115                         char    *tmp = USB_int_GetDeviceString(dev, 0, desc.ConfigurationStr);
 116                         LOG("ConfigurationStr = '%s'", tmp);
 117                         free(tmp);
 118                 }
 119
 120                 cur_ptr = full_buf = malloc( LittleEndian16(desc.TotalLength) );
 121                 USB_int_ReadDescriptor(dev, 0, 2, i, desc.TotalLength, full_buf);
 122
 123                 cur_ptr += desc.Length;
 124
 125                 // TODO: Interfaces
 126                 for( int j = 0; j < desc.NumInterfaces; j ++ )
 127                 {
 128                         struct sDescriptor_Interface *iface;
 129                         iface = (void*)cur_ptr;
 130                         // TODO: Sanity check with remaining space
 131                         cur_ptr += sizeof(*iface);
 132
 133                         LOG("Interface %i/%i = {", i, j);
 134                         LOG(" .InterfaceNum = %i", iface->InterfaceNum);
 135                         LOG(" .NumEndpoints = %i", iface->NumEndpoints);
 136                         LOG(" .InterfaceClass = 0x%x", iface->InterfaceClass);
 137                         LOG(" .InterfaceSubClass = 0x%x", iface->InterfaceSubClass);
 138                         LOG(" .InterfaceProcol = 0x%x", iface->InterfaceProtocol);
 139
 140                         if( iface->InterfaceStr ) {
 141                                 char    *tmp = USB_int_GetDeviceString(dev, 0, iface->InterfaceStr);
 142                                 LOG(" .InterfaceStr = %i '%s'", iface->InterfaceStr, tmp);
 143                                 free(tmp);
 144                         }
 145                         LOG("}");
 146
 147                         for( int k = 0; k < iface->NumEndpoints; k ++ )
 148                         {
 149                                 struct sDescriptor_Endpoint *endpt;
 150                                 endpt = (void*)cur_ptr;
 151                                 // TODO: Sanity check with remaining space
 152                                 cur_ptr += sizeof(*endpt);
 153
 154                                 LOG("Endpoint %i/%i/%i = {", i, j, k);
 155                                 LOG(" .Address = 0x%2x", endpt->Address);
 156                                 LOG(" .Attributes = 0b%8b", endpt->Attributes);
 157                                 LOG(" .MaxPacketSize = %i", LittleEndian16(endpt->MaxPacketSize));
 158                                 LOG(" .PollingInterval = %i", endpt->PollingInterval);
 159                                 LOG("}");
 160                         }
 161                 }
 162
 163                 free(full_buf);
 164         }
 165
 166         // Done.
 167         LEAVE('-');
 168 }
 169
 170 void USB_DeviceDisconnected(tUSBHub *Hub, int Port)
 171 {
 172
 173 }
 174
 175 void *USB_GetDeviceDataPtr(tUSBInterface *Dev) { return Dev->Data; }
 176 void USB_SetDeviceDataPtr(tUSBInterface *Dev, void *Ptr) { Dev->Data = Ptr; }
 177
 178 int USB_int_AllocateAddress(tUSBHost *Host)
 179 {
 180          int    i;
 181         for( i = 1; i < 128; i ++ )
 182         {
 183                 if(Host->AddressBitmap[i/8] & (1 << (i%8)))
 184                         continue ;
 185                 Host->AddressBitmap[i/8] |= 1 << (i%8);
 186                 return i;
 187         }
 188         return 0;
 189 }
 190
 191 void USB_int_DeallocateAddress(tUSBHost *Host, int Address)
 192 {
 193         Host->AddressBitmap[Address/8] &= ~(1 << (Address%8));
 194 }
 195