rom/usb/pciusbhc/ohci/dev.c

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