Modules/USB - Cleanup and sorting, added hub code to build
[tpg/acess2.git] / Modules / USB / Core / usb.c
index ca86a2b..ae80a11 100644 (file)
@@ -1,30 +1,27 @@
 /*
- * Acess 2 USB Stack
+ * Acess2 USB Stack
  * - By John Hodge (thePowersGang)
  *
  * usb.c
- * - USB Packet Control
+ * - USB Structure
  */
 #define DEBUG  1
 #include <acess.h>
 #include <vfs.h>
 #include <drv_pci.h>
 #include "usb.h"
-#include "usb_proto.h"
-#include "usb_lowlevel.h"
 
 // === IMPORTS ===
 extern tUSBHost        *gUSB_Hosts;
+extern tUSBDriver gUSBHub_Driver;
 
 // === STRUCTURES ===
 
 // === PROTOTYPES ===
 tUSBHub        *USB_RegisterHost(tUSBHostDef *HostDef, void *ControllerPtr, int nPorts);
-void   USB_DeviceConnected(tUSBHub *Hub, int Port);
-void   USB_DeviceDisconnected(tUSBHub *Hub, int Port);
-void   *USB_GetDeviceDataPtr(tUSBInterface *Dev);
-void   USB_SetDeviceDataPtr(tUSBInterface *Dev, void *Ptr);
- int   USB_int_AllocateAddress(tUSBHost *Host);
+
+// === GLOBALS ===
+tUSBDriver     *gUSB_InterfaceDrivers = &gUSBHub_Driver;
 
 // === CODE ===
 tUSBHub *USB_RegisterHost(tUSBHostDef *HostDef, void *ControllerPtr, int nPorts)
@@ -61,174 +58,33 @@ tUSBHub *USB_RegisterHost(tUSBHostDef *HostDef, void *ControllerPtr, int nPorts)
        return &host->RootHub;
 }
 
-void USB_DeviceConnected(tUSBHub *Hub, int Port)
+void USB_RegisterDriver(tUSBDriver *Driver)
 {
-       tUSBDevice      *dev;
-       if( Port >= Hub->nPorts )       return ;
-       if( Hub->Devices[Port] )        return ;
-
-       ENTER("pHub iPort", Hub, Port);
-
-       // 0. Perform port init? (done in hub?) 
-       
-       // Create structure
-       dev = malloc(sizeof(tUSBDevice));
-       dev->ParentHub = Hub;
-       dev->Host = Hub->Interface->Dev->Host;
-       dev->Address = 0;
-
-       // 1. Assign an address
-       dev->Address = USB_int_AllocateAddress(dev->Host);
-       if(dev->Address == 0) {
-               Log_Error("USB", "No addresses avaliable on host %p", dev->Host);
-               free(dev);
-               LEAVE('-');
-               return ;
-       }
-       USB_int_SendSetupSetAddress(dev->Host, dev->Address);
-       LOG("Assigned address %i", dev->Address);
-       
-       // 2. Get device information
-       {
-               struct sDescriptor_Device       desc;
-               LOG("Getting device descriptor");
-               // Endpoint 0, Desc Type 1, Index 0
-               USB_int_ReadDescriptor(dev, 0, 1, 0, sizeof(desc), &desc);
-               
-               LOG("Device Descriptor = {");
-               LOG(" .Length = %i", desc.Length);
-               LOG(" .Type = %i", desc.Type);
-               LOG(" .USBVersion = 0x%04x", desc.USBVersion);
-               LOG(" .DeviceClass = 0x%02x", desc.DeviceClass);
-               LOG(" .DeviceSubClass = 0x%02x", desc.DeviceSubClass);
-               LOG(" .DeviceProtocol = 0x%02x", desc.DeviceProtocol);
-               LOG(" .MaxPacketSize = 0x%02x", desc.MaxPacketSize);
-               LOG(" .VendorID = 0x%04x", desc.VendorID);
-               LOG(" .ProductID = 0x%04x", desc.ProductID);
-               LOG(" .DeviceID = 0x%04x", desc.DeviceID);
-               LOG(" .ManufacturerStr = Str %i", desc.ManufacturerStr);
-               LOG(" .ProductStr = Str %i", desc.ProductStr);
-               LOG(" .SerialNumberStr = Str %i", desc.SerialNumberStr);
-               LOG(" .NumConfigurations = %i", desc.SerialNumberStr);
-               LOG("}");
-               
-               if( desc.ManufacturerStr )
-               {
-                       char    *tmp = USB_int_GetDeviceString(dev, 0, desc.ManufacturerStr);
-                       LOG("ManufacturerStr = '%s'", tmp);
-                       free(tmp);
-               }
-               if( desc.ProductStr )
-               {
-                       char    *tmp = USB_int_GetDeviceString(dev, 0, desc.ProductStr);
-                       LOG("ProductStr = '%s'", tmp);
-                       free(tmp);
-               }
-               if( desc.SerialNumberStr )
-               {
-                       char    *tmp = USB_int_GetDeviceString(dev, 0, desc.SerialNumberStr);
-                       LOG("SerialNumbertStr = '%s'", tmp);
-                       free(tmp);
-               }
-       }
-       
-       // 3. Get configurations
-       for( int i = 0; i < 1; i ++ )
-       {
-               struct sDescriptor_Configuration        desc;
-               void    *full_buf;
-               char    *cur_ptr;
-               
-               USB_int_ReadDescriptor(dev, 0, 2, i, sizeof(desc), &desc);
-               LOG("Configuration Descriptor %i = {", i);
-               LOG(" .Length = %i", desc.Length);
-               LOG(" .Type = %i", desc.Type);
-               LOG(" .TotalLength = 0x%x", LittleEndian16(desc.TotalLength));
-               LOG(" .NumInterfaces = %i", desc.NumInterfaces);
-               LOG(" .ConfigurationValue = %i", desc.ConfigurationValue);
-               LOG(" .ConfigurationStr = %i", desc.ConfigurationStr);
-               LOG(" .AttributesBmp = 0b%b", desc.AttributesBmp);
-               LOG(" .MaxPower = %i (*2mA)", desc.MaxPower);
-               LOG("}");
-               if( desc.ConfigurationStr ) {
-                       char    *tmp = USB_int_GetDeviceString(dev, 0, desc.ConfigurationStr);
-                       LOG("ConfigurationStr = '%s'", tmp);
-                       free(tmp);
-               }
-
-               cur_ptr = full_buf = malloc( LittleEndian16(desc.TotalLength) );
-               USB_int_ReadDescriptor(dev, 0, 2, i, desc.TotalLength, full_buf);
-
-               cur_ptr += desc.Length;
-
-               // TODO: Interfaces
-               for( int j = 0; j < desc.NumInterfaces; j ++ )
-               {
-                       struct sDescriptor_Interface *iface;
-                       iface = (void*)cur_ptr;
-                       // TODO: Sanity check with remaining space
-                       cur_ptr += sizeof(*iface);
-                       
-                       LOG("Interface %i/%i = {", i, j);
-                       LOG(" .InterfaceNum = %i", iface->InterfaceNum);
-                       LOG(" .NumEndpoints = %i", iface->NumEndpoints);
-                       LOG(" .InterfaceClass = 0x%x", iface->InterfaceClass);
-                       LOG(" .InterfaceSubClass = 0x%x", iface->InterfaceSubClass);
-                       LOG(" .InterfaceProcol = 0x%x", iface->InterfaceProtocol);
-
-                       if( iface->InterfaceStr ) {
-                               char    *tmp = USB_int_GetDeviceString(dev, 0, iface->InterfaceStr);
-                               LOG(" .InterfaceStr = %i '%s'", iface->InterfaceStr, tmp);
-                               free(tmp);
-                       }
-                       LOG("}");
-
-                       for( int k = 0; k < iface->NumEndpoints; k ++ )
-                       {
-                               struct sDescriptor_Endpoint *endpt;
-                               endpt = (void*)cur_ptr;
-                               // TODO: Sanity check with remaining space
-                               cur_ptr += sizeof(*endpt);
-                               
-                               LOG("Endpoint %i/%i/%i = {", i, j, k);
-                               LOG(" .Address = 0x%2x", endpt->Address);
-                               LOG(" .Attributes = 0b%8b", endpt->Attributes);
-                               LOG(" .MaxPacketSize = %i", LittleEndian16(endpt->MaxPacketSize));
-                               LOG(" .PollingInterval = %i", endpt->PollingInterval);
-                               LOG("}");
-                       }
-               }
-               
-               free(full_buf);
-       }
-
-       // Done.
-       LEAVE('-');
+       Log_Warning("USB", "TODO: Implement USB_RegisterDriver");
 }
 
-void USB_DeviceDisconnected(tUSBHub *Hub, int Port)
+// --- Hub Registration ---
+// NOTE: Doesn't do much nowdays
+tUSBHub *USB_RegisterHub(tUSBInterface *Device, int PortCount)
 {
+       tUSBHub *ret;
        
+       ret = malloc(sizeof(tUSBHub) + sizeof(ret->Devices[0])*PortCount);
+       ret->Interface = Device;
+       ret->nPorts = PortCount;
+       memset(ret->Devices, 0, sizeof(ret->Devices[0])*PortCount);
+       return ret;
 }
 
-void *USB_GetDeviceDataPtr(tUSBInterface *Dev) { return Dev->Data; }
-void USB_SetDeviceDataPtr(tUSBInterface *Dev, void *Ptr) { Dev->Data = Ptr; }
-
-int USB_int_AllocateAddress(tUSBHost *Host)
+void USB_RemoveHub(tUSBHub *Hub)
 {
-        int    i;
-       for( i = 1; i < 128; i ++ )
+       for( int i = 0; i < Hub->nPorts; i ++ )
        {
-               if(Host->AddressBitmap[i/8] & (1 << (i%8)))
-                       continue ;
-               Host->AddressBitmap[i/8] |= 1 << (i%8);
-               return i;
+               if( Hub->Devices[i] )
+               {
+                       USB_DeviceDisconnected( Hub, i );
+               }
        }
-       return 0;
-}
-
-void USB_int_DeallocateAddress(tUSBHost *Host, int Address)
-{
-       Host->AddressBitmap[Address/8] &= ~(1 << (Address%8));
+       free(Hub);
 }
 

UCC git Repository :: git.ucc.asn.au