KernelLand/Modules/USB/Core/usb_io.c

   1 /*
   2  * Acess2 USB Stack
   3  * - By John Hodge (thePowersGang)
   4  *
   5  * usb_io.c
   6  * - High-level IO
   7  */
   8 #define DEBUG   0
   9
  10 #include <usb_core.h>
  11 #include "usb.h"
  12 #include "usb_lowlevel.h"
  13 #include <workqueue.h>
  14 #include <events.h>
  15 #include "usb_async.h"
  16
  17 // === PROTOTYPES ===
  18 void    USB_ReadDescriptor(tUSBInterface *Iface, int Type, int Index, int Length, void *Data);
  19 void    USB_Request(tUSBInterface *Iface, int Endpoint, int Type, int Req, int Value, int Index, int Len, void *Data);
  20 void    USB_SendData(tUSBInterface *Dev, int Endpoint, size_t Length, const void *Data);
  21 void    USB_WakeCallback(void *Ptr, void *Buf, size_t Length);
  22 void    USB_AsyncCallback(void *Ptr, void *Buf, size_t Length);
  23 void    USB_AsyncThread(void *unused);
  24
  25 // === GLOBALS ===
  26 tWorkqueue      gUSB_AsyncQueue;
  27
  28 // === CODE ===
  29 void USB_ReadDescriptor(tUSBInterface *Iface, int Type, int Index, int Length, void *Data)
  30 {
  31         USB_int_ReadDescriptor(Iface->Dev, 0, Type, Index, Length, Data);
  32 }
  33
  34 void USB_Request(tUSBInterface *Iface, int Endpoint, int Type, int Req, int Value, int Index, int Len, void *Data)
  35 {
  36          int    endpt;
  37
  38         // Sanity check
  39         if(Endpoint < 0 || Endpoint >= Iface->nEndpoints)
  40                 return ;
  41
  42         // Get endpoint number
  43         if(Endpoint)
  44                 endpt = Iface->Endpoints[Endpoint-1].EndpointNum;
  45         else
  46                 endpt = 0;
  47
  48         USB_int_Request(Iface->Dev->Host, Iface->Dev->Address, endpt, Type, Req, Value, Index, Len, Data);
  49 }
  50
  51
  52 void USB_SendData(tUSBInterface *Dev, int Endpoint, size_t Length, const void *Data)
  53 {
  54         tUSBHost *host;
  55         tUSBEndpoint    *ep;
  56         void    *dest_hdl = (void*)(Dev->Dev->Address*16 + Dev->Endpoints[Endpoint-1].EndpointNum + 1);
  57         ENTER("pDev iEndpoint iLength pData", Dev, Endpoint, Length, Data);
  58
  59         ep = &Dev->Endpoints[Endpoint-1];
  60         host = Dev->Dev->Host;
  61
  62         Threads_ClearEvent(THREAD_EVENT_SHORTWAIT);
  63         host->HostDef->SendBulk(host->Ptr, dest_hdl, USB_WakeCallback, Proc_GetCurThread(), 1, (void*)Data, Length);
  64         Threads_WaitEvents(THREAD_EVENT_SHORTWAIT);
  65
  66         LEAVE('-');
  67 }
  68
  69 void USB_RecvData(tUSBInterface *Dev, int Endpoint, size_t Length, void *Data)
  70 {
  71         tUSBHost *host;
  72         tUSBEndpoint    *ep;
  73         void    *dest_hdl = (void*)(Dev->Dev->Address*16 + Dev->Endpoints[Endpoint-1].EndpointNum + 1);
  74         ENTER("pDev iEndpoint iLength pData", Dev, Endpoint, Length, Data);
  75
  76         ep = &Dev->Endpoints[Endpoint-1];
  77         host = Dev->Dev->Host;
  78
  79         Threads_ClearEvent(THREAD_EVENT_SHORTWAIT);
  80         host->HostDef->SendBulk(host->Ptr, dest_hdl, USB_WakeCallback, Proc_GetCurThread(), 0, Data, Length);
  81         Threads_WaitEvents(THREAD_EVENT_SHORTWAIT);
  82
  83         LEAVE('-');
  84 }
  85
  86 void USB_RecvDataA(tUSBInterface *Dev, int Endpoint, size_t Length, void *DataBuf, tUSB_DataCallback Callback)
  87 {
  88         tAsyncOp *op;
  89         tUSBHost *host;
  90         void    *dest_hdl = (void*)(Dev->Dev->Address*16 + Dev->Endpoints[Endpoint-1].EndpointNum + 1);
  91
  92         ENTER("pDev iEndpoint iLength pDataBuf", Dev, Endpoint, Length, DataBuf);
  93
  94         op = malloc(sizeof(*op));
  95         op->Next = NULL;
  96         op->Endpt = &Dev->Endpoints[Endpoint-1];
  97         op->Length = Length;
  98         op->Data = DataBuf;
  99
 100         // TODO: Handle transfers that are larger than one packet
 101         // TODO: Data toggle
 102
 103         host = Dev->Dev->Host;
 104
 105         LOG("IN from %p %i:%i", host->Ptr, Dev->Dev->Address, op->Endpt->EndpointNum);
 106         host->HostDef->SendBulk(host->Ptr, dest_hdl, USB_AsyncCallback, op, 0, DataBuf, Length);
 107
 108         LEAVE('-');
 109
 110 //      Log_Warning("USB", "TODO: Implement USB_RecvDataA");
 111 }
 112
 113 void USB_WakeCallback(void *Ptr, void *Buf, size_t Length)
 114 {
 115         Threads_PostEvent(Ptr, THREAD_EVENT_SHORTWAIT);
 116 }
 117
 118 void USB_AsyncCallback(void *Ptr, void *Buf, size_t Length)
 119 {
 120         tAsyncOp *op = Ptr;
 121         op->Length = Length;
 122         LOG("adding %p to work queue", op);
 123         Workqueue_AddWork(&gUSB_AsyncQueue, op);
 124 }
 125
 126 void USB_AsyncThread(void *Unused)
 127 {
 128         Threads_SetName("USB Async IO Thread");
 129         for(;;)
 130         {
 131                 tAsyncOp *op = Workqueue_GetWork(&gUSB_AsyncQueue);
 132                 tUSBInterface   *iface = op->Endpt->Interface;
 133
 134                 LOG("op = %p", op);
 135
 136                 iface->Driver->Endpoints[op->Endpt->EndpointIdx].DataAvail(
 137                         iface, op->Endpt->EndpointIdx,
 138                         op->Length, op->Data);
 139
 140                 free(op);
 141         }
 142 }
 143