rom/usb/pciusbhc/uhci/dev.c

   1 /* dev.c - pciuhci.device based on work by Chris Hodges */
   2
   3 #include "debug.h"
   4
   5 #include <proto/exec.h>
   6 #include <proto/utility.h>
   7
   8 #include "uhwcmd.h"
   9
  10 static int devInit(LIBBASETYPEPTR base) {
  11     KPRINTF(10, ("devInit base: 0x%p SysBase: 0x%p\n", base, SysBase));
  12
  13     base->hd_MemPool = CreatePool(MEMF_PUBLIC | MEMF_CLEAR | MEMF_SEM_PROTECTED, 16384, 4096);
  14     if(base->hd_MemPool) {
  15         NEWLIST(&base->hd_Units);
  16         KPRINTF(10, ("devInit: Ok\n"));
  17     } else {
  18         KPRINTF(10, ("devInit: CreatePool() failed!\n"));
  19         return FALSE;
  20     }
  21
  22     KPRINTF(10, ("devInit: openCnt = %ld\n", base->hd_Library.lib_OpenCnt));
  23     return TRUE;
  24 }
  25
  26 /*
  27  *===========================================================
  28  * devOpen(ioreq, unit, flags, base)
  29  *===========================================================
  30  *
  31  * This is the the DEV_OPEN function.
  32  *
  33  */
  34 static int devOpen(LIBBASETYPEPTR base, struct IOUsbHWReq *ioreq, ULONG unit, ULONG flags) {
  35     KPRINTF(10, ("devOpen ioreq: 0x%p unit: %ld flags: 0x%08lx base: 0x%p\n",
  36                ioreq, unit, flags, base));
  37
  38     KPRINTF(10, ("devOpen: openCnt = %ld\n", base->hd_Library.lib_OpenCnt));
  39
  40     if(ioreq->iouh_Req.io_Message.mn_Length < sizeof(struct IOUsbHWReq)) {
  41         KPRINTF(20, ("devOpen: invalid MN_LENGTH!\n"));
  42
  43         ioreq->iouh_Req.io_Error = IOERR_BADLENGTH;
  44     } else {
  45         /* Default to open failure. */
  46         ioreq->iouh_Req.io_Error = IOERR_OPENFAIL;
  47
  48         ioreq->iouh_Req.io_Unit = Open_Unit(ioreq, unit, base);
  49         if(!ioreq->iouh_Req.io_Unit)
  50         {
  51             KPRINTF(20, ("devOpen: could not open unit!\n"));
  52         } else {
  53             /* Opended ok! */
  54             ioreq->iouh_Req.io_Message.mn_Node.ln_Type = NT_REPLYMSG;
  55             ioreq->iouh_Req.io_Error                   = 0;
  56
  57             return TRUE;
  58         }
  59     }
  60
  61     return FALSE;
  62 }
  63
  64
  65 /*
  66  *===========================================================
  67  * devClose(ioreq, base)
  68  *===========================================================
  69  *
  70  * This is the the DEV_EXPUNGE function.
  71  *
  72  */
  73
  74 static int devClose(LIBBASETYPEPTR base, struct IOUsbHWReq *ioreq) {
  75     KPRINTF(10, ("devClose ioreq: 0x%p base: 0x%p\n", ioreq, base));
  76
  77     Close_Unit(base, (struct PCIUnit *) ioreq->iouh_Req.io_Unit, ioreq);
  78
  79     ioreq->iouh_Req.io_Unit   = (APTR) -1;
  80     ioreq->iouh_Req.io_Device = (APTR) -1;
  81     return TRUE;
  82 }
  83
  84
  85 static int devExpunge(LIBBASETYPEPTR base) {
  86     pciExpunge(base);
  87
  88     DeletePool(base->hd_MemPool);
  89
  90     return TRUE;
  91 }
  92
  93 ADD2INITLIB(devInit, 0)
  94 ADD2OPENDEV(devOpen, 0)
  95 ADD2CLOSEDEV(devClose, 0)
  96 ADD2EXPUNGELIB(devExpunge, 0)
  97
  98 /*
  99  *===========================================================
 100  * devBeginIO(ioreq, base)
 101  *===========================================================
 102  *
 103  * This is the DEV_BEGINIO vector of the device.
 104  *
 105  */
 106 AROS_LH1(void, devBeginIO,
 107          AROS_LHA(struct IOUsbHWReq *, ioreq, A1),
 108              LIBBASETYPEPTR, base, 5, pciuhci)
 109 {
 110     AROS_LIBFUNC_INIT
 111
 112     struct PCIUnit *unit = (struct PCIUnit *) ioreq->iouh_Req.io_Unit;
 113     WORD ret;
 114
 115     //KPRINTF(1, ("devBeginIO ioreq: 0x%08lx base: 0x%08lx cmd: %lu\n", ioreq, base, ioreq->iouh_Req.io_Command));
 116
 117     ioreq->iouh_Req.io_Message.mn_Node.ln_Type = NT_MESSAGE;
 118     ioreq->iouh_Req.io_Error                   = UHIOERR_NO_ERROR;
 119
 120     if (ioreq->iouh_Req.io_Command < NSCMD_DEVICEQUERY) {
 121         switch (ioreq->iouh_Req.io_Command) {
 122                         case CMD_RESET:
 123                 ret = cmdReset(ioreq, unit, base);
 124                 break;
 125
 126                         case CMD_FLUSH:
 127                 ret = cmdFlush(ioreq, unit, base);
 128                 break;
 129
 130             case UHCMD_QUERYDEVICE:
 131                 ret = cmdQueryDevice(ioreq, unit, base);
 132                 break;
 133
 134                         case UHCMD_USBRESET:
 135                 ret = cmdUsbReset(ioreq, unit, base);
 136                 break;
 137
 138                         case UHCMD_USBRESUME:
 139                 ret = cmdUsbResume(ioreq, unit, base);
 140                 break;
 141
 142                         case UHCMD_USBSUSPEND:
 143                 ret = cmdUsbSuspend(ioreq, unit, base);
 144                 break;
 145
 146                         case UHCMD_USBOPER:
 147                 ret = cmdUsbOper(ioreq, unit, base);
 148                 break;
 149
 150                         case UHCMD_CONTROLXFER:
 151                 ret = cmdControlXFer(ioreq, unit, base);
 152                 break;
 153
 154                         case UHCMD_BULKXFER:
 155                 ret = cmdBulkXFer(ioreq, unit, base);
 156                 break;
 157
 158                         case UHCMD_INTXFER:
 159                 ret = cmdIntXFer(ioreq, unit, base);
 160                 break;
 161
 162                         case UHCMD_ISOXFER:
 163                 ret = cmdIsoXFer(ioreq, unit, base);
 164                 break;
 165
 166             default:
 167                 ret = IOERR_NOCMD;
 168                 break;
 169         }
 170     } else {
 171         switch(ioreq->iouh_Req.io_Command) {
 172             case NSCMD_DEVICEQUERY:
 173                 KPRINTF2(200,("cmdNSDeviceQuery\n"));
 174
 175                 static const UWORD NSDSupported[] = {
 176                     CMD_FLUSH, CMD_RESET,
 177                     UHCMD_QUERYDEVICE,
 178                     UHCMD_USBRESET,
 179                     UHCMD_USBRESUME,
 180                     UHCMD_USBSUSPEND,
 181                     UHCMD_USBOPER,
 182                     UHCMD_CONTROLXFER ,
 183                     UHCMD_ISOXFER,
 184                     UHCMD_INTXFER,
 185                     UHCMD_BULKXFER,
 186                     NSCMD_DEVICEQUERY,
 187                     0
 188                 };
 189
 190                 struct NSDeviceQueryResult *nsdq = (struct NSDeviceQueryResult *)((struct IOStdReq *)(ioreq))->io_Data;
 191                 nsdq->DevQueryFormat    = 0;
 192                 nsdq->SizeAvailable     = sizeof(struct NSDeviceQueryResult);
 193                 nsdq->DeviceType        = NSDEVTYPE_USBHARDWARE;
 194                 nsdq->DeviceSubType     = 0;
 195                 nsdq->SupportedCommands = (UWORD *)NSDSupported;
 196
 197                 ret = RC_OK;
 198
 199                 break;
 200
 201             default:
 202                 ret = IOERR_NOCMD;
 203                 break;
 204         }
 205     }
 206
 207     if(ret != RC_DONTREPLY) {
 208         /* Set error codes */
 209         if (ret != RC_OK) {
 210             ioreq->iouh_Req.io_Error = ret & 0xff;
 211         }
 212         /* Terminate the iorequest */
 213         ioreq->iouh_Req.io_Message.mn_Node.ln_Type = NT_FREEMSG;
 214         /* If not quick I/O, reply the message */
 215         if(!(ioreq->iouh_Req.io_Flags & IOF_QUICK)) {
 216             ReplyMsg(&ioreq->iouh_Req.io_Message);
 217         }
 218     }
 219
 220     AROS_LIBFUNC_EXIT
 221 }
 222
 223 /*
 224  *===========================================================
 225  * devAbortIO(ioreq, base)
 226  *===========================================================
 227  *
 228  * This is the DEV_ABORTIO vector of the device. It abort
 229  * the given iorequest, and set
 230  *
 231  */
 232 AROS_LH1(LONG, devAbortIO,
 233          AROS_LHA(struct IOUsbHWReq *, ioreq, A1),
 234              LIBBASETYPEPTR, base, 6, pciuhci)
 235 {
 236     AROS_LIBFUNC_INIT
 237
 238     KPRINTF(50, ("devAbortIO ioreq: 0x%p, command %ld, status %ld\n", ioreq, ioreq->iouh_Req.io_Command, ioreq->iouh_Req.io_Message.mn_Node.ln_Type));
 239
 240     /* Is it pending? */
 241     if(ioreq->iouh_Req.io_Message.mn_Node.ln_Type == NT_MESSAGE) {
 242         if(cmdAbortIO(ioreq, base)) {
 243             return(0);
 244         }
 245     }
 246     return(-1);
 247
 248     AROS_LIBFUNC_EXIT
 249 }
 250