arch/arm-native/soc/broadcom/283x/usb/usb2otg/usb2otg_intr.c

   1 /*
   2     Copyright © 2013-2015, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #define DEBUG 0
   7 #include <aros/debug.h>
   8
   9 #include <proto/exec.h>
  10 #include <proto/kernel.h>
  11 #include <proto/utility.h>
  12
  13 #include "usb2otg_intern.h"
  14
  15 AROS_INTH1(FNAME_DEV(PendingInt), struct USB2OTGUnit *, otg_Unit)
  16 {
  17     AROS_INTFUNC_INIT
  18
  19    D(bug("[USB2OTG] ## Pending Work Interupt\n"));
  20
  21     /* **************** PROCESS DONE TRANSFERS **************** */
  22
  23     FNAME_ROOTHUB(PendingIO)(otg_Unit);
  24
  25 //    uhciHandleFinishedTDs(otg_Unit);
  26
  27     if (otg_Unit->hu_CtrlXFerQueue.lh_Head->ln_Succ)
  28     {
  29 //        uhciScheduleCtrlTDs(otg_Unit);
  30     }
  31
  32     if (otg_Unit->hu_IntXFerQueue.lh_Head->ln_Succ)
  33     {
  34 //        uhciScheduleIntTDs(otg_Unit);
  35     }
  36
  37     if (otg_Unit->hu_BulkXFerQueue.lh_Head->ln_Succ)
  38     {
  39 //        uhciScheduleBulkTDs(otg_Unit);
  40     }
  41
  42     D(bug("[USB2OTG] ## Pending Work Processed\n"));
  43
  44     return FALSE;
  45
  46     AROS_INTFUNC_EXIT
  47 }
  48
  49 AROS_INTH1(FNAME_DEV(NakTimeoutInt), struct USB2OTGUnit *, otg_Unit)
  50 {
  51     AROS_INTFUNC_INIT
  52
  53     struct IOUsbHWReq *ioreq;
  54
  55    D(bug("[USB2OTG] ## NakTimeout Interupt\n"));
  56
  57 //    ULONG framecnt;
  58 //    uhciUpdateFrameCounter(hc);
  59 //    framecnt = hc->hc_FrameCounter;
  60 #if (0)
  61     ioreq = (struct IOUsbHWReq *) otg_Unit->hu_TDQueue.lh_Head;
  62     while(((struct Node *) ioreq)->ln_Succ)
  63     {
  64         if(ioreq->iouh_Flags & UHFF_NAKTIMEOUT)
  65         {
  66 /*            uqh = (struct UhciQH *) ioreq->iouh_DriverPrivate1;
  67             if(uqh)
  68             {
  69                 KPRINTF(1, ("Examining IOReq=%p with UQH=%p\n", ioreq, uqh));
  70                 devadrep = (ioreq->iouh_DevAddr<<5) + ioreq->iouh_Endpoint + ((ioreq->iouh_Dir == UHDIR_IN) ? 0x10 : 0);
  71                 linkelem = READMEM32_LE(&uqh->uqh_Element);
  72                 if(linkelem & UHCI_TERMINATE)
  73                 {
  74                     KPRINTF(1, ("UQH terminated %08lx\n", linkelem));
  75                     if(framecnt > unit->hu_NakTimeoutFrame[devadrep])
  76                     {
  77                         // give the thing the chance to exit gracefully
  78                         KPRINTF(20, ("Terminated? NAK timeout %ld > %ld, IOReq=%p\n", framecnt, unit->hu_NakTimeoutFrame[devadrep], ioreq));
  79                         causeint = TRUE;
  80                     }
  81                 } else {
  82                     utd = (struct UhciTD *) (((IPTR)linkelem & UHCI_PTRMASK) - hc->hc_PCIVirtualAdjust - 16); // struct UhciTD starts 16 before physical TD
  83                     ctrlstatus = READMEM32_LE(&utd->utd_CtrlStatus);
  84                     if(ctrlstatus & UTCF_ACTIVE)
  85                     {
  86                         if(framecnt > unit->hu_NakTimeoutFrame[devadrep])
  87                         {
  88                             // give the thing the chance to exit gracefully
  89                             KPRINTF(20, ("NAK timeout %ld > %ld, IOReq=%p\n", framecnt, unit->hu_NakTimeoutFrame[devadrep], ioreq));
  90                             ctrlstatus &= ~UTCF_ACTIVE;
  91                             WRITEMEM32_LE(&utd->utd_CtrlStatus, ctrlstatus);
  92                             causeint = TRUE;
  93                         }
  94                     } else {
  95                         if(framecnt > unit->hu_NakTimeoutFrame[devadrep])
  96                         {
  97                             // give the thing the chance to exit gracefully
  98                             KPRINTF(20, ("Terminated? NAK timeout %ld > %ld, IOReq=%p\n", framecnt, unit->hu_NakTimeoutFrame[devadrep], ioreq));
  99                             causeint = TRUE;
 100                         }
 101                     }
 102                 }
 103             }*/
 104         }
 105         ioreq = (struct IOUsbHWReq *) ((struct Node *) ioreq)->ln_Succ;
 106     }
 107
 108 //    uhciCheckPortStatusChange(hc);
 109 #endif
 110     FNAME_ROOTHUB(PendingIO)(otg_Unit);
 111
 112     otg_Unit->hu_NakTimeoutReq.tr_time.tv_micro = 150 * 1000;
 113     SendIO((APTR) &otg_Unit->hu_NakTimeoutReq);
 114
 115     D(bug("[USB2OTG] ## NakTimeout Processed\n"));
 116
 117     return FALSE;
 118
 119     AROS_INTFUNC_EXIT
 120 }