Modules/USB - Fiddling with USB

[tpg/acess2.git] / Modules / USB / Core / usb.c

diff --git a/Modules/USB/Core/usb.c b/Modules/USB/Core/usb.c
index de884e4..0b4bc63 100644 (file)
--- a/Modules/USB/Core/usb.c
+++ b/Modules/USB/Core/usb.c
@@ -9,24 +9,90 @@
 #include "usb.h"
 #include "usb_proto.h"
 
+// === IMPORTS ===
+extern tUSBHost        *gUSB_Hosts;
+
 // === 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(tUSBDevice *Dev);
+void   USB_SetDeviceDataPtr(tUSBDevice *Dev, void *Ptr);
+ int   USB_int_AllocateAddress(tUSBHost *Host);
+ int   USB_int_SendSetupSetAddress(tUSBHost *Host, int Address);
+
 // === CODE ===
 tUSBHub *USB_RegisterHost(tUSBHostDef *HostDef, void *ControllerPtr, int nPorts)
 {
-       // TODO:
-       return NULL;
+       tUSBHost        *host;
+       
+       host = malloc(sizeof(tUSBHost) + nPorts*sizeof(void*));
+       if(!host) {
+               // Oh, bugger.
+               return NULL;
+       }
+       host->HostDef = HostDef;
+       host->Ptr = ControllerPtr;
+       memset(host->AddressBitmap, 0, sizeof(host->AddressBitmap));
+
+       host->RootHubDev.Next = NULL;
+       host->RootHubDev.ParentHub = NULL;
+       host->RootHubDev.Host = host;
+       host->RootHubDev.Address = 0;
+       host->RootHubDev.Driver = NULL;
+       host->RootHubDev.Data = NULL;
+
+       host->RootHub.Device = NULL;
+       host->RootHub.CheckPorts = NULL;
+       host->RootHub.nPorts = nPorts;
+       memset(host->RootHub.Devices, 0, sizeof(void*)*nPorts);
+
+       // TODO: Lock
+       host->Next = gUSB_Hosts;
+       gUSB_Hosts = host;
+
+       // Initialise?
+       HostDef->CheckPorts(ControllerPtr);
+       
+       return &host->RootHub;
 }
 
 void USB_DeviceConnected(tUSBHub *Hub, int Port)
 {
+       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->Next = NULL;
+       dev->ParentHub = Hub;
+       dev->Host = Hub->Device->Host;
+       dev->Address = 0;
+       dev->Driver = 0;
+       dev->Data = 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
+
+       // Done.
+       LEAVE('-');
 }
 
 void USB_DeviceDisconnected(tUSBHub *Hub, int Port)
@@ -49,7 +115,7 @@ int USB_int_AllocateAddress(tUSBHost *Host)
        return 0;
 }
 
-int USB_int_SendSetupSetAddress(tUSBHost *Host, void *Ptr, int Address)
+int USB_int_SendSetupSetAddress(tUSBHost *Host, int Address)
 {
        struct sDeviceRequest   req;
        req.ReqType = 0;        // bmRequestType
@@ -59,5 +125,36 @@ int USB_int_SendSetupSetAddress(tUSBHost *Host, void *Ptr, int Address)
        req.Length = 0; // wLength
        
        // Addr 0:0, Data Toggle = 0, no interrupt
-       return Host->HostDef->SendSETUP(Ptr, 0, 0, 0, FALSE, &req, sizeof(req)) == NULL;
+       return Host->HostDef->SendSETUP(Host->Ptr, 0, 0, 0, FALSE, &req, sizeof(req)) == NULL;
+}
+
+int USB_int_ReadDescriptor(tUSBDevice *Dev, int Endpoint, int Type, int Index, int Length, void *Dest)
+{
+       struct sDeviceRequest   req;
+       const int       ciMaxPacketSize = 0x400;
+       req.ReqType = 0x80;
+       req.Request = 6;        // GET_DESCRIPTOR
+       req.Value = ((Type & 0xFF) << 8) | (Index & 0xFF);
+       req.Index = 0;  // TODO: Language ID
+       req.Length = Length;
+       
+       Dev->Host->HostDef->SendSETUP(
+               Dev->Host->Ptr, Dev->Address, Endpoint,
+               0, FALSE,
+               &req, sizeof(req)
+               );
+       
+       while( Length > ciMaxPacketSize )
+       {
+               Dev->Host->HostDef->SendIN(
+                       Dev->Host->Ptr, Dev->Address, Endpoint,
+                       1, FALSE,
+                       Dest, ciMaxPacketSize
+                       );
+               Length -= ciMaxPacketSize;
+       }
+
+       // TODO: Complete and get completion    
+
+       return 0;
 }