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      * devBeginIO(ioreq, base)
 143      *===========================================================
 144      *
 145      * This is the DEV_BEGINIO vector of the device.
 146      *
 147      */
 148     AROS_LH1(void, devBeginIO,
 149     AROS_LHA(struct IOUsbHWReq *, ioreq, A1), LIBBASETYPEPTR, base, 5, ohci)
 150 {
 151     AROS_LIBFUNC_INIT
 152         struct PCIUnit *unit = (struct PCIUnit *)ioreq->iouh_Req.io_Unit;
 153     WORD ret;
 154
 155     ioreq->iouh_Req.io_Message.mn_Node.ln_Type = NT_MESSAGE;
 156     ioreq->iouh_Req.io_Error = UHIOERR_NO_ERROR;
 157
 158     if (ioreq->iouh_Req.io_Command < NSCMD_DEVICEQUERY)
 159     {
 160         switch (ioreq->iouh_Req.io_Command)
 161         {
 162         case CMD_RESET:
 163             ret = cmdReset(ioreq, unit, base);
 164             break;
 165
 166         case CMD_FLUSH:
 167             ret = cmdFlush(ioreq, unit, base);
 168             break;
 169
 170         case UHCMD_QUERYDEVICE:
 171             ret = cmdQueryDevice(ioreq, unit, base);
 172             break;
 173
 174         case UHCMD_USBRESET:
 175             ret = cmdUsbReset(ioreq, unit, base);
 176             break;
 177
 178         case UHCMD_USBRESUME:
 179             ret = cmdUsbResume(ioreq, unit, base);
 180             break;
 181
 182         case UHCMD_USBSUSPEND:
 183             ret = cmdUsbSuspend(ioreq, unit, base);
 184             break;
 185
 186         case UHCMD_USBOPER:
 187             ret = cmdUsbOper(ioreq, unit, base);
 188             break;
 189
 190         case UHCMD_CONTROLXFER:
 191             ret = cmdXFer(ioreq, unit, base);
 192             break;
 193
 194         case UHCMD_BULKXFER:
 195             ret = cmdXFer(ioreq, unit, base);
 196             break;
 197
 198         case UHCMD_INTXFER:
 199             ret = cmdXFer(ioreq, unit, base);
 200             break;
 201
 202         case UHCMD_ISOXFER:
 203             ret = cmdXFer(ioreq, unit, base);
 204             break;
 205
 206         default:
 207             ret = IOERR_NOCMD;
 208             break;
 209         }
 210     }
 211     else
 212     {
 213         switch (ioreq->iouh_Req.io_Command)
 214         {
 215         case NSCMD_DEVICEQUERY:
 216             ret = cmdNSDeviceQuery((struct IOStdReq *)ioreq, unit, base);
 217             break;
 218
 219         default:
 220             ret = IOERR_NOCMD;
 221             break;
 222         }
 223     }
 224
 225     if (ret != RC_DONTREPLY)
 226     {
 227         KPRINTF(1, ("TermIO\n"));
 228         if (ret != RC_OK)
 229         {
 230             /* Set error codes */
 231             ioreq->iouh_Req.io_Error = ret & 0xff;
 232         }
 233         /* Terminate the iorequest */
 234         TermIO(ioreq, base);
 235     }
 236
 237 AROS_LIBFUNC_EXIT}
 238
 239 /*
 240  *===========================================================
 241  * devAbortIO(ioreq, base)
 242  *===========================================================
 243  *
 244  * This is the DEV_ABORTIO vector of the device. It abort
 245  * the given iorequest, and set
 246  *
 247  */
 248 AROS_LH1(LONG, devAbortIO,
 249     AROS_LHA(struct IOUsbHWReq *, ioreq, A1), LIBBASETYPEPTR, base, 6, ohci)
 250 {
 251     AROS_LIBFUNC_INIT
 252         KPRINTF(50, ("devAbortIO ioreq: 0x%p, command %ld, status %ld\n",
 253             ioreq, ioreq->iouh_Req.io_Command,
 254             ioreq->iouh_Req.io_Message.mn_Node.ln_Type));
 255
 256     /* Is it pending? */
 257     if (ioreq->iouh_Req.io_Message.mn_Node.ln_Type == NT_MESSAGE)
 258     {
 259         if (cmdAbortIO(ioreq, base))
 260         {
 261             return 0;
 262         }
 263     }
 264     return -1;
 265
 266 AROS_LIBFUNC_EXIT}