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

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