[mirror_edk2.git] / MdeModulePkg / Bus / Pci / UhciDxe / UhciSched.c

/** @file\r
\r
  The EHCI register operation routines.\r
\r
Copyright (c) 2007 - 2009, Intel Corporation\r
All rights reserved. This program and the accompanying materials\r
are licensed and made available under the terms and conditions of the BSD License\r
which accompanies this distribution.  The full text of the license may be found at\r
http://opensource.org/licenses/bsd-license.php\r
\r
THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r
WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
\r
**/\r
\r
#include "Uhci.h"\r
\r
\r
/**\r
  Create Frame List Structure.\r
\r
  @param  Uhc                    UHCI device.\r
\r
  @retval EFI_OUT_OF_RESOURCES   Can't allocate memory resources.\r
  @retval EFI_UNSUPPORTED        Map memory fail.\r
  @retval EFI_SUCCESS            Success.\r
\r
**/\r
EFI_STATUS\r
UhciInitFrameList (\r
  IN USB_HC_DEV         *Uhc\r
  )\r
{\r
  EFI_PHYSICAL_ADDRESS  MappedAddr;\r
  EFI_STATUS            Status;\r
  VOID                  *Buffer;\r
  VOID                  *Mapping;\r
  UINTN                 Pages;\r
  UINTN                 Bytes;\r
  UINTN                 Index;\r
  UINTN                 Len;\r
  EFI_PHYSICAL_ADDRESS  PhyAddr;\r
\r
  //\r
  // The Frame List is a common buffer that will be\r
  // accessed by both the cpu and the usb bus master\r
  // at the same time. The Frame List ocupies 4K bytes,\r
  // and must be aligned on 4-Kbyte boundaries.\r
  //\r
  Bytes = 4096;\r
  Pages = EFI_SIZE_TO_PAGES (Bytes);\r
\r
  Status = Uhc->PciIo->AllocateBuffer (\r
                         Uhc->PciIo,\r
                         AllocateAnyPages,\r
                         EfiBootServicesData,\r
                         Pages,\r
                         &Buffer,\r
                         0\r
                         );\r
\r
  if (EFI_ERROR (Status)) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  Status = Uhc->PciIo->Map (\r
                         Uhc->PciIo,\r
                         EfiPciIoOperationBusMasterCommonBuffer,\r
                         Buffer,\r
                         &Bytes,\r
                         &MappedAddr,\r
                         &Mapping\r
                         );\r
\r
  if (EFI_ERROR (Status) || (Bytes != 4096)) {\r
    Status = EFI_UNSUPPORTED;\r
    goto ON_ERROR;\r
  }\r
\r
  Uhc->FrameBase           = (UINT32 *) (UINTN) Buffer; // Cpu memory address\r
  Uhc->FrameBasePciMemAddr = (UINT32 *) (UINTN) MappedAddr; // Pci memory address\r
  Uhc->FrameMapping        = Mapping;\r
\r
  //\r
  // Allocate the QH used by sync interrupt/control/bulk transfer.\r
  // FS ctrl/bulk queue head is set to loopback so additional BW\r
  // can be reclaimed. Notice, LS don't support bulk transfer and\r
  // also doesn't support BW reclamation.\r
  //\r
  Uhc->SyncIntQh  = UhciCreateQh (Uhc, 1);\r
  Uhc->CtrlQh     = UhciCreateQh (Uhc, 1);\r
  Uhc->BulkQh     = UhciCreateQh (Uhc, 1);\r
\r
  if ((Uhc->SyncIntQh == NULL) || (Uhc->CtrlQh == NULL) || (Uhc->BulkQh == NULL)) {\r
    Uhc->PciIo->Unmap (Uhc->PciIo, Mapping);\r
    Status = EFI_OUT_OF_RESOURCES;\r
    goto ON_ERROR;\r
  }\r
\r
  //\r
  //                                                +-------------+\r
  //                                                |             |\r
  // Link the three together: SyncIntQh->CtrlQh->BulkQh <---------+\r
  // Each frame entry is linked to this sequence of QH. These QH\r
  // will remain on the schedul, never got removed\r
  //\r
  Len    = sizeof (UHCI_QH_HW);\r
  Status = Uhc->PciIo->Map (\r
                         Uhc->PciIo,\r
                         EfiPciIoOperationBusMasterRead,\r
                         Uhc->CtrlQh,\r
                         &Len,\r
                         &PhyAddr,\r
                         &Mapping\r
                         );\r
  ASSERT (!EFI_ERROR (Status));\r
\r
  Uhc->SyncIntQh->QhHw.HorizonLink  = QH_HLINK (PhyAddr, FALSE);\r
  Uhc->SyncIntQh->NextQh            = Uhc->CtrlQh;\r
\r
  Status = Uhc->PciIo->Map (\r
                         Uhc->PciIo,\r
                         EfiPciIoOperationBusMasterRead,\r
                         Uhc->BulkQh,\r
                         &Len,\r
                         &PhyAddr,\r
                         &Mapping\r
                         );\r
  ASSERT (!EFI_ERROR (Status));\r
\r
  Uhc->CtrlQh->QhHw.HorizonLink     = QH_HLINK (PhyAddr, FALSE);\r
  Uhc->CtrlQh->NextQh               = Uhc->BulkQh;\r
\r
  //\r
  // Some old platform such as Intel's Tiger 4 has a difficult time\r
  // in supporting the full speed bandwidth reclamation in the previous\r
  // mentioned form. Most new platforms don't suffer it.\r
  //\r
  Uhc->BulkQh->QhHw.HorizonLink     = QH_HLINK (PhyAddr, FALSE);\r
\r
  Uhc->BulkQh->NextQh               = NULL;\r
\r
  Len    = sizeof (UHCI_QH_HW);\r
  Status = Uhc->PciIo->Map (\r
                         Uhc->PciIo,\r
                         EfiPciIoOperationBusMasterRead,\r
                         Uhc->SyncIntQh,\r
                         &Len,\r
                         &PhyAddr,\r
                         &Mapping\r
                         );\r
  ASSERT (!EFI_ERROR (Status));\r
\r
  for (Index = 0; Index < UHCI_FRAME_NUM; Index++) {\r
    Uhc->FrameBase[Index] = QH_HLINK (Uhc->SyncIntQh, FALSE);\r
    Uhc->FrameBasePciMemAddr[Index] = QH_HLINK (PhyAddr, FALSE);\r
  }\r
\r
  //\r
  // Tell the Host Controller where the Frame List lies,\r
  // by set the Frame List Base Address Register.\r
  //\r
  UhciSetFrameListBaseAddr (Uhc->PciIo, (VOID *) (Uhc->FrameBasePciMemAddr));\r
  return EFI_SUCCESS;\r
\r
ON_ERROR:\r
  if (Uhc->SyncIntQh != NULL) {\r
    UsbHcFreeMem (Uhc->MemPool, Uhc->SyncIntQh, sizeof (UHCI_QH_SW));\r
  }\r
\r
  if (Uhc->CtrlQh != NULL) {\r
    UsbHcFreeMem (Uhc->MemPool, Uhc->CtrlQh, sizeof (UHCI_QH_SW));\r
  }\r
\r
  if (Uhc->BulkQh != NULL) {\r
    UsbHcFreeMem (Uhc->MemPool, Uhc->BulkQh, sizeof (UHCI_QH_SW));\r
  }\r
\r
  Uhc->PciIo->FreeBuffer (Uhc->PciIo, Pages, Buffer);\r
  return Status;\r
}\r
\r
\r
/**\r
  Destory FrameList buffer.\r
\r
  @param  Uhc                    The UHCI device.\r
\r
**/\r
VOID\r
UhciDestoryFrameList (\r
  IN USB_HC_DEV           *Uhc\r
  )\r
{\r
  //\r
  // Unmap the common buffer for framelist entry,\r
  // and free the common buffer.\r
  // Uhci's frame list occupy 4k memory.\r
  //\r
  Uhc->PciIo->Unmap (Uhc->PciIo, Uhc->FrameMapping);\r
\r
  Uhc->PciIo->FreeBuffer (\r
                Uhc->PciIo,\r
                EFI_SIZE_TO_PAGES (4096),\r
                (VOID *) Uhc->FrameBase\r
                );\r
\r
  if (Uhc->SyncIntQh != NULL) {\r
    UsbHcFreeMem (Uhc->MemPool, Uhc->SyncIntQh, sizeof (UHCI_QH_SW));\r
  }\r
\r
  if (Uhc->CtrlQh != NULL) {\r
    UsbHcFreeMem (Uhc->MemPool, Uhc->CtrlQh, sizeof (UHCI_QH_SW));\r
  }\r
\r
  if (Uhc->BulkQh != NULL) {\r
    UsbHcFreeMem (Uhc->MemPool, Uhc->BulkQh, sizeof (UHCI_QH_SW));\r
  }\r
\r
  Uhc->FrameBase           = NULL;\r
  Uhc->FrameBasePciMemAddr = NULL;\r
  Uhc->SyncIntQh           = NULL;\r
  Uhc->CtrlQh              = NULL;\r
  Uhc->BulkQh              = NULL;\r
}\r
\r
\r
/**\r
  Convert the poll rate to the maxium 2^n that is smaller\r
  than Interval.\r
\r
  @param  Interval               The poll rate to convert.\r
\r
  @return The converted poll rate.\r
\r
**/\r
UINTN\r
UhciConvertPollRate (\r
  IN  UINTN               Interval\r
  )\r
{\r
  UINTN                   BitCount;\r
\r
  ASSERT (Interval != 0);\r
\r
  //\r
  // Find the index (1 based) of the highest non-zero bit\r
  //\r
  BitCount = 0;\r
\r
  while (Interval != 0) {\r
    Interval >>= 1;\r
    BitCount++;\r
  }\r
\r
  return (UINTN)1 << (BitCount - 1);\r
}\r
\r
\r
/**\r
  Link a queue head (for asynchronous interrupt transfer) to\r
  the frame list.\r
\r
  @param  Uhc                    The UHCI device.\r
  @param  Qh                     The queue head to link into.\r
\r
**/\r
VOID\r
UhciLinkQhToFrameList (\r
  USB_HC_DEV              *Uhc,\r
  UHCI_QH_SW              *Qh\r
  )\r
{\r
  UINTN                   Index;\r
  UHCI_QH_SW              *Prev;\r
  UHCI_QH_SW              *Next;\r
  UINTN                   Len;\r
  EFI_PHYSICAL_ADDRESS    PhyAddr;\r
  EFI_PHYSICAL_ADDRESS    QhPciAddr;\r
  VOID*                   Map;\r
  EFI_STATUS              Status;\r
\r
  ASSERT ((Uhc->FrameBase != NULL) && (Qh != NULL));\r
\r
  Len    = sizeof (UHCI_QH_HW);\r
  Status = Uhc->PciIo->Map (\r
                            Uhc->PciIo,\r
                            EfiPciIoOperationBusMasterRead,\r
                            Qh,\r
                            &Len,\r
                            &QhPciAddr,\r
                            &Map\r
                            );\r
  ASSERT (!EFI_ERROR (Status));\r
\r
  for (Index = 0; Index < UHCI_FRAME_NUM; Index += Qh->Interval) {\r
    //\r
    // First QH can't be NULL because we always keep static queue\r
    // heads on the frame list\r
    //\r
    ASSERT (!LINK_TERMINATED (Uhc->FrameBase[Index]));\r
    Next  = UHCI_ADDR (Uhc->FrameBase[Index]);\r
    Prev  = NULL;\r
\r
    //\r
    // Now, insert the queue head (Qh) into this frame:\r
    // 1. Find a queue head with the same poll interval, just insert\r
    //    Qh after this queue head, then we are done.\r
    //\r
    // 2. Find the position to insert the queue head into:\r
    //      Previous head's interval is bigger than Qh's\r
    //      Next head's interval is less than Qh's\r
    //    Then, insert the Qh between then\r
    //\r
    // This method is very much the same as that used by EHCI.\r
    // Because each QH's interval is round down to 2^n, poll\r
    // rate is correct.\r
    //\r
    while (Next->Interval > Qh->Interval) {\r
      Prev  = Next;\r
      Next  = Next->NextQh;\r
      ASSERT (Next != NULL);\r
    }\r
\r
    //\r
    // The entry may have been linked into the frame by early insertation.\r
    // For example: if insert a Qh with Qh.Interval == 4, and there is a Qh\r
    // with Qh.Interval == 8 on the frame. If so, we are done with this frame.\r
    // It isn't necessary to compare all the QH with the same interval to\r
    // Qh. This is because if there is other QH with the same interval, Qh\r
    // should has been inserted after that at FrameBase[0] and at FrameBase[0] it is\r
    // impossible (Next == Qh)\r
    //\r
    if (Next == Qh) {\r
      continue;\r
    }\r
\r
    if (Next->Interval == Qh->Interval) {\r
      //\r
      // If there is a QH with the same interval, it locates at\r
      // FrameBase[0], and we can simply insert it after this QH. We\r
      // are all done.\r
      //\r
      ASSERT ((Index == 0) && (Qh->NextQh == NULL));\r
\r
      Prev                    = Next;\r
      Next                    = Next->NextQh;\r
\r
      Qh->NextQh              = Next;\r
      Prev->NextQh            = Qh;\r
\r
      Qh->QhHw.HorizonLink    = Prev->QhHw.HorizonLink;\r
\r
      Prev->QhHw.HorizonLink  = QH_HLINK (QhPciAddr, FALSE);\r
      break;\r
    }\r
\r
    //\r
    // OK, find the right position, insert it in. If Qh's next\r
    // link has already been set, it is in position. This is\r
    // guarranted by 2^n polling interval.\r
    //\r
    if (Qh->NextQh == NULL) {\r
      Qh->NextQh            = Next;\r
\r
      Len    = sizeof (UHCI_QH_HW);\r
      Status = Uhc->PciIo->Map (\r
                            Uhc->PciIo,\r
                            EfiPciIoOperationBusMasterRead,\r
                            Next,\r
                            &Len,\r
                            &PhyAddr,\r
                            &Map\r
                            );\r
      ASSERT (!EFI_ERROR (Status));\r
\r
      Qh->QhHw.HorizonLink  = QH_HLINK (PhyAddr, FALSE);\r
    }\r
\r
    if (Prev == NULL) {\r
      Uhc->FrameBase[Index]           = QH_HLINK (Qh, FALSE);\r
      Uhc->FrameBasePciMemAddr[Index] = QH_HLINK (QhPciAddr, FALSE);\r
    } else {\r
      Prev->NextQh            = Qh;\r
      Prev->QhHw.HorizonLink  = QH_HLINK (QhPciAddr, FALSE);\r
    }\r
  }\r
}\r
\r
\r
/**\r
  Unlink QH from the frame list is easier: find all\r
  the precedence node, and pointer there next to QhSw's\r
  next.\r
\r
  @param  Uhc                    The UHCI device.\r
  @param  Qh                     The queue head to unlink.\r
\r
**/\r
VOID\r
UhciUnlinkQhFromFrameList (\r
  USB_HC_DEV              *Uhc,\r
  UHCI_QH_SW              *Qh\r
  )\r
{\r
  UINTN                   Index;\r
  UHCI_QH_SW              *Prev;\r
  UHCI_QH_SW              *This;\r
\r
  ASSERT ((Uhc->FrameBase != NULL) && (Qh != NULL));\r
\r
  for (Index = 0; Index < UHCI_FRAME_NUM; Index += Qh->Interval) {\r
    //\r
    // Frame link can't be NULL because we always keep static\r
    // queue heads on the frame list\r
    //\r
    ASSERT (!LINK_TERMINATED (Uhc->FrameBase[Index]));\r
    This  = UHCI_ADDR (Uhc->FrameBase[Index]);\r
    Prev  = NULL;\r
\r
    //\r
    // Walk through the frame's QH list to find the\r
    // queue head to remove\r
    //\r
    while ((This != NULL) && (This != Qh)) {\r
      Prev  = This;\r
      This  = This->NextQh;\r
    }\r
\r
    //\r
    // Qh may have already been unlinked from this frame\r
    // by early action.\r
    //\r
    if (This == NULL) {\r
      continue;\r
    }\r
\r
    if (Prev == NULL) {\r
      //\r
      // Qh is the first entry in the frame\r
      //\r
      Uhc->FrameBase[Index]           = (UINT32)(UINTN)Qh->NextQh;\r
      Uhc->FrameBasePciMemAddr[Index] = Qh->QhHw.HorizonLink;\r
    } else {\r
      Prev->NextQh            = Qh->NextQh;\r
      Prev->QhHw.HorizonLink  = Qh->QhHw.HorizonLink;\r
    }\r
  }\r
}\r
\r
\r
/**\r
  Check TDs Results.\r
\r
  @param  Uhc                    This UHCI device.\r
  @param  Td                     UHCI_TD_SW to check.\r
  @param  IsLow                  Is Low Speed Device.\r
  @param  QhResult               Return the result of this TD list.\r
\r
  @return Whether the TD's result is finialized.\r
\r
**/\r
BOOLEAN\r
UhciCheckTdStatus (\r
  IN  USB_HC_DEV          *Uhc,\r
  IN  UHCI_TD_SW          *Td,\r
  IN  BOOLEAN             IsLow,\r
  OUT UHCI_QH_RESULT      *QhResult\r
  )\r
{\r
  UINTN                   Len;\r
  UINT8                   State;\r
  UHCI_TD_HW              *TdHw;\r
  BOOLEAN                 Finished;\r
\r
  Finished             = TRUE;\r
\r
  //\r
  // Initialize the data toggle to that of the first\r
  // TD. The next toggle to use is either:\r
  // 1. first TD's toggle if no TD is executed OK\r
  // 2. the next toggle of last executed-OK TD\r
  //\r
  QhResult->Result     = EFI_USB_NOERROR;\r
  QhResult->NextToggle = (UINT8)Td->TdHw.DataToggle;\r
  QhResult->Complete   = 0;\r
\r
  while (Td != NULL) {\r
    TdHw  = &Td->TdHw;\r
    State = (UINT8)TdHw->Status;\r
\r
    //\r
    // UHCI will set STALLED bit when it abort the execution\r
    // of TD list. There are several reasons:\r
    //   1. BABBLE error happened\r
    //   2. Received a STALL response\r
    //   3. Error count decreased to zero.\r
    //\r
    // It also set CRC/Timeout/NAK/Buffer Error/BitStuff Error\r
    // bits when corresponding conditions happen. But these\r
    // conditions are not deadly, that is a TD can successfully\r
    // completes even these bits are set. But it is likely that\r
    // upper layer won't distinguish these condtions. So, only\r
    // set these bits when TD is actually halted.\r
    //\r
    if ((State & USBTD_STALLED) != 0) {\r
      if ((State & USBTD_BABBLE) != 0) {\r
        QhResult->Result |= EFI_USB_ERR_BABBLE;\r
\r
      } else if (TdHw->ErrorCount != 0) {\r
        QhResult->Result |= EFI_USB_ERR_STALL;\r
      }\r
\r
      if ((State & USBTD_CRC) != 0) {\r
        QhResult->Result |= EFI_USB_ERR_CRC;\r
      }\r
\r
      if ((State & USBTD_BUFFERR) != 0) {\r
        QhResult->Result |= EFI_USB_ERR_BUFFER;\r
      }\r
\r
      if ((Td->TdHw.Status & USBTD_BITSTUFF) != 0) {\r
        QhResult->Result |= EFI_USB_ERR_BITSTUFF;\r
      }\r
\r
      if (TdHw->ErrorCount == 0) {\r
        QhResult->Result |= EFI_USB_ERR_TIMEOUT;\r
      }\r
\r
      Finished = TRUE;\r
      goto ON_EXIT;\r
\r
    } else if ((State & USBTD_ACTIVE) != 0) {\r
      //\r
      // The TD is still active, no need to check further.\r
      //\r
      QhResult->Result |= EFI_USB_ERR_NOTEXECUTE;\r
\r
      Finished = FALSE;\r
      goto ON_EXIT;\r
\r
    } else {\r
      //\r
      // Update the next data toggle, it is always the\r
      // next to the last known-good TD's data toggle if\r
      // any TD is executed OK\r
      //\r
      QhResult->NextToggle = (UINT8) (1 - (UINT8)TdHw->DataToggle);\r
\r
      //\r
      // This TD is finished OK or met short packet read. Update the\r
      // transfer length if it isn't a SETUP.\r
      //\r
      Len = (TdHw->ActualLen + 1) & 0x7FF;\r
\r
      if (TdHw->PidCode != SETUP_PACKET_ID) {\r
        QhResult->Complete += Len;\r
      }\r
\r
      //\r
      // Short packet condition for full speed input TD, also\r
      // terminate the transfer\r
      //\r
      if (!IsLow && (TdHw->ShortPacket == 1) && (Len < Td->DataLen)) {\r
        DEBUG ((EFI_D_INFO, "UhciCheckTdStatus: short packet read occured\n"));\r
\r
        Finished = TRUE;\r
        goto ON_EXIT;\r
      }\r
    }\r
\r
    Td = Td->NextTd;\r
  }\r
\r
ON_EXIT:\r
  //\r
  // Check whether HC is halted. Don't move this up. It must be\r
  // called after data toggle is successfully updated.\r
  //\r
  if (!UhciIsHcWorking (Uhc->PciIo)) {\r
    QhResult->Result |= EFI_USB_ERR_SYSTEM;\r
    Finished  = TRUE;\r
  }\r
\r
  if (Finished) {\r
    Uhc->PciIo->Flush (Uhc->PciIo);\r
  }\r
\r
  UhciAckAllInterrupt (Uhc);\r
  return Finished;\r
}\r
\r
\r
/**\r
  Check the result of the transfer.\r
\r
  @param  Uhc                    The UHCI device.\r
  @param  Qh                     The queue head of the transfer.\r
  @param  Td                     The first TDs of the transfer.\r
  @param  TimeOut                TimeOut value in milliseconds.\r
  @param  IsLow                  Is Low Speed Device.\r
  @param  QhResult               The variable to return result.\r
\r
  @retval EFI_SUCCESS            The transfer finished with success.\r
  @retval EFI_DEVICE_ERROR       Transfer failed.\r
\r
**/\r
EFI_STATUS\r
UhciExecuteTransfer (\r
  IN  USB_HC_DEV          *Uhc,\r
  IN  UHCI_QH_SW          *Qh,\r
  IN  UHCI_TD_SW          *Td,\r
  IN  UINTN               TimeOut,\r
  IN  BOOLEAN             IsLow,\r
  OUT UHCI_QH_RESULT      *QhResult\r
  )\r
{\r
  UINTN                   Index;\r
  UINTN                   Delay;\r
  BOOLEAN                 Finished;\r
  EFI_STATUS              Status;\r
\r
  Finished = FALSE;\r
  Status   = EFI_SUCCESS;\r
  Delay    = (TimeOut * UHC_1_MILLISECOND / UHC_SYNC_POLL_INTERVAL) + 1;\r
\r
  for (Index = 0; Index < Delay; Index++) {\r
    Finished = UhciCheckTdStatus (Uhc, Td, IsLow, QhResult);\r
\r
    //\r
    // Transfer is OK or some error occured (TD inactive)\r
    //\r
    if (Finished) {\r
      break;\r
    }\r
\r
    gBS->Stall (UHC_SYNC_POLL_INTERVAL);\r
  }\r
\r
  if (!Finished) {\r
    DEBUG ((EFI_D_ERROR, "UhciExecuteTransfer: execution not finished for %dms\n", (UINT32)TimeOut));\r
    UhciDumpQh (Qh);\r
    UhciDumpTds (Td);\r
\r
    Status = EFI_TIMEOUT;\r
\r
  } else if (QhResult->Result != EFI_USB_NOERROR) {\r
    DEBUG ((EFI_D_ERROR, "UhciExecuteTransfer: execution failed with result %x\n", QhResult->Result));\r
    UhciDumpQh (Qh);\r
    UhciDumpTds (Td);\r
\r
    Status = EFI_DEVICE_ERROR;\r
  }\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Update Async Request, QH and TDs.\r
\r
  @param  Uhc                    The UHCI device.\r
  @param  AsyncReq               The UHCI asynchronous transfer to update.\r
  @param  Result                 Transfer reslut.\r
  @param  NextToggle             The toggle of next data.\r
\r
**/\r
VOID\r
UhciUpdateAsyncReq (\r
  IN USB_HC_DEV          *Uhc,\r
  IN UHCI_ASYNC_REQUEST  *AsyncReq,\r
  IN UINT32              Result,\r
  IN UINT32              NextToggle\r
  )\r
{\r
  UHCI_QH_SW              *Qh;\r
  UHCI_TD_SW              *FirstTd;\r
  UHCI_TD_SW              *Td;\r
\r
  Qh          = AsyncReq->QhSw;\r
  FirstTd     = AsyncReq->FirstTd;\r
\r
  if (Result == EFI_USB_NOERROR) {\r
    //\r
    // The last transfer succeeds. Then we need to update\r
    // the Qh and Td for next round of transfer.\r
    // 1. Update the TD's data toggle\r
    // 2. Activate all the TDs\r
    // 3. Link the TD to the queue head again since during\r
    //    execution, queue head's TD pointer is changed by\r
    //    hardware.\r
    //\r
    for (Td = FirstTd; Td != NULL; Td = Td->NextTd) {\r
      Td->TdHw.DataToggle = NextToggle;\r
      NextToggle         ^= 1;\r
      Td->TdHw.Status    |= USBTD_ACTIVE;\r
    }\r
\r
    UhciLinkTdToQh (Uhc, Qh, FirstTd);\r
    return ;\r
  }\r
}\r
\r
\r
/**\r
  Create Async Request node, and Link to List.\r
\r
  @param  Uhc                    The UHCI device.\r
  @param  Qh                     The queue head of the transfer.\r
  @param  FirstTd                First TD of the transfer.\r
  @param  DevAddr                Device Address.\r
  @param  EndPoint               EndPoint Address.\r
  @param  DataLen                Data length.\r
  @param  Interval               Polling Interval when inserted to frame list.\r
  @param  Mapping                Mapping value.\r
  @param  Data                   Data buffer, unmapped.\r
  @param  Callback               Callback after interrupt transfeer.\r
  @param  Context                Callback Context passed as function parameter.\r
  @param  IsLow                  Is Low Speed.\r
\r
  @retval EFI_SUCCESS            An asynchronous transfer is created.\r
  @retval EFI_INVALID_PARAMETER  Paremeter is error.\r
  @retval EFI_OUT_OF_RESOURCES   Failed because of resource shortage.\r
\r
**/\r
EFI_STATUS\r
UhciCreateAsyncReq (\r
  IN USB_HC_DEV                       *Uhc,\r
  IN UHCI_QH_SW                       *Qh,\r
  IN UHCI_TD_SW                       *FirstTd,\r
  IN UINT8                            DevAddr,\r
  IN UINT8                            EndPoint,\r
  IN UINTN                            DataLen,\r
  IN UINTN                            Interval,\r
  IN VOID                             *Mapping,\r
  IN UINT8                            *Data,\r
  IN EFI_ASYNC_USB_TRANSFER_CALLBACK  Callback,\r
  IN VOID                             *Context,\r
  IN BOOLEAN                          IsLow\r
  )\r
{\r
  UHCI_ASYNC_REQUEST      *AsyncReq;\r
\r
  AsyncReq = AllocatePool (sizeof (UHCI_ASYNC_REQUEST));\r
\r
  if (AsyncReq == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  //\r
  // Fill Request field. Data is allocated host memory, not mapped\r
  //\r
  AsyncReq->Signature   = UHCI_ASYNC_INT_SIGNATURE;\r
  AsyncReq->DevAddr     = DevAddr;\r
  AsyncReq->EndPoint    = EndPoint;\r
  AsyncReq->DataLen     = DataLen;\r
  AsyncReq->Interval    = UhciConvertPollRate(Interval);\r
  AsyncReq->Mapping     = Mapping;\r
  AsyncReq->Data        = Data;\r
  AsyncReq->Callback    = Callback;\r
  AsyncReq->Context     = Context;\r
  AsyncReq->QhSw        = Qh;\r
  AsyncReq->FirstTd     = FirstTd;\r
  AsyncReq->IsLow       = IsLow;\r
\r
  //\r
  // Insert the new interrupt transfer to the head of the list.\r
  // The interrupt transfer's monitor function scans the whole\r
  // list from head to tail. The new interrupt transfer MUST be\r
  // added to the head of the list.\r
  //\r
  InsertHeadList (&(Uhc->AsyncIntList), &(AsyncReq->Link));\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  Free an asynchronous request's resource such as memory.\r
\r
  @param  Uhc                    The UHCI device.\r
  @param  AsyncReq               The asynchronous request to free.\r
\r
**/\r
VOID\r
UhciFreeAsyncReq (\r
  IN USB_HC_DEV           *Uhc,\r
  IN UHCI_ASYNC_REQUEST   *AsyncReq\r
  )\r
{\r
  ASSERT ((Uhc != NULL) && (AsyncReq != NULL));\r
\r
  UhciDestoryTds (Uhc, AsyncReq->FirstTd);\r
  UsbHcFreeMem (Uhc->MemPool, AsyncReq->QhSw, sizeof (UHCI_QH_SW));\r
\r
  if (AsyncReq->Mapping != NULL) {\r
    Uhc->PciIo->Unmap (Uhc->PciIo, AsyncReq->Mapping);\r
  }\r
\r
  if (AsyncReq->Data != NULL) {\r
    gBS->FreePool (AsyncReq->Data);\r
  }\r
\r
  gBS->FreePool (AsyncReq);\r
}\r
\r
\r
/**\r
  Unlink an asynchronous request's from UHC's asynchronus list.\r
  also remove the queue head from the frame list. If FreeNow,\r
  release its resource also. Otherwise, add the request to the\r
  UHC's recycle list to wait for a while before release the memory.\r
  Until then, hardware won't hold point to the request.\r
\r
  @param  Uhc                    The UHCI device.\r
  @param  AsyncReq               The asynchronous request to free.\r
  @param  FreeNow                If TRUE, free the resource immediately, otherwise\r
                                 add the request to recycle wait list.\r
\r
**/\r
VOID\r
UhciUnlinkAsyncReq (\r
  IN USB_HC_DEV           *Uhc,\r
  IN UHCI_ASYNC_REQUEST   *AsyncReq,\r
  IN BOOLEAN              FreeNow\r
  )\r
{\r
  ASSERT ((Uhc != NULL) && (AsyncReq != NULL));\r
\r
  RemoveEntryList (&(AsyncReq->Link));\r
  UhciUnlinkQhFromFrameList (Uhc, AsyncReq->QhSw);\r
\r
  if (FreeNow) {\r
    UhciFreeAsyncReq (Uhc, AsyncReq);\r
  } else {\r
    //\r
    // To sychronize with hardware, mark the queue head as inactive\r
    // then add AsyncReq to UHC's recycle list\r
    //\r
    AsyncReq->QhSw->QhHw.VerticalLink = QH_VLINK (NULL, TRUE);\r
    AsyncReq->Recycle = Uhc->RecycleWait;\r
    Uhc->RecycleWait  = AsyncReq;\r
  }\r
}\r
\r
\r
/**\r
  Delete Async Interrupt QH and TDs.\r
\r
  @param  Uhc                    The UHCI device.\r
  @param  DevAddr                Device Address.\r
  @param  EndPoint               EndPoint Address.\r
  @param  Toggle                 The next data toggle to use.\r
\r
  @retval EFI_SUCCESS            The request is deleted.\r
  @retval EFI_INVALID_PARAMETER  Paremeter is error.\r
  @retval EFI_NOT_FOUND          The asynchronous isn't found.\r
\r
**/\r
EFI_STATUS\r
UhciRemoveAsyncReq (\r
  IN  USB_HC_DEV          *Uhc,\r
  IN  UINT8               DevAddr,\r
  IN  UINT8               EndPoint,\r
  OUT UINT8               *Toggle\r
  )\r
{\r
  EFI_STATUS          Status;\r
  UHCI_ASYNC_REQUEST  *AsyncReq;\r
  UHCI_QH_RESULT      QhResult;\r
  LIST_ENTRY          *Link;\r
  BOOLEAN             Found;\r
\r
  Status = EFI_SUCCESS;\r
\r
  //\r
  // If no asynchronous interrupt transaction exists\r
  //\r
  if (IsListEmpty (&(Uhc->AsyncIntList))) {\r
    return EFI_SUCCESS;\r
  }\r
\r
  //\r
  // Find the asynchronous transfer to this device/endpoint pair\r
  //\r
  Found = FALSE;\r
  Link  = Uhc->AsyncIntList.ForwardLink;\r
\r
  do {\r
    AsyncReq  = UHCI_ASYNC_INT_FROM_LINK (Link);\r
    Link      = Link->ForwardLink;\r
\r
    if ((AsyncReq->DevAddr == DevAddr) && (AsyncReq->EndPoint == EndPoint)) {\r
      Found = TRUE;\r
      break;\r
    }\r
\r
  } while (Link != &(Uhc->AsyncIntList));\r
\r
  if (!Found) {\r
    return EFI_NOT_FOUND;\r
  }\r
\r
  //\r
  // Check the result of the async transfer then update it\r
  // to get the next data toggle to use.\r
  //\r
  UhciCheckTdStatus (Uhc, AsyncReq->FirstTd, AsyncReq->IsLow, &QhResult);\r
  *Toggle = QhResult.NextToggle;\r
\r
  //\r
  // Don't release the request now, keep it to synchronize with hardware.\r
  //\r
  UhciUnlinkAsyncReq (Uhc, AsyncReq, FALSE);\r
  return Status;\r
}\r
\r
\r
/**\r
  Recycle the asynchronouse request. When a queue head\r
  is unlinked from frame list, host controller hardware\r
  may still hold a cached pointer to it. To synchronize\r
  with hardware, the request is released in two steps:\r
  first it is linked to the UHC's RecycleWait list. At\r
  the next time UhciMonitorAsyncReqList is fired, it is\r
  moved to UHC's Recylelist. Then, at another timer\r
  activation, all the requests on Recycle list is freed.\r
  This guarrantes that each unlink queue head keeps\r
  existing for at least 50ms, far enough for the hardware\r
  to clear its cache.\r
\r
  @param  Uhc                    The UHCI device.\r
\r
**/\r
VOID\r
UhciRecycleAsyncReq (\r
  IN USB_HC_DEV           *Uhc\r
  )\r
{\r
  UHCI_ASYNC_REQUEST      *Req;\r
  UHCI_ASYNC_REQUEST      *Next;\r
\r
  Req = Uhc->Recycle;\r
\r
  while (Req != NULL) {\r
    Next = Req->Recycle;\r
    UhciFreeAsyncReq (Uhc, Req);\r
    Req  = Next;\r
  }\r
\r
  Uhc->Recycle     = Uhc->RecycleWait;\r
  Uhc->RecycleWait = NULL;\r
}\r
\r
\r
\r
/**\r
  Release all the asynchronous transfers on the lsit.\r
\r
  @param  Uhc                    The UHCI device.\r
\r
**/\r
VOID\r
UhciFreeAllAsyncReq (\r
  IN USB_HC_DEV           *Uhc\r
  )\r
{\r
  LIST_ENTRY              *Head;\r
  UHCI_ASYNC_REQUEST      *AsyncReq;\r
\r
  //\r
  // Call UhciRecycleAsyncReq twice. The requests on Recycle\r
  // will be released at the first call; The requests on\r
  // RecycleWait will be released at the second call.\r
  //\r
  UhciRecycleAsyncReq (Uhc);\r
  UhciRecycleAsyncReq (Uhc);\r
\r
  Head = &(Uhc->AsyncIntList);\r
\r
  if (IsListEmpty (Head)) {\r
    return;\r
  }\r
\r
  while (!IsListEmpty (Head)) {\r
    AsyncReq  = UHCI_ASYNC_INT_FROM_LINK (Head->ForwardLink);\r
    UhciUnlinkAsyncReq (Uhc, AsyncReq, TRUE);\r
  }\r
}\r
\r
\r
/**\r
  Interrupt transfer periodic check handler.\r
\r
  @param  Event                  The event of the time.\r
  @param  Context                Context of the event, pointer to USB_HC_DEV.\r
\r
**/\r
VOID\r
EFIAPI\r
UhciMonitorAsyncReqList (\r
  IN EFI_EVENT            Event,\r
  IN VOID                 *Context\r
  )\r
{\r
  UHCI_ASYNC_REQUEST      *AsyncReq;\r
  LIST_ENTRY              *Link;\r
  USB_HC_DEV              *Uhc;\r
  VOID                    *Data;\r
  BOOLEAN                 Finished;\r
  UHCI_QH_RESULT          QhResult;\r
\r
  Uhc = (USB_HC_DEV *) Context;\r
\r
  //\r
  // Recycle the asynchronous requests expired, and promote\r
  // requests waiting to be recycled the next time when this\r
  // timer expires\r
  //\r
  UhciRecycleAsyncReq (Uhc);\r
\r
  if (IsListEmpty (&(Uhc->AsyncIntList))) {\r
    return ;\r
  }\r
\r
  //\r
  // This loop must be delete safe\r
  //\r
  Link = Uhc->AsyncIntList.ForwardLink;\r
\r
  do {\r
    AsyncReq  = UHCI_ASYNC_INT_FROM_LINK (Link);\r
    Link      = Link->ForwardLink;\r
\r
    Finished = UhciCheckTdStatus (Uhc, AsyncReq->FirstTd, AsyncReq->IsLow, &QhResult);\r
\r
    if (!Finished) {\r
      continue;\r
    }\r
\r
    //\r
    // Copy the data to temporary buffer if there are some\r
    // data transferred. We may have zero-length packet\r
    //\r
    Data = NULL;\r
\r
    if (QhResult.Complete != 0) {\r
      Data = AllocatePool (QhResult.Complete);\r
\r
      if (Data == NULL) {\r
        return ;\r
      }\r
\r
      CopyMem (Data, AsyncReq->FirstTd->Data, QhResult.Complete);\r
    }\r
\r
    UhciUpdateAsyncReq (Uhc, AsyncReq, QhResult.Result, QhResult.NextToggle);\r
\r
    //\r
    // Now, either transfer is SUCCESS or met errors since\r
    // we have skipped to next transfer earlier if current\r
    // transfer is still active.\r
    //\r
    if (QhResult.Result == EFI_USB_NOERROR) {\r
      AsyncReq->Callback (Data, QhResult.Complete, AsyncReq->Context, QhResult.Result);\r
    } else {\r
      //\r
      // Leave error recovery to its related device driver.\r
      // A common case of the error recovery is to re-submit\r
      // the interrupt transfer. When an interrupt transfer\r
      // is re-submitted, its position in the linked list is\r
      // changed. It is inserted to the head of the linked\r
      // list, while this function scans the whole list from\r
      // head to tail. Thus, the re-submitted interrupt transfer's\r
      // callback function will not be called again in this round.\r
      //\r
      AsyncReq->Callback (NULL, 0, AsyncReq->Context, QhResult.Result);\r
    }\r
\r
    if (Data != NULL) {\r
      gBS->FreePool (Data);\r
    }\r
  } while (Link != &(Uhc->AsyncIntList));\r
}\r