Kernel - Added pointer to IRQ callbacks

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

diff --git a/Modules/USB/Core/usb.c b/Modules/USB/Core/usb.c
index 60bf3f2..60f2ab8 100644 (file)
--- a/Modules/USB/Core/usb.c
+++ b/Modules/USB/Core/usb.c
@@ -10,28 +10,15 @@
 
 
 // === CODE ===
-void USB_MakeToken(void *Buf, int PID, int Addr, int EndP)
+int USB_int_SendSetupSetAddress(tUSBHost *Host, int Address)
 {
-       Uint8   *tok = Buf;
-        int    crc = 0;
+       Uint8   data[8];
+       data[0] = 0;    // bmRequestType
+       data[1] = 5;    // SET_ADDRESS
+       data[2] = Address & 0x7F;       // wValue (low)
+       data[3] = 0;    // wValue (high)
+       data[4] = 0;    // wLength
+       data[6] = 0;    // wLength
        
-       tok[0] = PID & 0xFF;
-       tok[1] = (Addr & 0x7F) | ((EndP&1)<<7);
-       tok[2] = ((EndP >> 1) & 0x7) | crc;
+       Host->SendSETUP(Host, 0, 0, 0, data, 8);
 }
-
-#if 0
-void USB_SendData(int Controller, int Dev, int Endpoint, void *Data, int Length)
-{
-       Uint8   buf[Length+3+2/*?*/];
-       
-       USB_MakeToken(buf, PID_DATA0, Dev, Endpoint);
-       
-       switch(Controller & 0xF00)
-       {
-       case 1: // UHCI
-               UHCI_SendPacket(Controller & 0xFF);
-               break;
-       }
-}
-#endif