--- /dev/null
+/*
+ * PROJECT: ReactOS USB EHCI Miniport Driver
+ * LICENSE: GPL-2.0+ (https://spdx.org/licenses/GPL-2.0+)
+ * PURPOSE: USBEHCI main driver functions
+ * COPYRIGHT: Copyright 2017-2018 Vadim Galyant <vgal@rambler.ru>
+ */
+
+#include "usbehci.h"
+
+#define NDEBUG
+#include <debug.h>
+
+#define NDEBUG_EHCI_TRACE
+#include "dbg_ehci.h"
+
+USBPORT_REGISTRATION_PACKET RegPacket;
+
+static const UCHAR ClassicPeriod[8] = {
+ ENDPOINT_INTERRUPT_1ms - 1,
+ ENDPOINT_INTERRUPT_2ms - 1,
+ ENDPOINT_INTERRUPT_4ms - 1,
+ ENDPOINT_INTERRUPT_8ms - 1,
+ ENDPOINT_INTERRUPT_16ms - 1,
+ ENDPOINT_INTERRUPT_32ms - 1,
+ ENDPOINT_INTERRUPT_32ms - 1,
+ ENDPOINT_INTERRUPT_32ms - 1
+};
+
+static const EHCI_PERIOD pTable[] = {
+ { ENDPOINT_INTERRUPT_1ms, 0x00, 0xFF },
+ { ENDPOINT_INTERRUPT_2ms, 0x00, 0x55 },
+ { ENDPOINT_INTERRUPT_2ms, 0x00, 0xAA },
+ { ENDPOINT_INTERRUPT_4ms, 0x00, 0x11 },
+ { ENDPOINT_INTERRUPT_4ms, 0x00, 0x44 },
+ { ENDPOINT_INTERRUPT_4ms, 0x00, 0x22 },
+ { ENDPOINT_INTERRUPT_4ms, 0x00, 0x88 },
+ { ENDPOINT_INTERRUPT_8ms, 0x00, 0x01 },
+ { ENDPOINT_INTERRUPT_8ms, 0x00, 0x10 },
+ { ENDPOINT_INTERRUPT_8ms, 0x00, 0x04 },
+ { ENDPOINT_INTERRUPT_8ms, 0x00, 0x40 },
+ { ENDPOINT_INTERRUPT_8ms, 0x00, 0x02 },
+ { ENDPOINT_INTERRUPT_8ms, 0x00, 0x20 },
+ { ENDPOINT_INTERRUPT_8ms, 0x00, 0x08 },
+ { ENDPOINT_INTERRUPT_8ms, 0x00, 0x80 },
+ { ENDPOINT_INTERRUPT_16ms, 0x01, 0x01 },
+ { ENDPOINT_INTERRUPT_16ms, 0x02, 0x01 },
+ { ENDPOINT_INTERRUPT_16ms, 0x01, 0x10 },
+ { ENDPOINT_INTERRUPT_16ms, 0x02, 0x10 },
+ { ENDPOINT_INTERRUPT_16ms, 0x01, 0x04 },
+ { ENDPOINT_INTERRUPT_16ms, 0x02, 0x04 },
+ { ENDPOINT_INTERRUPT_16ms, 0x01, 0x40 },
+ { ENDPOINT_INTERRUPT_16ms, 0x02, 0x40 },
+ { ENDPOINT_INTERRUPT_16ms, 0x01, 0x02 },
+ { ENDPOINT_INTERRUPT_16ms, 0x02, 0x02 },
+ { ENDPOINT_INTERRUPT_16ms, 0x01, 0x20 },
+ { ENDPOINT_INTERRUPT_16ms, 0x02, 0x20 },
+ { ENDPOINT_INTERRUPT_16ms, 0x01, 0x08 },
+ { ENDPOINT_INTERRUPT_16ms, 0x02, 0x08 },
+ { ENDPOINT_INTERRUPT_16ms, 0x01, 0x80 },
+ { ENDPOINT_INTERRUPT_16ms, 0x02, 0x80 },
+ { ENDPOINT_INTERRUPT_32ms, 0x03, 0x01 },
+ { ENDPOINT_INTERRUPT_32ms, 0x05, 0x01 },
+ { ENDPOINT_INTERRUPT_32ms, 0x04, 0x01 },
+ { ENDPOINT_INTERRUPT_32ms, 0x06, 0x01 },
+ { ENDPOINT_INTERRUPT_32ms, 0x03, 0x10 },
+ { ENDPOINT_INTERRUPT_32ms, 0x05, 0x10 },
+ { ENDPOINT_INTERRUPT_32ms, 0x04, 0x10 },
+ { ENDPOINT_INTERRUPT_32ms, 0x06, 0x10 },
+ { ENDPOINT_INTERRUPT_32ms, 0x03, 0x04 },
+ { ENDPOINT_INTERRUPT_32ms, 0x05, 0x04 },
+ { ENDPOINT_INTERRUPT_32ms, 0x04, 0x04 },
+ { ENDPOINT_INTERRUPT_32ms, 0x06, 0x04 },
+ { ENDPOINT_INTERRUPT_32ms, 0x03, 0x40 },
+ { ENDPOINT_INTERRUPT_32ms, 0x05, 0x40 },
+ { ENDPOINT_INTERRUPT_32ms, 0x04, 0x40 },
+ { ENDPOINT_INTERRUPT_32ms, 0x06, 0x40 },
+ { ENDPOINT_INTERRUPT_32ms, 0x03, 0x02 },
+ { ENDPOINT_INTERRUPT_32ms, 0x05, 0x02 },
+ { ENDPOINT_INTERRUPT_32ms, 0x04, 0x02 },
+ { ENDPOINT_INTERRUPT_32ms, 0x06, 0x02 },
+ { ENDPOINT_INTERRUPT_32ms, 0x03, 0x20 },
+ { ENDPOINT_INTERRUPT_32ms, 0x05, 0x20 },
+ { ENDPOINT_INTERRUPT_32ms, 0x04, 0x20 },
+ { ENDPOINT_INTERRUPT_32ms, 0x06, 0x20 },
+ { ENDPOINT_INTERRUPT_32ms, 0x03, 0x08 },
+ { ENDPOINT_INTERRUPT_32ms, 0x05, 0x08 },
+ { ENDPOINT_INTERRUPT_32ms, 0x04, 0x08 },
+ { ENDPOINT_INTERRUPT_32ms, 0x06, 0x08 },
+ { ENDPOINT_INTERRUPT_32ms, 0x03, 0x80 },
+ { ENDPOINT_INTERRUPT_32ms, 0x05, 0x80 },
+ { ENDPOINT_INTERRUPT_32ms, 0x04, 0x80 },
+ { ENDPOINT_INTERRUPT_32ms, 0x06, 0x80 },
+ { 0x00, 0x00, 0x00 }
+};
+C_ASSERT(RTL_NUMBER_OF(pTable) == INTERRUPT_ENDPOINTs + 1);
+
+static const UCHAR Balance[] = {
+ 0, 16, 8, 24, 4, 20, 12, 28, 2, 18, 10, 26, 6, 22, 14, 30,
+ 1, 17, 9, 25, 5, 21, 13, 29, 3, 19, 11, 27, 7, 23, 15, 31
+};
+C_ASSERT(RTL_NUMBER_OF(Balance) == EHCI_FRAMES);
+
+static const UCHAR LinkTable[] = {
+ 255, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8, 9, 9,
+ 10, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 19, 19,
+ 20, 20, 21, 21, 22, 22, 23, 23, 24, 24, 25, 25, 26, 26, 27, 27, 28, 28, 29, 29,
+ 30, 30, 0
+};
+C_ASSERT(RTL_NUMBER_OF(LinkTable) == INTERRUPT_ENDPOINTs + 1);
+
+PEHCI_HCD_TD
+NTAPI
+EHCI_AllocTd(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_ENDPOINT EhciEndpoint)
+{
+ PEHCI_HCD_TD TD;
+ ULONG ix;
+
+ DPRINT_EHCI("EHCI_AllocTd: ... \n");
+
+ if (EhciEndpoint->MaxTDs == 0)
+ {
+ RegPacket.UsbPortBugCheck(EhciExtension);
+ return NULL;
+ }
+
+ TD = EhciEndpoint->FirstTD;
+
+ for (ix = 1; TD->TdFlags & EHCI_HCD_TD_FLAG_ALLOCATED; ix++)
+ {
+ TD += 1;
+
+ if (ix >= EhciEndpoint->MaxTDs)
+ {
+ RegPacket.UsbPortBugCheck(EhciExtension);
+ return NULL;
+ }
+ }
+
+ TD->TdFlags |= EHCI_HCD_TD_FLAG_ALLOCATED;
+
+ EhciEndpoint->RemainTDs--;
+
+ return TD;
+}
+
+PEHCI_HCD_QH
+NTAPI
+EHCI_InitializeQH(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_ENDPOINT EhciEndpoint,
+ IN PEHCI_HCD_QH QH,
+ IN ULONG QhPA)
+{
+ PUSBPORT_ENDPOINT_PROPERTIES EndpointProperties;
+ ULONG DeviceSpeed;
+
+ DPRINT_EHCI("EHCI_InitializeQH: EhciEndpoint - %p, QH - %p, QhPA - %p\n",
+ EhciEndpoint,
+ QH,
+ QhPA);
+
+ EndpointProperties = &EhciEndpoint->EndpointProperties;
+
+ RtlZeroMemory(QH, sizeof(EHCI_HCD_QH));
+
+ ASSERT((QhPA & ~LINK_POINTER_MASK) == 0);
+
+ QH->sqh.PhysicalAddress = QhPA;
+
+ QH->sqh.HwQH.EndpointParams.DeviceAddress = EndpointProperties->DeviceAddress;
+ QH->sqh.HwQH.EndpointParams.EndpointNumber = EndpointProperties->EndpointAddress;
+
+ DeviceSpeed = EndpointProperties->DeviceSpeed;
+
+ switch (DeviceSpeed)
+ {
+ case UsbLowSpeed:
+ QH->sqh.HwQH.EndpointParams.EndpointSpeed = EHCI_QH_EP_LOW_SPEED;
+ break;
+
+ case UsbFullSpeed:
+ QH->sqh.HwQH.EndpointParams.EndpointSpeed = EHCI_QH_EP_FULL_SPEED;
+ break;
+
+ case UsbHighSpeed:
+ QH->sqh.HwQH.EndpointParams.EndpointSpeed = EHCI_QH_EP_HIGH_SPEED;
+ break;
+
+ default:
+ DPRINT1("EHCI_InitializeQH: Unknown DeviceSpeed - %x\n", DeviceSpeed);
+ ASSERT(FALSE);
+ break;
+ }
+
+ QH->sqh.HwQH.EndpointParams.MaximumPacketLength = EndpointProperties->MaxPacketSize;
+ QH->sqh.HwQH.EndpointCaps.PipeMultiplier = 1;
+
+ if (DeviceSpeed == UsbHighSpeed)
+ {
+ QH->sqh.HwQH.EndpointCaps.HubAddr = 0;
+ QH->sqh.HwQH.EndpointCaps.PortNumber = 0;
+ }
+ else
+ {
+ QH->sqh.HwQH.EndpointCaps.HubAddr = EndpointProperties->HubAddr;
+ QH->sqh.HwQH.EndpointCaps.PortNumber = EndpointProperties->PortNumber;
+
+ if (EndpointProperties->TransferType == USBPORT_TRANSFER_TYPE_CONTROL)
+ QH->sqh.HwQH.EndpointParams.ControlEndpointFlag = 1;
+ }
+
+ QH->sqh.HwQH.NextTD = TERMINATE_POINTER;
+ QH->sqh.HwQH.AlternateNextTD = TERMINATE_POINTER;
+
+ QH->sqh.HwQH.Token.Status &= (UCHAR)~(EHCI_TOKEN_STATUS_ACTIVE |
+ EHCI_TOKEN_STATUS_HALTED);
+
+ return QH;
+}
+
+MPSTATUS
+NTAPI
+EHCI_OpenBulkOrControlEndpoint(IN PEHCI_EXTENSION EhciExtension,
+ IN PUSBPORT_ENDPOINT_PROPERTIES EndpointProperties,
+ IN PEHCI_ENDPOINT EhciEndpoint,
+ IN BOOLEAN IsControl)
+{
+ PEHCI_HCD_QH QH;
+ ULONG QhPA;
+ PEHCI_HCD_TD TdVA;
+ ULONG TdPA;
+ PEHCI_HCD_TD TD;
+ ULONG TdCount;
+ ULONG ix;
+
+ DPRINT("EHCI_OpenBulkOrControlEndpoint: EhciEndpoint - %p, IsControl - %x\n",
+ EhciEndpoint,
+ IsControl);
+
+ InitializeListHead(&EhciEndpoint->ListTDs);
+
+ EhciEndpoint->DmaBufferVA = (PVOID)EndpointProperties->BufferVA;
+ EhciEndpoint->DmaBufferPA = EndpointProperties->BufferPA;
+
+ RtlZeroMemory(EhciEndpoint->DmaBufferVA, sizeof(EHCI_HCD_TD));
+
+ QH = (PEHCI_HCD_QH)EhciEndpoint->DmaBufferVA + 1;
+ QhPA = EhciEndpoint->DmaBufferPA + sizeof(EHCI_HCD_TD);
+
+ EhciEndpoint->FirstTD = (PEHCI_HCD_TD)(QH + 1);
+
+ TdCount = (EndpointProperties->BufferLength -
+ (sizeof(EHCI_HCD_TD) + sizeof(EHCI_HCD_QH))) /
+ sizeof(EHCI_HCD_TD);
+
+ if (EndpointProperties->TransferType == USBPORT_TRANSFER_TYPE_CONTROL)
+ EhciEndpoint->EndpointStatus |= USBPORT_ENDPOINT_CONTROL;
+
+ EhciEndpoint->MaxTDs = TdCount;
+ EhciEndpoint->RemainTDs = TdCount;
+
+ TdVA = EhciEndpoint->FirstTD;
+ TdPA = QhPA + sizeof(EHCI_HCD_QH);
+
+ for (ix = 0; ix < TdCount; ix++)
+ {
+ DPRINT_EHCI("EHCI_OpenBulkOrControlEndpoint: TdVA - %p, TdPA - %p\n",
+ TdVA,
+ TdPA);
+
+ RtlZeroMemory(TdVA, sizeof(EHCI_HCD_TD));
+
+ ASSERT((TdPA & ~LINK_POINTER_MASK) == 0);
+
+ TdVA->PhysicalAddress = TdPA;
+ TdVA->EhciEndpoint = EhciEndpoint;
+ TdVA->EhciTransfer = NULL;
+
+ TdPA += sizeof(EHCI_HCD_TD);
+ TdVA += 1;
+ }
+
+ EhciEndpoint->QH = EHCI_InitializeQH(EhciExtension,
+ EhciEndpoint,
+ QH,
+ QhPA);
+
+ if (IsControl)
+ {
+ QH->sqh.HwQH.EndpointParams.DataToggleControl = 1;
+ EhciEndpoint->HcdHeadP = NULL;
+ }
+ else
+ {
+ QH->sqh.HwQH.EndpointParams.DataToggleControl = 0;
+ }
+
+ TD = EHCI_AllocTd(EhciExtension, EhciEndpoint);
+
+ if (!TD)
+ return MP_STATUS_NO_RESOURCES;
+
+ TD->TdFlags |= EHCI_HCD_TD_FLAG_DUMMY;
+ TD->HwTD.Token.Status &= (UCHAR)~EHCI_TOKEN_STATUS_ACTIVE;
+
+ TD->HwTD.NextTD = TERMINATE_POINTER;
+ TD->HwTD.AlternateNextTD = TERMINATE_POINTER;
+
+ TD->NextHcdTD = NULL;
+ TD->AltNextHcdTD = NULL;
+
+ EhciEndpoint->HcdTailP = TD;
+ EhciEndpoint->HcdHeadP = TD;
+
+ QH->sqh.HwQH.CurrentTD = TD->PhysicalAddress;
+ QH->sqh.HwQH.NextTD = TERMINATE_POINTER;
+ QH->sqh.HwQH.AlternateNextTD = TERMINATE_POINTER;
+
+ QH->sqh.HwQH.Token.Status &= (UCHAR)~EHCI_TOKEN_STATUS_ACTIVE;
+ QH->sqh.HwQH.Token.TransferBytes = 0;
+
+ return MP_STATUS_SUCCESS;
+}
+
+MPSTATUS
+NTAPI
+EHCI_OpenInterruptEndpoint(IN PEHCI_EXTENSION EhciExtension,
+ IN PUSBPORT_ENDPOINT_PROPERTIES EndpointProperties,
+ IN PEHCI_ENDPOINT EhciEndpoint)
+{
+ PEHCI_HCD_QH QH;
+ ULONG QhPA;
+ PEHCI_HCD_TD FirstTD;
+ ULONG FirstTdPA;
+ PEHCI_HCD_TD TD;
+ PEHCI_HCD_TD DummyTD;
+ ULONG TdCount;
+ ULONG ix;
+ const EHCI_PERIOD * PeriodTable = NULL;
+ ULONG ScheduleOffset;
+ ULONG Idx = 0;
+ UCHAR Period;
+
+ DPRINT("EHCI_OpenInterruptEndpoint: EhciExtension - %p, EndpointProperties - %p, EhciEndpoint - %p\n",
+ EhciExtension,
+ EndpointProperties,
+ EhciEndpoint);
+
+ Period = EndpointProperties->Period;
+ ScheduleOffset = EndpointProperties->ScheduleOffset;
+
+ ASSERT(Period < (INTERRUPT_ENDPOINTs + 1));
+
+ while (!(Period & 1))
+ {
+ Idx++;
+ Period >>= 1;
+ }
+
+ ASSERT(Idx < 8);
+
+ InitializeListHead(&EhciEndpoint->ListTDs);
+
+ if (EhciEndpoint->EndpointProperties.DeviceSpeed == UsbHighSpeed)
+ {
+ PeriodTable = &pTable[ClassicPeriod[Idx] + ScheduleOffset];
+ EhciEndpoint->PeriodTable = PeriodTable;
+
+ DPRINT("EHCI_OpenInterruptEndpoint: EhciEndpoint - %p, ScheduleMask - %X, Index - %X\n",
+ EhciEndpoint,
+ PeriodTable->ScheduleMask,
+ ClassicPeriod[Idx]);
+
+ EhciEndpoint->StaticQH = EhciExtension->PeriodicHead[PeriodTable->PeriodIdx];
+ }
+ else
+ {
+ EhciEndpoint->PeriodTable = NULL;
+
+ DPRINT("EHCI_OpenInterruptEndpoint: EhciEndpoint - %p, Index - %X\n",
+ EhciEndpoint,
+ ClassicPeriod[Idx]);
+
+ EhciEndpoint->StaticQH = EhciExtension->PeriodicHead[ClassicPeriod[Idx] +
+ ScheduleOffset];
+ }
+
+ EhciEndpoint->DmaBufferVA = (PVOID)EndpointProperties->BufferVA;
+ EhciEndpoint->DmaBufferPA = EndpointProperties->BufferPA;
+
+ RtlZeroMemory((PVOID)EndpointProperties->BufferVA, sizeof(EHCI_HCD_TD));
+
+ QH = (PEHCI_HCD_QH)(EndpointProperties->BufferVA + sizeof(EHCI_HCD_TD));
+ QhPA = EndpointProperties->BufferPA + sizeof(EHCI_HCD_TD);
+
+ FirstTD = (PEHCI_HCD_TD)(EndpointProperties->BufferVA +
+ sizeof(EHCI_HCD_TD) +
+ sizeof(EHCI_HCD_QH));
+
+ FirstTdPA = EndpointProperties->BufferPA +
+ sizeof(EHCI_HCD_TD) +
+ sizeof(EHCI_HCD_QH);
+
+ TdCount = (EndpointProperties->BufferLength -
+ (sizeof(EHCI_HCD_TD) + sizeof(EHCI_HCD_QH))) /
+ sizeof(EHCI_HCD_TD);
+
+ ASSERT(TdCount >= EHCI_MAX_INTERRUPT_TD_COUNT + 1);
+
+ EhciEndpoint->FirstTD = FirstTD;
+ EhciEndpoint->MaxTDs = TdCount;
+
+ for (ix = 0; ix < TdCount; ix++)
+ {
+ TD = EhciEndpoint->FirstTD + ix;
+
+ RtlZeroMemory(TD, sizeof(EHCI_HCD_TD));
+
+ ASSERT((FirstTdPA & ~LINK_POINTER_MASK) == 0);
+
+ TD->PhysicalAddress = FirstTdPA;
+ TD->EhciEndpoint = EhciEndpoint;
+ TD->EhciTransfer = NULL;
+
+ FirstTdPA += sizeof(EHCI_HCD_TD);
+ }
+
+ EhciEndpoint->RemainTDs = TdCount;
+
+ EhciEndpoint->QH = EHCI_InitializeQH(EhciExtension,
+ EhciEndpoint,
+ QH,
+ QhPA);
+
+ if (EhciEndpoint->EndpointProperties.DeviceSpeed == UsbHighSpeed)
+ {
+ QH->sqh.HwQH.EndpointCaps.InterruptMask = PeriodTable->ScheduleMask;
+ }
+ else
+ {
+ QH->sqh.HwQH.EndpointCaps.InterruptMask =
+ EndpointProperties->InterruptScheduleMask;
+
+ QH->sqh.HwQH.EndpointCaps.SplitCompletionMask =
+ EndpointProperties->SplitCompletionMask;
+ }
+
+ DummyTD = EHCI_AllocTd(EhciExtension, EhciEndpoint);
+
+ DummyTD->TdFlags |= EHCI_HCD_TD_FLAG_DUMMY;
+ DummyTD->NextHcdTD = NULL;
+ DummyTD->AltNextHcdTD = NULL;
+
+ DummyTD->HwTD.Token.Status &= ~EHCI_TOKEN_STATUS_ACTIVE;
+
+ DummyTD->HwTD.NextTD = TERMINATE_POINTER;
+ DummyTD->HwTD.AlternateNextTD = TERMINATE_POINTER;
+
+ EhciEndpoint->HcdTailP = DummyTD;
+ EhciEndpoint->HcdHeadP = DummyTD;
+
+ QH->sqh.HwQH.CurrentTD = DummyTD->PhysicalAddress;
+ QH->sqh.HwQH.NextTD = TERMINATE_POINTER;
+ QH->sqh.HwQH.AlternateNextTD = TERMINATE_POINTER;
+
+ QH->sqh.HwQH.Token.Status &= ~EHCI_TOKEN_STATUS_ACTIVE;
+ QH->sqh.HwQH.Token.TransferBytes = 0;
+
+ return MP_STATUS_SUCCESS;
+}
+
+MPSTATUS
+NTAPI
+EHCI_OpenHsIsoEndpoint(IN PEHCI_EXTENSION EhciExtension,
+ IN PUSBPORT_ENDPOINT_PROPERTIES EndpointProperties,
+ IN PEHCI_ENDPOINT EhciEndpoint)
+{
+ DPRINT1("EHCI_OpenHsIsoEndpoint: UNIMPLEMENTED. FIXME\n");
+ return MP_STATUS_NOT_SUPPORTED;
+}
+
+MPSTATUS
+NTAPI
+EHCI_OpenIsoEndpoint(IN PEHCI_EXTENSION EhciExtension,
+ IN PUSBPORT_ENDPOINT_PROPERTIES EndpointProperties,
+ IN PEHCI_ENDPOINT EhciEndpoint)
+{
+ DPRINT1("EHCI_OpenIsoEndpoint: UNIMPLEMENTED. FIXME\n");
+ return MP_STATUS_NOT_SUPPORTED;
+}
+
+MPSTATUS
+NTAPI
+EHCI_OpenEndpoint(IN PVOID ehciExtension,
+ IN PUSBPORT_ENDPOINT_PROPERTIES EndpointProperties,
+ IN PVOID ehciEndpoint)
+{
+ PEHCI_EXTENSION EhciExtension = ehciExtension;
+ PEHCI_ENDPOINT EhciEndpoint = ehciEndpoint;
+ ULONG TransferType;
+ MPSTATUS MPStatus;
+
+ DPRINT("EHCI_OpenEndpoint: ... \n");
+
+ RtlCopyMemory(&EhciEndpoint->EndpointProperties,
+ EndpointProperties,
+ sizeof(EhciEndpoint->EndpointProperties));
+
+ TransferType = EndpointProperties->TransferType;
+
+ switch (TransferType)
+ {
+ case USBPORT_TRANSFER_TYPE_ISOCHRONOUS:
+ if (EndpointProperties->DeviceSpeed == UsbHighSpeed)
+ {
+ MPStatus = EHCI_OpenHsIsoEndpoint(EhciExtension,
+ EndpointProperties,
+ EhciEndpoint);
+ }
+ else
+ {
+ MPStatus = EHCI_OpenIsoEndpoint(EhciExtension,
+ EndpointProperties,
+ EhciEndpoint);
+ }
+
+ break;
+
+ case USBPORT_TRANSFER_TYPE_CONTROL:
+ MPStatus = EHCI_OpenBulkOrControlEndpoint(EhciExtension,
+ EndpointProperties,
+ EhciEndpoint,
+ TRUE);
+ break;
+
+ case USBPORT_TRANSFER_TYPE_BULK:
+ MPStatus = EHCI_OpenBulkOrControlEndpoint(EhciExtension,
+ EndpointProperties,
+ EhciEndpoint,
+ FALSE);
+ break;
+
+ case USBPORT_TRANSFER_TYPE_INTERRUPT:
+ MPStatus = EHCI_OpenInterruptEndpoint(EhciExtension,
+ EndpointProperties,
+ EhciEndpoint);
+ break;
+
+ default:
+ MPStatus = MP_STATUS_NOT_SUPPORTED;
+ break;
+ }
+
+ return MPStatus;
+}
+
+MPSTATUS
+NTAPI
+EHCI_ReopenEndpoint(IN PVOID ehciExtension,
+ IN PUSBPORT_ENDPOINT_PROPERTIES EndpointProperties,
+ IN PVOID ehciEndpoint)
+{
+ PEHCI_ENDPOINT EhciEndpoint;
+ ULONG TransferType;
+ PEHCI_HCD_QH QH;
+ MPSTATUS MPStatus;
+
+ EhciEndpoint = ehciEndpoint;
+
+ TransferType = EndpointProperties->TransferType;
+
+ DPRINT("EHCI_ReopenEndpoint: EhciEndpoint - %p, TransferType - %x\n",
+ EhciEndpoint,
+ TransferType);
+
+ switch (TransferType)
+ {
+ case USBPORT_TRANSFER_TYPE_ISOCHRONOUS:
+ if (EndpointProperties->DeviceSpeed == UsbHighSpeed)
+ {
+ DPRINT1("EHCI_ReopenEndpoint: HS Iso. UNIMPLEMENTED. FIXME\n");
+ MPStatus = MP_STATUS_NOT_SUPPORTED;
+ }
+ else
+ {
+ DPRINT1("EHCI_ReopenEndpoint: Iso. UNIMPLEMENTED. FIXME\n");
+ MPStatus = MP_STATUS_NOT_SUPPORTED;
+ }
+
+ break;
+
+ case USBPORT_TRANSFER_TYPE_CONTROL:
+ case USBPORT_TRANSFER_TYPE_BULK:
+ case USBPORT_TRANSFER_TYPE_INTERRUPT:
+ RtlCopyMemory(&EhciEndpoint->EndpointProperties,
+ EndpointProperties,
+ sizeof(EhciEndpoint->EndpointProperties));
+
+ QH = EhciEndpoint->QH;
+
+ QH->sqh.HwQH.EndpointParams.DeviceAddress = EndpointProperties->DeviceAddress;
+ QH->sqh.HwQH.EndpointParams.MaximumPacketLength = EndpointProperties->MaxPacketSize;
+
+ QH->sqh.HwQH.EndpointCaps.HubAddr = EndpointProperties->HubAddr;
+
+ break;
+
+ default:
+ DPRINT1("EHCI_ReopenEndpoint: Unknown TransferType\n");
+ MPStatus = MP_STATUS_SUCCESS;
+ break;
+ }
+
+ return MPStatus;
+}
+
+VOID
+NTAPI
+EHCI_QueryEndpointRequirements(IN PVOID ehciExtension,
+ IN PUSBPORT_ENDPOINT_PROPERTIES EndpointProperties,
+ IN PUSBPORT_ENDPOINT_REQUIREMENTS EndpointRequirements)
+{
+ ULONG TransferType;
+
+ DPRINT("EHCI_QueryEndpointRequirements: ... \n");
+
+ TransferType = EndpointProperties->TransferType;
+
+ switch (TransferType)
+ {
+ case USBPORT_TRANSFER_TYPE_ISOCHRONOUS:
+ DPRINT("EHCI_QueryEndpointRequirements: IsoTransfer\n");
+
+ if (EndpointProperties->DeviceSpeed == UsbHighSpeed)
+ {
+ EndpointRequirements->HeaderBufferSize = EHCI_MAX_HS_ISO_HEADER_BUFFER_SIZE;
+ EndpointRequirements->MaxTransferSize = EHCI_MAX_HS_ISO_TRANSFER_SIZE;
+ }
+ else
+ {
+ EndpointRequirements->HeaderBufferSize = EHCI_MAX_FS_ISO_HEADER_BUFFER_SIZE;
+ EndpointRequirements->MaxTransferSize = EHCI_MAX_FS_ISO_TRANSFER_SIZE;
+ }
+ break;
+
+ case USBPORT_TRANSFER_TYPE_CONTROL:
+ DPRINT("EHCI_QueryEndpointRequirements: ControlTransfer\n");
+ EndpointRequirements->HeaderBufferSize = sizeof(EHCI_HCD_TD) +
+ sizeof(EHCI_HCD_QH) +
+ EHCI_MAX_CONTROL_TD_COUNT * sizeof(EHCI_HCD_TD);
+
+ EndpointRequirements->MaxTransferSize = EHCI_MAX_CONTROL_TRANSFER_SIZE;
+ break;
+
+ case USBPORT_TRANSFER_TYPE_BULK:
+ DPRINT("EHCI_QueryEndpointRequirements: BulkTransfer\n");
+ EndpointRequirements->HeaderBufferSize = sizeof(EHCI_HCD_TD) +
+ sizeof(EHCI_HCD_QH) +
+ EHCI_MAX_BULK_TD_COUNT * sizeof(EHCI_HCD_TD);
+
+ EndpointRequirements->MaxTransferSize = EHCI_MAX_BULK_TRANSFER_SIZE;
+ break;
+
+ case USBPORT_TRANSFER_TYPE_INTERRUPT:
+ DPRINT("EHCI_QueryEndpointRequirements: InterruptTransfer\n");
+ EndpointRequirements->HeaderBufferSize = sizeof(EHCI_HCD_TD) +
+ sizeof(EHCI_HCD_QH) +
+ EHCI_MAX_INTERRUPT_TD_COUNT * sizeof(EHCI_HCD_TD);
+
+ EndpointRequirements->MaxTransferSize = EHCI_MAX_INTERRUPT_TRANSFER_SIZE;
+ break;
+
+ default:
+ DPRINT1("EHCI_QueryEndpointRequirements: Unknown TransferType - %x\n",
+ TransferType);
+ DbgBreakPoint();
+ break;
+ }
+}
+
+VOID
+NTAPI
+EHCI_DisablePeriodicList(IN PEHCI_EXTENSION EhciExtension)
+{
+ PEHCI_HW_REGISTERS OperationalRegs;
+ EHCI_USB_COMMAND Command;
+
+ DPRINT("EHCI_DisablePeriodicList: ... \n");
+
+ if (EhciExtension->Flags & EHCI_FLAGS_IDLE_SUPPORT)
+ {
+ OperationalRegs = EhciExtension->OperationalRegs;
+
+ Command.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+ Command.PeriodicEnable = 0;
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG, Command.AsULONG);
+ }
+}
+
+VOID
+NTAPI
+EHCI_CloseEndpoint(IN PVOID ehciExtension,
+ IN PVOID ehciEndpoint,
+ IN BOOLEAN DisablePeriodic)
+{
+ PEHCI_EXTENSION EhciExtension = ehciExtension;
+ PEHCI_ENDPOINT EhciEndpoint = ehciEndpoint;
+ ULONG TransferType;
+
+ DPRINT1("EHCI_CloseEndpoint: EhciEndpoint - %p, DisablePeriodic - %X\n",
+ EhciEndpoint,
+ DisablePeriodic);
+
+ if (DisablePeriodic)
+ {
+ TransferType = EhciEndpoint->EndpointProperties.TransferType;
+
+ if (TransferType == USBPORT_TRANSFER_TYPE_ISOCHRONOUS ||
+ TransferType == USBPORT_TRANSFER_TYPE_INTERRUPT)
+ {
+ EHCI_DisablePeriodicList(EhciExtension);
+ }
+ }
+}
+
+PEHCI_STATIC_QH
+NTAPI
+EHCI_GetQhForFrame(IN PEHCI_EXTENSION EhciExtension,
+ IN ULONG FrameIdx)
+{
+ //DPRINT_EHCI("EHCI_GetQhForFrame: FrameIdx - %x, Balance[FrameIdx] - %x\n",
+ // FrameIdx,
+ // Balance[FrameIdx & 0x1F]);
+
+ return EhciExtension->PeriodicHead[Balance[FrameIdx & (EHCI_FRAMES - 1)]];
+}
+
+PEHCI_HCD_QH
+NTAPI
+EHCI_GetDummyQhForFrame(IN PEHCI_EXTENSION EhciExtension,
+ IN ULONG Idx)
+{
+ return (PEHCI_HCD_QH)((ULONG_PTR)EhciExtension->IsoDummyQHListVA +
+ Idx * sizeof(EHCI_HCD_QH));
+}
+
+VOID
+NTAPI
+EHCI_AlignHwStructure(IN PEHCI_EXTENSION EhciExtension,
+ IN PULONG PhysicalAddress,
+ IN PULONG_PTR VirtualAddress,
+ IN ULONG Alignment)
+{
+ ULONG PAddress;
+ ULONG NewPAddress;
+ ULONG_PTR VAddress;
+
+ //DPRINT_EHCI("EHCI_AlignHwStructure: *PhysicalAddress - %X, *VirtualAddress - %X, Alignment - %x\n",
+ // *PhysicalAddress,
+ // *VirtualAddress,
+ // Alignment);
+
+ PAddress = *PhysicalAddress;
+ VAddress = *VirtualAddress;
+
+ NewPAddress = (ULONG)(ULONG_PTR)PAGE_ALIGN(*PhysicalAddress + Alignment - 1);
+
+ if (NewPAddress != (ULONG)(ULONG_PTR)PAGE_ALIGN(*PhysicalAddress))
+ {
+ VAddress += NewPAddress - PAddress;
+ PAddress = NewPAddress;
+
+ DPRINT("EHCI_AlignHwStructure: VAddress - %X, PAddress - %X\n",
+ VAddress,
+ PAddress);
+ }
+
+ *VirtualAddress = VAddress;
+ *PhysicalAddress = PAddress;
+}
+
+VOID
+NTAPI
+EHCI_AddDummyQHs(IN PEHCI_EXTENSION EhciExtension)
+{
+ PEHCI_HC_RESOURCES HcResourcesVA;
+ PEHCI_HCD_QH DummyQH;
+ ULONG DummyQhPA;
+ EHCI_QH_EP_PARAMS EndpointParams;
+ EHCI_LINK_POINTER PAddress;
+ ULONG Frame;
+
+ DPRINT("EHCI_AddDummyQueueHeads: EhciExtension - %p\n", EhciExtension);
+
+ HcResourcesVA = EhciExtension->HcResourcesVA;
+
+ DummyQH = EhciExtension->IsoDummyQHListVA;
+ DummyQhPA = EhciExtension->IsoDummyQHListPA;
+
+ for (Frame = 0; Frame < EHCI_FRAME_LIST_MAX_ENTRIES; Frame++)
+ {
+ RtlZeroMemory(DummyQH, sizeof(EHCI_HCD_QH));
+
+ PAddress.AsULONG = HcResourcesVA->PeriodicFrameList[Frame];
+
+ DummyQH->sqh.HwQH.HorizontalLink.AsULONG = PAddress.AsULONG;
+ DummyQH->sqh.HwQH.CurrentTD = 0;
+ DummyQH->sqh.HwQH.NextTD = TERMINATE_POINTER;
+ DummyQH->sqh.HwQH.AlternateNextTD = TERMINATE_POINTER;
+
+ EndpointParams = DummyQH->sqh.HwQH.EndpointParams;
+ EndpointParams.DeviceAddress = 0;
+ EndpointParams.EndpointSpeed = 0;
+ EndpointParams.MaximumPacketLength = EHCI_DUMMYQH_MAX_PACKET_LENGTH;
+ DummyQH->sqh.HwQH.EndpointParams = EndpointParams;
+
+ DummyQH->sqh.HwQH.EndpointCaps.AsULONG = 0;
+ DummyQH->sqh.HwQH.EndpointCaps.InterruptMask = 0;
+ DummyQH->sqh.HwQH.EndpointCaps.SplitCompletionMask = 0;
+ DummyQH->sqh.HwQH.EndpointCaps.PipeMultiplier = 1;
+
+ DummyQH->sqh.HwQH.Token.Status &= (UCHAR)~EHCI_TOKEN_STATUS_ACTIVE;
+
+ DummyQH->sqh.PhysicalAddress = DummyQhPA;
+ DummyQH->sqh.StaticQH = EHCI_GetQhForFrame(EhciExtension, Frame);
+
+ PAddress.AsULONG = DummyQhPA;
+ PAddress.Reserved = 0;
+ PAddress.Type = EHCI_LINK_TYPE_QH;
+
+ HcResourcesVA->PeriodicFrameList[Frame] = PAddress.AsULONG;
+
+ DummyQH++;
+ DummyQhPA += sizeof(EHCI_HCD_QH);
+ }
+}
+
+VOID
+NTAPI
+EHCI_InitializeInterruptSchedule(IN PEHCI_EXTENSION EhciExtension)
+{
+ PEHCI_STATIC_QH StaticQH;
+ ULONG ix;
+
+ DPRINT("EHCI_InitializeInterruptSchedule: ... \n");
+
+ for (ix = 0; ix < INTERRUPT_ENDPOINTs; ix++)
+ {
+ StaticQH = EhciExtension->PeriodicHead[ix];
+
+ StaticQH->HwQH.EndpointParams.HeadReclamationListFlag = 0;
+ StaticQH->HwQH.NextTD |= TERMINATE_POINTER;
+ StaticQH->HwQH.Token.Status |= (UCHAR)EHCI_TOKEN_STATUS_HALTED;
+ }
+
+ for (ix = 1; ix < INTERRUPT_ENDPOINTs; ix++)
+ {
+ StaticQH = EhciExtension->PeriodicHead[ix];
+
+ StaticQH->PrevHead = NULL;
+ StaticQH->NextHead = (PEHCI_HCD_QH)EhciExtension->PeriodicHead[LinkTable[ix]];
+
+ StaticQH->HwQH.HorizontalLink.AsULONG =
+ EhciExtension->PeriodicHead[LinkTable[ix]]->PhysicalAddress;
+
+ StaticQH->HwQH.HorizontalLink.Type = EHCI_LINK_TYPE_QH;
+ StaticQH->HwQH.EndpointCaps.InterruptMask = 0xFF;
+
+ StaticQH->QhFlags |= EHCI_QH_FLAG_STATIC;
+
+ if (ix < (ENDPOINT_INTERRUPT_8ms - 1))
+ StaticQH->QhFlags |= EHCI_QH_FLAG_STATIC_FAST;
+ }
+
+ EhciExtension->PeriodicHead[0]->HwQH.HorizontalLink.Terminate = 1;
+
+ EhciExtension->PeriodicHead[0]->QhFlags |= (EHCI_QH_FLAG_STATIC |
+ EHCI_QH_FLAG_STATIC_FAST);
+}
+
+MPSTATUS
+NTAPI
+EHCI_InitializeSchedule(IN PEHCI_EXTENSION EhciExtension,
+ IN ULONG_PTR BaseVA,
+ IN ULONG BasePA)
+{
+ PEHCI_HW_REGISTERS OperationalRegs;
+ PEHCI_HC_RESOURCES HcResourcesVA;
+ ULONG HcResourcesPA;
+ PEHCI_STATIC_QH AsyncHead;
+ ULONG AsyncHeadPA;
+ PEHCI_STATIC_QH PeriodicHead;
+ ULONG PeriodicHeadPA;
+ PEHCI_STATIC_QH StaticQH;
+ EHCI_LINK_POINTER NextLink;
+ EHCI_LINK_POINTER StaticHeadPA;
+ ULONG Frame;
+ ULONG ix;
+
+ DPRINT("EHCI_InitializeSchedule: BaseVA - %p, BasePA - %p\n",
+ BaseVA,
+ BasePA);
+
+ OperationalRegs = EhciExtension->OperationalRegs;
+
+ HcResourcesVA = (PEHCI_HC_RESOURCES)BaseVA;
+ HcResourcesPA = BasePA;
+
+ EhciExtension->HcResourcesVA = HcResourcesVA;
+ EhciExtension->HcResourcesPA = BasePA;
+
+ /* Asynchronous Schedule */
+
+ AsyncHead = &HcResourcesVA->AsyncHead;
+ AsyncHeadPA = HcResourcesPA + FIELD_OFFSET(EHCI_HC_RESOURCES, AsyncHead);
+
+ RtlZeroMemory(AsyncHead, sizeof(EHCI_STATIC_QH));
+
+ NextLink.AsULONG = AsyncHeadPA;
+ NextLink.Type = EHCI_LINK_TYPE_QH;
+
+ AsyncHead->HwQH.HorizontalLink = NextLink;
+ AsyncHead->HwQH.EndpointParams.HeadReclamationListFlag = 1;
+ AsyncHead->HwQH.EndpointCaps.PipeMultiplier = 1;
+ AsyncHead->HwQH.NextTD |= TERMINATE_POINTER;
+ AsyncHead->HwQH.Token.Status = (UCHAR)EHCI_TOKEN_STATUS_HALTED;
+
+ AsyncHead->PhysicalAddress = AsyncHeadPA;
+ AsyncHead->PrevHead = AsyncHead->NextHead = (PEHCI_HCD_QH)AsyncHead;
+
+ EhciExtension->AsyncHead = AsyncHead;
+
+ /* Periodic Schedule */
+
+ PeriodicHead = &HcResourcesVA->PeriodicHead[0];
+ PeriodicHeadPA = HcResourcesPA + FIELD_OFFSET(EHCI_HC_RESOURCES, PeriodicHead[0]);
+
+ for (ix = 0; ix < (INTERRUPT_ENDPOINTs + 1); ix++)
+ {
+ EHCI_AlignHwStructure(EhciExtension,
+ &PeriodicHeadPA,
+ (PULONG_PTR)&PeriodicHead,
+ 80);
+
+ EhciExtension->PeriodicHead[ix] = PeriodicHead;
+ EhciExtension->PeriodicHead[ix]->PhysicalAddress = PeriodicHeadPA;
+
+ PeriodicHead += 1;
+ PeriodicHeadPA += sizeof(EHCI_STATIC_QH);
+ }
+
+ EHCI_InitializeInterruptSchedule(EhciExtension);
+
+ for (Frame = 0; Frame < EHCI_FRAME_LIST_MAX_ENTRIES; Frame++)
+ {
+ StaticQH = EHCI_GetQhForFrame(EhciExtension, Frame);
+
+ StaticHeadPA.AsULONG = StaticQH->PhysicalAddress;
+ StaticHeadPA.Type = EHCI_LINK_TYPE_QH;
+
+ //DPRINT_EHCI("EHCI_InitializeSchedule: StaticHeadPA[%x] - %X\n",
+ // Frame,
+ // StaticHeadPA);
+
+ HcResourcesVA->PeriodicFrameList[Frame] = StaticHeadPA.AsULONG;
+ }
+
+ EhciExtension->IsoDummyQHListVA = &HcResourcesVA->IsoDummyQH[0];
+ EhciExtension->IsoDummyQHListPA = HcResourcesPA + FIELD_OFFSET(EHCI_HC_RESOURCES, IsoDummyQH[0]);
+
+ EHCI_AddDummyQHs(EhciExtension);
+
+ WRITE_REGISTER_ULONG(&OperationalRegs->PeriodicListBase,
+ EhciExtension->HcResourcesPA + FIELD_OFFSET(EHCI_HC_RESOURCES, PeriodicFrameList));
+
+ WRITE_REGISTER_ULONG(&OperationalRegs->AsyncListBase,
+ NextLink.AsULONG);
+
+ return MP_STATUS_SUCCESS;
+}
+
+MPSTATUS
+NTAPI
+EHCI_InitializeHardware(IN PEHCI_EXTENSION EhciExtension)
+{
+ PEHCI_HC_CAPABILITY_REGISTERS CapabilityRegisters;
+ PEHCI_HW_REGISTERS OperationalRegs;
+ EHCI_USB_COMMAND Command;
+ LARGE_INTEGER EndTime;
+ LARGE_INTEGER CurrentTime;
+ EHCI_HC_STRUCTURAL_PARAMS StructuralParams;
+
+ DPRINT("EHCI_InitializeHardware: ... \n");
+
+ OperationalRegs = EhciExtension->OperationalRegs;
+ CapabilityRegisters = EhciExtension->CapabilityRegisters;
+
+ Command.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+ Command.Reset = 1;
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG, Command.AsULONG);
+
+ KeQuerySystemTime(&EndTime);
+ EndTime.QuadPart += 100 * 10000; // 100 msec
+
+ DPRINT("EHCI_InitializeHardware: Start reset ... \n");
+
+ while (TRUE)
+ {
+ KeQuerySystemTime(&CurrentTime);
+ Command.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+
+ if (Command.Reset != 1)
+ break;
+
+ if (CurrentTime.QuadPart >= EndTime.QuadPart)
+ {
+ if (Command.Reset == 1)
+ {
+ DPRINT1("EHCI_InitializeHardware: Reset failed!\n");
+ return MP_STATUS_HW_ERROR;
+ }
+
+ break;
+ }
+ }
+
+ DPRINT("EHCI_InitializeHardware: Reset - OK\n");
+
+ StructuralParams.AsULONG = READ_REGISTER_ULONG(&CapabilityRegisters->StructParameters.AsULONG);
+
+ EhciExtension->NumberOfPorts = StructuralParams.PortCount;
+ EhciExtension->PortPowerControl = StructuralParams.PortPowerControl;
+
+ DPRINT("EHCI_InitializeHardware: StructuralParams - %X\n", StructuralParams.AsULONG);
+ DPRINT("EHCI_InitializeHardware: PortPowerControl - %x\n", EhciExtension->PortPowerControl);
+ DPRINT("EHCI_InitializeHardware: N_PORTS - %x\n", EhciExtension->NumberOfPorts);
+
+ WRITE_REGISTER_ULONG(&OperationalRegs->PeriodicListBase, 0);
+ WRITE_REGISTER_ULONG(&OperationalRegs->AsyncListBase, 0);
+
+ EhciExtension->InterruptMask.AsULONG = 0;
+ EhciExtension->InterruptMask.Interrupt = 1;
+ EhciExtension->InterruptMask.ErrorInterrupt = 1;
+ EhciExtension->InterruptMask.PortChangeInterrupt = 0;
+ EhciExtension->InterruptMask.FrameListRollover = 1;
+ EhciExtension->InterruptMask.HostSystemError = 1;
+ EhciExtension->InterruptMask.InterruptOnAsyncAdvance = 1;
+
+ return MP_STATUS_SUCCESS;
+}
+
+UCHAR
+NTAPI
+EHCI_GetOffsetEECP(IN PEHCI_EXTENSION EhciExtension,
+ IN UCHAR CapabilityID)
+{
+ EHCI_LEGACY_EXTENDED_CAPABILITY LegacyCapability;
+ EHCI_HC_CAPABILITY_PARAMS CapParameters;
+ UCHAR OffsetEECP;
+
+ DPRINT("EHCI_GetOffsetEECP: CapabilityID - %x\n", CapabilityID);
+
+ CapParameters = EhciExtension->CapabilityRegisters->CapParameters;
+
+ OffsetEECP = CapParameters.ExtCapabilitiesPointer;
+
+ if (!OffsetEECP)
+ return 0;
+
+ while (TRUE)
+ {
+ RegPacket.UsbPortReadWriteConfigSpace(EhciExtension,
+ TRUE,
+ &LegacyCapability.AsULONG,
+ OffsetEECP,
+ sizeof(LegacyCapability));
+
+ DPRINT("EHCI_GetOffsetEECP: OffsetEECP - %x\n", OffsetEECP);
+
+ if (LegacyCapability.CapabilityID == CapabilityID)
+ break;
+
+ OffsetEECP = LegacyCapability.NextCapabilityPointer;
+
+ if (!OffsetEECP)
+ return 0;
+ }
+
+ return OffsetEECP;
+}
+
+MPSTATUS
+NTAPI
+EHCI_TakeControlHC(IN PEHCI_EXTENSION EhciExtension)
+{
+ LARGE_INTEGER EndTime;
+ LARGE_INTEGER CurrentTime;
+ EHCI_LEGACY_EXTENDED_CAPABILITY LegacyCapability;
+ UCHAR OffsetEECP;
+
+ DPRINT("EHCI_TakeControlHC: EhciExtension - %p\n", EhciExtension);
+
+ OffsetEECP = EHCI_GetOffsetEECP(EhciExtension, 1);
+
+ if (OffsetEECP == 0)
+ return MP_STATUS_SUCCESS;
+
+ DPRINT("EHCI_TakeControlHC: OffsetEECP - %X\n", OffsetEECP);
+
+ RegPacket.UsbPortReadWriteConfigSpace(EhciExtension,
+ TRUE,
+ &LegacyCapability.AsULONG,
+ OffsetEECP,
+ sizeof(LegacyCapability));
+
+ if (LegacyCapability.BiosOwnedSemaphore == 0)
+ return MP_STATUS_SUCCESS;
+
+ LegacyCapability.OsOwnedSemaphore = 1;
+
+ RegPacket.UsbPortReadWriteConfigSpace(EhciExtension,
+ FALSE,
+ &LegacyCapability.AsULONG,
+ OffsetEECP,
+ sizeof(LegacyCapability));
+
+ KeQuerySystemTime(&EndTime);
+ EndTime.QuadPart += 100 * 10000;
+
+ do
+ {
+ RegPacket.UsbPortReadWriteConfigSpace(EhciExtension,
+ TRUE,
+ &LegacyCapability.AsULONG,
+ OffsetEECP,
+ sizeof(LegacyCapability));
+ KeQuerySystemTime(&CurrentTime);
+
+ if (LegacyCapability.BiosOwnedSemaphore)
+ {
+ DPRINT("EHCI_TakeControlHC: Ownership is ok\n");
+ break;
+ }
+ }
+ while (CurrentTime.QuadPart <= EndTime.QuadPart);
+
+ return MP_STATUS_SUCCESS;
+}
+
+VOID
+NTAPI
+EHCI_GetRegistryParameters(IN PEHCI_EXTENSION EhciExtension)
+{
+ DPRINT1("EHCI_GetRegistryParameters: UNIMPLEMENTED. FIXME\n");
+}
+
+MPSTATUS
+NTAPI
+EHCI_StartController(IN PVOID ehciExtension,
+ IN PUSBPORT_RESOURCES Resources)
+{
+ PEHCI_EXTENSION EhciExtension = ehciExtension;
+ PEHCI_HC_CAPABILITY_REGISTERS CapabilityRegisters;
+ PEHCI_HW_REGISTERS OperationalRegs;
+ MPSTATUS MPStatus;
+ EHCI_USB_COMMAND Command;
+ UCHAR CapabilityRegLength;
+ UCHAR Fladj;
+
+ DPRINT("EHCI_StartController: ... \n");
+
+ if ((Resources->ResourcesTypes & (USBPORT_RESOURCES_MEMORY | USBPORT_RESOURCES_INTERRUPT)) !=
+ (USBPORT_RESOURCES_MEMORY | USBPORT_RESOURCES_INTERRUPT))
+ {
+ DPRINT1("EHCI_StartController: Resources->ResourcesTypes - %x\n",
+ Resources->ResourcesTypes);
+
+ return MP_STATUS_ERROR;
+ }
+
+ CapabilityRegisters = (PEHCI_HC_CAPABILITY_REGISTERS)Resources->ResourceBase;
+ EhciExtension->CapabilityRegisters = CapabilityRegisters;
+
+ CapabilityRegLength = READ_REGISTER_UCHAR(&CapabilityRegisters->RegistersLength);
+
+ OperationalRegs = (PEHCI_HW_REGISTERS)((ULONG_PTR)CapabilityRegisters +
+ CapabilityRegLength);
+
+ EhciExtension->OperationalRegs = OperationalRegs;
+
+ DPRINT("EHCI_StartController: CapabilityRegisters - %p\n", CapabilityRegisters);
+ DPRINT("EHCI_StartController: OperationalRegs - %p\n", OperationalRegs);
+
+ RegPacket.UsbPortReadWriteConfigSpace(EhciExtension,
+ TRUE,
+ &Fladj,
+ EHCI_FLADJ_PCI_CONFIG_OFFSET,
+ sizeof(Fladj));
+
+ EhciExtension->FrameLengthAdjustment = Fladj;
+
+ EHCI_GetRegistryParameters(EhciExtension);
+
+ MPStatus = EHCI_TakeControlHC(EhciExtension);
+
+ if (MPStatus)
+ {
+ DPRINT1("EHCI_StartController: Unsuccessful TakeControlHC()\n");
+ return MPStatus;
+ }
+
+ MPStatus = EHCI_InitializeHardware(EhciExtension);
+
+ if (MPStatus)
+ {
+ DPRINT1("EHCI_StartController: Unsuccessful InitializeHardware()\n");
+ return MPStatus;
+ }
+
+ MPStatus = EHCI_InitializeSchedule(EhciExtension,
+ Resources->StartVA,
+ Resources->StartPA);
+
+ if (MPStatus)
+ {
+ DPRINT1("EHCI_StartController: Unsuccessful InitializeSchedule()\n");
+ return MPStatus;
+ }
+
+ RegPacket.UsbPortReadWriteConfigSpace(EhciExtension,
+ TRUE,
+ &Fladj,
+ EHCI_FLADJ_PCI_CONFIG_OFFSET,
+ sizeof(Fladj));
+
+ if (Fladj != EhciExtension->FrameLengthAdjustment)
+ {
+ Fladj = EhciExtension->FrameLengthAdjustment;
+
+ RegPacket.UsbPortReadWriteConfigSpace(EhciExtension,
+ FALSE, // write
+ &Fladj,
+ EHCI_FLADJ_PCI_CONFIG_OFFSET,
+ sizeof(Fladj));
+ }
+
+ /* Port routing control logic default-routes all ports to this HC */
+ EhciExtension->PortRoutingControl = EHCI_CONFIG_FLAG_CONFIGURED;
+ WRITE_REGISTER_ULONG(&OperationalRegs->ConfigFlag,
+ EhciExtension->PortRoutingControl);
+
+ Command.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+ Command.InterruptThreshold = 1; // one micro-frame
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG, Command.AsULONG);
+
+ Command.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+ Command.Run = 1; // execution of the schedule
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG, Command.AsULONG);
+
+ EhciExtension->IsStarted = TRUE;
+
+ if (Resources->IsChirpHandled)
+ {
+ ULONG Port;
+
+ for (Port = 1; Port <= EhciExtension->NumberOfPorts; Port++)
+ {
+ EHCI_RH_SetFeaturePortPower(EhciExtension, Port);
+ }
+
+ RegPacket.UsbPortWait(EhciExtension, 200);
+
+ for (Port = 1; Port <= EhciExtension->NumberOfPorts; Port++)
+ {
+ EHCI_RH_ChirpRootPort(EhciExtension, Port++);
+ }
+ }
+
+ return MPStatus;
+}
+
+VOID
+NTAPI
+EHCI_StopController(IN PVOID ehciExtension,
+ IN BOOLEAN DisableInterrupts)
+{
+ DPRINT1("EHCI_StopController: UNIMPLEMENTED. FIXME\n");
+}
+
+VOID
+NTAPI
+EHCI_SuspendController(IN PVOID ehciExtension)
+{
+ PEHCI_EXTENSION EhciExtension = ehciExtension;
+ PEHCI_HW_REGISTERS OperationalRegs;
+ EHCI_USB_COMMAND Command;
+ EHCI_USB_STATUS Status;
+ EHCI_INTERRUPT_ENABLE IntrEn;
+ ULONG ix;
+
+ DPRINT("EHCI_SuspendController: ... \n");
+
+ OperationalRegs = EhciExtension->OperationalRegs;
+
+ EhciExtension->BackupPeriodiclistbase = READ_REGISTER_ULONG(&OperationalRegs->PeriodicListBase);
+ EhciExtension->BackupAsynclistaddr = READ_REGISTER_ULONG(&OperationalRegs->AsyncListBase);
+ EhciExtension->BackupCtrlDSSegment = READ_REGISTER_ULONG(&OperationalRegs->SegmentSelector);
+ EhciExtension->BackupUSBCmd = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+
+ Command.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+ Command.InterruptAdvanceDoorbell = 0;
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG, Command.AsULONG);
+
+ Command.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+ Command.Run = 0;
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG, Command.AsULONG);
+
+ KeStallExecutionProcessor(125);
+
+ Status.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcStatus.AsULONG);
+
+ Status.HCHalted = 0;
+ Status.Reclamation = 0;
+ Status.PeriodicStatus = 0;
+ Status.AsynchronousStatus = 0;
+
+ if (Status.AsULONG)
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcStatus.AsULONG, Status.AsULONG);
+
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcInterruptEnable.AsULONG, 0);
+
+ for (ix = 0; ix < 10; ix++)
+ {
+ Status.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcStatus.AsULONG);
+
+ if (Status.HCHalted)
+ break;
+
+ RegPacket.UsbPortWait(EhciExtension, 1);
+ }
+
+ if (!Status.HCHalted)
+ DbgBreakPoint();
+
+ IntrEn.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcInterruptEnable.AsULONG);
+ IntrEn.PortChangeInterrupt = 1;
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcInterruptEnable.AsULONG, IntrEn.AsULONG);
+
+ EhciExtension->Flags |= EHCI_FLAGS_CONTROLLER_SUSPEND;
+}
+
+MPSTATUS
+NTAPI
+EHCI_ResumeController(IN PVOID ehciExtension)
+{
+ PEHCI_EXTENSION EhciExtension = ehciExtension;
+ PEHCI_HW_REGISTERS OperationalRegs;
+ ULONG RoutingControl;
+ EHCI_USB_COMMAND Command;
+
+ DPRINT("EHCI_ResumeController: ... \n");
+
+ OperationalRegs = EhciExtension->OperationalRegs;
+
+ RoutingControl = EhciExtension->PortRoutingControl;
+
+ if (!(RoutingControl & EHCI_CONFIG_FLAG_CONFIGURED))
+ {
+ EhciExtension->PortRoutingControl = RoutingControl | EHCI_CONFIG_FLAG_CONFIGURED;
+ WRITE_REGISTER_ULONG(&OperationalRegs->ConfigFlag,
+ EhciExtension->PortRoutingControl);
+
+ return MP_STATUS_HW_ERROR;
+ }
+
+ WRITE_REGISTER_ULONG(&OperationalRegs->SegmentSelector,
+ EhciExtension->BackupCtrlDSSegment);
+
+ WRITE_REGISTER_ULONG(&OperationalRegs->PeriodicListBase,
+ EhciExtension->BackupPeriodiclistbase);
+
+ WRITE_REGISTER_ULONG(&OperationalRegs->AsyncListBase,
+ EhciExtension->BackupAsynclistaddr);
+
+ Command.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+
+ Command.AsULONG = Command.AsULONG ^ EhciExtension->BackupUSBCmd;
+
+ Command.Reset = 0;
+ Command.FrameListSize = 0;
+ Command.InterruptAdvanceDoorbell = 0;
+ Command.LightResetHC = 0;
+ Command.AsynchronousParkModeCount = 0;
+ Command.AsynchronousParkModeEnable = 0;
+
+ Command.Run = 1;
+
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG,
+ Command.AsULONG);
+
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcInterruptEnable.AsULONG,
+ EhciExtension->InterruptMask.AsULONG);
+
+ EhciExtension->Flags &= ~EHCI_FLAGS_CONTROLLER_SUSPEND;
+
+ return MP_STATUS_SUCCESS;
+}
+
+BOOLEAN
+NTAPI
+EHCI_HardwarePresent(IN PEHCI_EXTENSION EhciExtension,
+ IN BOOLEAN IsInvalidateController)
+{
+ PEHCI_HW_REGISTERS OperationalRegs = EhciExtension->OperationalRegs;
+
+ if (READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG) != -1)
+ return TRUE;
+
+ DPRINT1("EHCI_HardwarePresent: IsInvalidateController - %x\n",
+ IsInvalidateController);
+
+ if (!IsInvalidateController)
+ return FALSE;
+
+ RegPacket.UsbPortInvalidateController(EhciExtension,
+ USBPORT_INVALIDATE_CONTROLLER_SURPRISE_REMOVE);
+ return FALSE;
+}
+
+BOOLEAN
+NTAPI
+EHCI_InterruptService(IN PVOID ehciExtension)
+{
+ PEHCI_EXTENSION EhciExtension = ehciExtension;
+ PEHCI_HW_REGISTERS OperationalRegs;
+ BOOLEAN Result = FALSE;
+ EHCI_USB_STATUS IntrSts;
+ EHCI_INTERRUPT_ENABLE IntrEn;
+ EHCI_INTERRUPT_ENABLE iStatus;
+ EHCI_USB_COMMAND Command;
+ ULONG FrameIndex;
+
+ OperationalRegs = EhciExtension->OperationalRegs;
+
+ DPRINT_EHCI("EHCI_InterruptService: ... \n");
+
+ Result = EHCI_HardwarePresent(EhciExtension, FALSE);
+
+ if (!Result)
+ return FALSE;
+
+ IntrEn.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcInterruptEnable.AsULONG);
+ IntrSts.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcStatus.AsULONG);
+
+ iStatus.AsULONG = (IntrEn.AsULONG & IntrSts.AsULONG) & EHCI_INTERRUPT_MASK;
+
+ if (!iStatus.AsULONG)
+ return FALSE;
+
+ EhciExtension->InterruptStatus = iStatus;
+
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcStatus.AsULONG, iStatus.AsULONG);
+
+ if (iStatus.HostSystemError)
+ {
+ EhciExtension->HcSystemErrors++;
+
+ if (EhciExtension->HcSystemErrors < EHCI_MAX_HC_SYSTEM_ERRORS)
+ {
+ Command.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+ Command.Run = 1;
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG, Command.AsULONG);
+ }
+ }
+
+ FrameIndex = READ_REGISTER_ULONG(&OperationalRegs->FrameIndex) / EHCI_MICROFRAMES;
+ FrameIndex &= EHCI_FRINDEX_FRAME_MASK;
+
+ if ((FrameIndex ^ EhciExtension->FrameIndex) & EHCI_FRAME_LIST_MAX_ENTRIES)
+ {
+ EhciExtension->FrameHighPart += 2 * EHCI_FRAME_LIST_MAX_ENTRIES;
+
+ EhciExtension->FrameHighPart -= (FrameIndex ^ EhciExtension->FrameHighPart) &
+ EHCI_FRAME_LIST_MAX_ENTRIES;
+ }
+
+ EhciExtension->FrameIndex = FrameIndex;
+
+ return TRUE;
+}
+
+VOID
+NTAPI
+EHCI_InterruptDpc(IN PVOID ehciExtension,
+ IN BOOLEAN EnableInterrupts)
+{
+ PEHCI_EXTENSION EhciExtension = ehciExtension;
+ PEHCI_HW_REGISTERS OperationalRegs;
+ EHCI_INTERRUPT_ENABLE iStatus;
+
+ OperationalRegs = EhciExtension->OperationalRegs;
+
+ DPRINT_EHCI("EHCI_InterruptDpc: [%p] EnableInterrupts - %x\n",
+ EhciExtension, EnableInterrupts);
+
+ iStatus = EhciExtension->InterruptStatus;
+ EhciExtension->InterruptStatus.AsULONG = 0;
+
+ if (iStatus.Interrupt == 1 ||
+ iStatus.ErrorInterrupt == 1 ||
+ iStatus.InterruptOnAsyncAdvance == 1)
+ {
+ DPRINT_EHCI("EHCI_InterruptDpc: [%p] InterruptStatus - %X\n", EhciExtension, iStatus.AsULONG);
+ RegPacket.UsbPortInvalidateEndpoint(EhciExtension, NULL);
+ }
+
+ if (iStatus.PortChangeInterrupt == 1)
+ {
+ DPRINT_EHCI("EHCI_InterruptDpc: [%p] PortChangeInterrupt\n", EhciExtension);
+ RegPacket.UsbPortInvalidateRootHub(EhciExtension);
+ }
+
+ if (EnableInterrupts)
+ {
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcInterruptEnable.AsULONG,
+ EhciExtension->InterruptMask.AsULONG);
+ }
+}
+
+ULONG
+NTAPI
+EHCI_MapAsyncTransferToTd(IN PEHCI_EXTENSION EhciExtension,
+ IN ULONG MaxPacketSize,
+ IN ULONG TransferedLen,
+ IN PULONG DataToggle,
+ IN PEHCI_TRANSFER EhciTransfer,
+ IN PEHCI_HCD_TD TD,
+ IN PUSBPORT_SCATTER_GATHER_LIST SgList)
+{
+ PUSBPORT_TRANSFER_PARAMETERS TransferParameters;
+ PUSBPORT_SCATTER_GATHER_ELEMENT SgElement;
+ ULONG SgIdx;
+ ULONG LengthThisTD;
+ ULONG ix;
+ ULONG SgRemain;
+ ULONG DiffLength;
+ ULONG NumPackets;
+
+ DPRINT_EHCI("EHCI_MapAsyncTransferToTd: EhciTransfer - %p, TD - %p, TransferedLen - %x, MaxPacketSize - %x, DataToggle - %x\n",
+ EhciTransfer,
+ TD,
+ TransferedLen,
+ MaxPacketSize,
+ DataToggle);
+
+ TransferParameters = EhciTransfer->TransferParameters;
+
+ SgElement = &SgList->SgElement[0];
+
+ for (SgIdx = 0; SgIdx < SgList->SgElementCount; SgIdx++)
+ {
+ if (TransferedLen >= SgElement->SgOffset &&
+ TransferedLen < SgElement->SgOffset + SgElement->SgTransferLength)
+ {
+ break;
+ }
+
+ SgElement += 1;
+ }
+
+ SgRemain = SgList->SgElementCount - SgIdx;
+
+ if (SgRemain > EHCI_MAX_QTD_BUFFER_PAGES)
+ {
+ TD->HwTD.Buffer[0] = SgList->SgElement[SgIdx].SgPhysicalAddress.LowPart -
+ SgList->SgElement[SgIdx].SgOffset +
+ TransferedLen;
+
+ LengthThisTD = EHCI_MAX_QTD_BUFFER_PAGES * PAGE_SIZE -
+ (TD->HwTD.Buffer[0] & (PAGE_SIZE - 1));
+
+ for (ix = 1; ix < EHCI_MAX_QTD_BUFFER_PAGES; ix++)
+ {
+ TD->HwTD.Buffer[ix] = SgList->SgElement[SgIdx + ix].SgPhysicalAddress.LowPart;
+ }
+
+ NumPackets = LengthThisTD / MaxPacketSize;
+ DiffLength = LengthThisTD - MaxPacketSize * (LengthThisTD / MaxPacketSize);
+
+ if (LengthThisTD != MaxPacketSize * (LengthThisTD / MaxPacketSize))
+ LengthThisTD -= DiffLength;
+
+ if (DataToggle && (NumPackets & 1))
+ *DataToggle = !(*DataToggle);
+ }
+ else
+ {
+ LengthThisTD = TransferParameters->TransferBufferLength - TransferedLen;
+
+ TD->HwTD.Buffer[0] = TransferedLen +
+ SgList->SgElement[SgIdx].SgPhysicalAddress.LowPart -
+ SgList->SgElement[SgIdx].SgOffset;
+
+ for (ix = 1; ix < EHCI_MAX_QTD_BUFFER_PAGES; ix++)
+ {
+ if ((SgIdx + ix) >= SgList->SgElementCount)
+ break;
+
+ TD->HwTD.Buffer[ix] = SgList->SgElement[SgIdx + ix].SgPhysicalAddress.LowPart;
+ }
+ }
+
+ TD->HwTD.Token.TransferBytes = LengthThisTD;
+ TD->LengthThisTD = LengthThisTD;
+
+ return LengthThisTD + TransferedLen;
+}
+
+VOID
+NTAPI
+EHCI_EnableAsyncList(IN PEHCI_EXTENSION EhciExtension)
+{
+ PEHCI_HW_REGISTERS OperationalRegs;
+ EHCI_USB_COMMAND UsbCmd;
+
+ DPRINT_EHCI("EHCI_EnableAsyncList: ... \n");
+
+ OperationalRegs = EhciExtension->OperationalRegs;
+
+ UsbCmd.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+ UsbCmd.AsynchronousEnable = 1;
+ WRITE_REGISTER_ULONG((&OperationalRegs->HcCommand.AsULONG), UsbCmd.AsULONG);
+}
+
+VOID
+NTAPI
+EHCI_DisableAsyncList(IN PEHCI_EXTENSION EhciExtension)
+{
+ PEHCI_HW_REGISTERS OperationalRegs;
+ EHCI_USB_COMMAND UsbCmd;
+
+ DPRINT("EHCI_DisableAsyncList: ... \n");
+
+ OperationalRegs = EhciExtension->OperationalRegs;
+
+ UsbCmd.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+ UsbCmd.AsynchronousEnable = 0;
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG, UsbCmd.AsULONG);
+}
+
+VOID
+NTAPI
+EHCI_EnablePeriodicList(IN PEHCI_EXTENSION EhciExtension)
+{
+ PEHCI_HW_REGISTERS OperationalRegs;
+ EHCI_USB_COMMAND Command;
+
+ DPRINT("EHCI_EnablePeriodicList: ... \n");
+
+ OperationalRegs = EhciExtension->OperationalRegs;
+
+ Command.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+ Command.PeriodicEnable = 1;
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG, Command.AsULONG);
+}
+
+VOID
+NTAPI
+EHCI_FlushAsyncCache(IN PEHCI_EXTENSION EhciExtension)
+{
+ PEHCI_HW_REGISTERS OperationalRegs;
+ EHCI_USB_COMMAND Command;
+ EHCI_USB_STATUS Status;
+ LARGE_INTEGER CurrentTime;
+ LARGE_INTEGER EndTime;
+ EHCI_USB_COMMAND Cmd;
+
+ DPRINT_EHCI("EHCI_FlushAsyncCache: EhciExtension - %p\n", EhciExtension);
+
+ OperationalRegs = EhciExtension->OperationalRegs;
+ Command.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+ Status.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcStatus.AsULONG);
+
+ if (!Status.AsynchronousStatus && !Command.AsynchronousEnable)
+ return;
+
+ if (Status.AsynchronousStatus && !Command.AsynchronousEnable)
+ {
+ KeQuerySystemTime(&EndTime);
+ EndTime.QuadPart += 100 * 10000; //100 ms
+
+ do
+ {
+ Status.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcStatus.AsULONG);
+ Command.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+ KeQuerySystemTime(&CurrentTime);
+
+ if (CurrentTime.QuadPart > EndTime.QuadPart)
+ RegPacket.UsbPortBugCheck(EhciExtension);
+ }
+ while (Status.AsynchronousStatus && Command.AsULONG != -1 && Command.Run);
+
+ return;
+ }
+
+ if (!Status.AsynchronousStatus && Command.AsynchronousEnable)
+ {
+ KeQuerySystemTime(&EndTime);
+ EndTime.QuadPart += 100 * 10000; //100 ms
+
+ do
+ {
+ Status.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcStatus.AsULONG);
+ Command.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+ KeQuerySystemTime(&CurrentTime);
+ }
+ while (!Status.AsynchronousStatus && Command.AsULONG != -1 && Command.Run);
+ }
+
+ Command.InterruptAdvanceDoorbell = 1;
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG, Command.AsULONG);
+
+ KeQuerySystemTime(&EndTime);
+ EndTime.QuadPart += 100 * 10000; //100 ms
+
+ Cmd.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+
+ if (Cmd.InterruptAdvanceDoorbell)
+ {
+ while (Cmd.Run)
+ {
+ if (Cmd.AsULONG == -1)
+ break;
+
+ KeStallExecutionProcessor(1);
+ Command.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+ KeQuerySystemTime(&CurrentTime);
+
+ if (!Command.InterruptAdvanceDoorbell)
+ break;
+
+ Cmd = Command;
+ }
+ }
+
+ /* InterruptOnAsyncAdvance */
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcStatus.AsULONG, 0x20);
+}
+
+VOID
+NTAPI
+EHCI_LockQH(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_HCD_QH QH,
+ IN ULONG TransferType)
+{
+ PEHCI_HCD_QH PrevQH;
+ PEHCI_HCD_QH NextQH;
+ ULONG QhPA;
+ ULONG FrameIndexReg;
+ PEHCI_HW_REGISTERS OperationalRegs;
+ EHCI_USB_COMMAND Command;
+
+ DPRINT_EHCI("EHCI_LockQH: QH - %p, TransferType - %x\n",
+ QH,
+ TransferType);
+
+ OperationalRegs = EhciExtension->OperationalRegs;
+
+ ASSERT((QH->sqh.QhFlags & EHCI_QH_FLAG_UPDATING) == 0);
+ ASSERT(EhciExtension->LockQH == NULL);
+
+ PrevQH = QH->sqh.PrevHead;
+ QH->sqh.QhFlags |= EHCI_QH_FLAG_UPDATING;
+
+ ASSERT(PrevQH);
+
+ NextQH = QH->sqh.NextHead;
+
+ EhciExtension->PrevQH = PrevQH;
+ EhciExtension->NextQH = NextQH;
+ EhciExtension->LockQH = QH;
+
+ if (NextQH)
+ {
+ QhPA = NextQH->sqh.PhysicalAddress;
+ QhPA &= LINK_POINTER_MASK + TERMINATE_POINTER;
+ QhPA |= (EHCI_LINK_TYPE_QH << 1);
+ }
+ else
+ {
+ QhPA = TERMINATE_POINTER;
+ }
+
+ PrevQH->sqh.HwQH.HorizontalLink.AsULONG = QhPA;
+
+ FrameIndexReg = READ_REGISTER_ULONG(&OperationalRegs->FrameIndex);
+
+ if (TransferType == USBPORT_TRANSFER_TYPE_INTERRUPT)
+ {
+ do
+ {
+ Command.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+ }
+ while (READ_REGISTER_ULONG(&OperationalRegs->FrameIndex) ==
+ FrameIndexReg && (Command.AsULONG != -1) && Command.Run);
+ }
+ else
+ {
+ EHCI_FlushAsyncCache(EhciExtension);
+ }
+}
+
+VOID
+NTAPI
+EHCI_UnlockQH(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_HCD_QH QH)
+{
+ ULONG QhPA;
+
+ DPRINT_EHCI("EHCI_UnlockQH: QH - %p\n", QH);
+
+ ASSERT(QH->sqh.QhFlags & EHCI_QH_FLAG_UPDATING);
+ ASSERT(EhciExtension->LockQH);
+ ASSERT(EhciExtension->LockQH == QH);
+
+ QH->sqh.QhFlags &= ~EHCI_QH_FLAG_UPDATING;
+
+ EhciExtension->LockQH = NULL;
+
+ QhPA = QH->sqh.PhysicalAddress;
+ QhPA &= LINK_POINTER_MASK + TERMINATE_POINTER;
+ QhPA |= (EHCI_LINK_TYPE_QH << 1);
+
+ EhciExtension->PrevQH->sqh.HwQH.HorizontalLink.AsULONG = QhPA;
+}
+
+VOID
+NTAPI
+EHCI_LinkTransferToQueue(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_ENDPOINT EhciEndpoint,
+ IN PEHCI_HCD_TD NextTD)
+{
+ PEHCI_HCD_QH QH;
+ PEHCI_HCD_TD TD;
+ PEHCI_TRANSFER Transfer;
+ PEHCI_HCD_TD LinkTD;
+ BOOLEAN IsPresent;
+ ULONG ix;
+
+ DPRINT_EHCI("EHCI_LinkTransferToQueue: EhciEndpoint - %p, NextTD - %p\n",
+ EhciEndpoint,
+ NextTD);
+
+ ASSERT(EhciEndpoint->HcdHeadP != NULL);
+ IsPresent = EHCI_HardwarePresent(EhciExtension, 0);
+
+ QH = EhciEndpoint->QH;
+ TD = EhciEndpoint->HcdHeadP;
+
+ if (TD == EhciEndpoint->HcdTailP)
+ {
+ if (IsPresent)
+ {
+ EHCI_LockQH(EhciExtension,
+ QH,
+ EhciEndpoint->EndpointProperties.TransferType);
+ }
+
+ QH->sqh.HwQH.CurrentTD = EhciEndpoint->DmaBufferPA;
+ QH->sqh.HwQH.NextTD = NextTD->PhysicalAddress;
+ QH->sqh.HwQH.AlternateNextTD = NextTD->HwTD.AlternateNextTD;
+
+ QH->sqh.HwQH.Token.Status = (UCHAR)~(EHCI_TOKEN_STATUS_ACTIVE |
+ EHCI_TOKEN_STATUS_HALTED);
+
+ QH->sqh.HwQH.Token.TransferBytes = 0;
+
+ if (IsPresent)
+ EHCI_UnlockQH(EhciExtension, QH);
+
+ EhciEndpoint->HcdHeadP = NextTD;
+ }
+ else
+ {
+ DPRINT_EHCI("EHCI_LinkTransferToQueue: TD - %p, HcdTailP - %p\n",
+ EhciEndpoint->HcdHeadP,
+ EhciEndpoint->HcdTailP);
+
+ LinkTD = EhciEndpoint->HcdHeadP;
+
+ while (TD != EhciEndpoint->HcdTailP)
+ {
+ LinkTD = TD;
+ TD = TD->NextHcdTD;
+ }
+
+ ASSERT(LinkTD != EhciEndpoint->HcdTailP);
+
+ Transfer = LinkTD->EhciTransfer;
+
+ TD = EhciEndpoint->FirstTD;
+
+ for (ix = 0; ix < EhciEndpoint->MaxTDs; ix++)
+ {
+ if (TD->EhciTransfer == Transfer)
+ {
+ TD->AltNextHcdTD = NextTD;
+ TD->HwTD.AlternateNextTD = NextTD->PhysicalAddress;
+ }
+
+ TD += 1;
+ }
+
+ LinkTD->HwTD.NextTD = NextTD->PhysicalAddress;
+ LinkTD->NextHcdTD = NextTD;
+
+ if (QH->sqh.HwQH.CurrentTD == LinkTD->PhysicalAddress)
+ {
+ QH->sqh.HwQH.NextTD = NextTD->PhysicalAddress;
+ QH->sqh.HwQH.AlternateNextTD = TERMINATE_POINTER;
+ }
+ }
+}
+
+MPSTATUS
+NTAPI
+EHCI_ControlTransfer(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_ENDPOINT EhciEndpoint,
+ IN PUSBPORT_TRANSFER_PARAMETERS TransferParameters,
+ IN PEHCI_TRANSFER EhciTransfer,
+ IN PUSBPORT_SCATTER_GATHER_LIST SgList)
+{
+ PEHCI_HCD_TD FirstTD;
+ PEHCI_HCD_TD LastTD;
+ PEHCI_HCD_TD TD;
+ PEHCI_HCD_TD PrevTD;
+ PEHCI_HCD_TD LinkTD;
+ ULONG TransferedLen = 0;
+ EHCI_TD_TOKEN Token;
+ ULONG DataToggle = 1;
+
+ DPRINT_EHCI("EHCI_ControlTransfer: EhciEndpoint - %p, EhciTransfer - %p\n",
+ EhciEndpoint,
+ EhciTransfer);
+
+ if (EhciEndpoint->RemainTDs < EHCI_MAX_CONTROL_TD_COUNT)
+ return MP_STATUS_FAILURE;
+
+ EhciExtension->PendingTransfers++;
+ EhciEndpoint->PendingTDs++;
+
+ EhciTransfer->TransferOnAsyncList = 1;
+
+ FirstTD = EHCI_AllocTd(EhciExtension, EhciEndpoint);
+
+ if (!FirstTD)
+ {
+ RegPacket.UsbPortBugCheck(EhciExtension);
+ return MP_STATUS_FAILURE;
+ }
+
+ EhciTransfer->PendingTDs++;
+
+ FirstTD->TdFlags |= EHCI_HCD_TD_FLAG_PROCESSED;
+ FirstTD->EhciTransfer = EhciTransfer;
+
+ FirstTD->HwTD.Buffer[0] = FirstTD->PhysicalAddress + FIELD_OFFSET(EHCI_HCD_TD, SetupPacket);
+ FirstTD->HwTD.Buffer[1] = 0;
+ FirstTD->HwTD.Buffer[2] = 0;
+ FirstTD->HwTD.Buffer[3] = 0;
+ FirstTD->HwTD.Buffer[4] = 0;
+
+ FirstTD->NextHcdTD = NULL;
+
+ FirstTD->HwTD.NextTD = TERMINATE_POINTER;
+ FirstTD->HwTD.AlternateNextTD = TERMINATE_POINTER;
+
+ FirstTD->HwTD.Token.AsULONG = 0;
+ FirstTD->HwTD.Token.ErrorCounter = 3;
+ FirstTD->HwTD.Token.PIDCode = EHCI_TD_TOKEN_PID_SETUP;
+ FirstTD->HwTD.Token.Status = (UCHAR)EHCI_TOKEN_STATUS_ACTIVE;
+ FirstTD->HwTD.Token.TransferBytes = sizeof(FirstTD->SetupPacket);
+
+ RtlCopyMemory(&FirstTD->SetupPacket,
+ &TransferParameters->SetupPacket,
+ sizeof(FirstTD->SetupPacket));
+
+ LastTD = EHCI_AllocTd(EhciExtension, EhciEndpoint);
+
+ if (!LastTD)
+ {
+ RegPacket.UsbPortBugCheck(EhciExtension);
+ return MP_STATUS_FAILURE;
+ }
+
+ EhciTransfer->PendingTDs++;
+
+ LastTD->TdFlags |= EHCI_HCD_TD_FLAG_PROCESSED;
+ LastTD->EhciTransfer = EhciTransfer;
+
+ LastTD->HwTD.Buffer[0] = 0;
+ LastTD->HwTD.Buffer[1] = 0;
+ LastTD->HwTD.Buffer[2] = 0;
+ LastTD->HwTD.Buffer[3] = 0;
+ LastTD->HwTD.Buffer[4] = 0;
+
+ LastTD->NextHcdTD = NULL;
+ LastTD->HwTD.NextTD = TERMINATE_POINTER;
+ LastTD->HwTD.AlternateNextTD = TERMINATE_POINTER;
+
+ LastTD->HwTD.Token.AsULONG = 0;
+ LastTD->HwTD.Token.ErrorCounter = 3;
+
+ FirstTD->AltNextHcdTD = LastTD;
+ FirstTD->HwTD.AlternateNextTD = LastTD->PhysicalAddress;
+
+ PrevTD = FirstTD;
+ LinkTD = FirstTD;
+
+ while (TransferedLen < TransferParameters->TransferBufferLength)
+ {
+ TD = EHCI_AllocTd(EhciExtension, EhciEndpoint);
+
+ if (!TD)
+ {
+ RegPacket.UsbPortBugCheck(EhciExtension);
+ return MP_STATUS_FAILURE;
+ }
+
+ LinkTD = TD;
+
+ EhciTransfer->PendingTDs++;
+
+ TD->TdFlags |= EHCI_HCD_TD_FLAG_PROCESSED;
+ TD->EhciTransfer = EhciTransfer;
+
+ TD->HwTD.Buffer[0] = 0;
+ TD->HwTD.Buffer[1] = 0;
+ TD->HwTD.Buffer[2] = 0;
+ TD->HwTD.Buffer[3] = 0;
+ TD->HwTD.Buffer[4] = 0;
+
+ TD->NextHcdTD = NULL;
+
+ TD->HwTD.NextTD = TERMINATE_POINTER;
+ TD->HwTD.AlternateNextTD = TERMINATE_POINTER;
+
+ TD->HwTD.Token.AsULONG = 0;
+ TD->HwTD.Token.ErrorCounter = 3;
+
+ PrevTD->NextHcdTD = TD;
+ PrevTD->HwTD.NextTD = TD->PhysicalAddress;
+
+ if (TransferParameters->TransferFlags & USBD_TRANSFER_DIRECTION_IN)
+ TD->HwTD.Token.PIDCode = EHCI_TD_TOKEN_PID_IN;
+ else
+ TD->HwTD.Token.PIDCode = EHCI_TD_TOKEN_PID_OUT;
+
+ TD->HwTD.Token.DataToggle = DataToggle;
+ TD->HwTD.Token.Status = (UCHAR)EHCI_TOKEN_STATUS_ACTIVE;
+
+ if (DataToggle)
+ TD->HwTD.Token.DataToggle = 1;
+ else
+ TD->HwTD.Token.DataToggle = 0;
+
+ TD->AltNextHcdTD = LastTD;
+ TD->HwTD.AlternateNextTD = LastTD->PhysicalAddress;
+
+ TransferedLen = EHCI_MapAsyncTransferToTd(EhciExtension,
+ EhciEndpoint->EndpointProperties.MaxPacketSize,
+ TransferedLen,
+ &DataToggle,
+ EhciTransfer,
+ TD,
+ SgList);
+
+ PrevTD = TD;
+ }
+
+ LinkTD->NextHcdTD = LastTD;
+ LinkTD->HwTD.NextTD = LastTD->PhysicalAddress;
+
+ LastTD->HwTD.Buffer[0] = 0;
+ LastTD->LengthThisTD = 0;
+
+ Token.AsULONG = 0;
+ Token.Status = (UCHAR)EHCI_TOKEN_STATUS_ACTIVE;
+ Token.InterruptOnComplete = 1;
+ Token.DataToggle = 1;
+
+ if (TransferParameters->TransferFlags & USBD_TRANSFER_DIRECTION_IN)
+ Token.PIDCode = EHCI_TD_TOKEN_PID_OUT;
+ else
+ Token.PIDCode = EHCI_TD_TOKEN_PID_IN;
+
+ LastTD->HwTD.Token = Token;
+
+ LastTD->NextHcdTD = EhciEndpoint->HcdTailP;
+ LastTD->HwTD.NextTD = EhciEndpoint->HcdTailP->PhysicalAddress;
+
+ EHCI_EnableAsyncList(EhciExtension);
+ EHCI_LinkTransferToQueue(EhciExtension, EhciEndpoint, FirstTD);
+
+ ASSERT(EhciEndpoint->HcdTailP->NextHcdTD == NULL);
+ ASSERT(EhciEndpoint->HcdTailP->AltNextHcdTD == NULL);
+
+ return MP_STATUS_SUCCESS;
+}
+
+MPSTATUS
+NTAPI
+EHCI_BulkTransfer(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_ENDPOINT EhciEndpoint,
+ IN PUSBPORT_TRANSFER_PARAMETERS TransferParameters,
+ IN PEHCI_TRANSFER EhciTransfer,
+ IN PUSBPORT_SCATTER_GATHER_LIST SgList)
+{
+ PEHCI_HCD_TD PrevTD;
+ PEHCI_HCD_TD FirstTD;
+ PEHCI_HCD_TD TD;
+ ULONG TransferedLen;
+
+ DPRINT_EHCI("EHCI_BulkTransfer: EhciEndpoint - %p, EhciTransfer - %p\n",
+ EhciEndpoint,
+ EhciTransfer);
+
+ if (((TransferParameters->TransferBufferLength /
+ ((EHCI_MAX_QTD_BUFFER_PAGES - 1) * PAGE_SIZE)) + 1) > EhciEndpoint->RemainTDs)
+ {
+ DPRINT1("EHCI_BulkTransfer: return MP_STATUS_FAILURE\n");
+ return MP_STATUS_FAILURE;
+ }
+
+ EhciExtension->PendingTransfers++;
+ EhciEndpoint->PendingTDs++;
+
+ EhciTransfer->TransferOnAsyncList = 1;
+
+ TransferedLen = 0;
+ PrevTD = NULL;
+
+ if (TransferParameters->TransferBufferLength)
+ {
+ while (TransferedLen < TransferParameters->TransferBufferLength)
+ {
+ TD = EHCI_AllocTd(EhciExtension, EhciEndpoint);
+
+ if (!TD)
+ {
+ RegPacket.UsbPortBugCheck(EhciExtension);
+ return MP_STATUS_FAILURE;
+ }
+
+ EhciTransfer->PendingTDs++;
+
+ TD->TdFlags |= EHCI_HCD_TD_FLAG_PROCESSED;
+ TD->EhciTransfer = EhciTransfer;
+
+ TD->HwTD.Buffer[0] = 0;
+ TD->HwTD.Buffer[1] = 0;
+ TD->HwTD.Buffer[2] = 0;
+ TD->HwTD.Buffer[3] = 0;
+ TD->HwTD.Buffer[4] = 0;
+
+ TD->NextHcdTD = NULL;
+ TD->HwTD.NextTD = TERMINATE_POINTER;
+ TD->HwTD.AlternateNextTD = TERMINATE_POINTER;
+
+ TD->HwTD.Token.AsULONG = 0;
+ TD->HwTD.Token.ErrorCounter = 3;
+
+ if (EhciTransfer->PendingTDs == 1)
+ {
+ FirstTD = TD;
+ }
+ else
+ {
+ PrevTD->HwTD.NextTD = TD->PhysicalAddress;
+ PrevTD->NextHcdTD = TD;
+ }
+
+ TD->HwTD.AlternateNextTD = EhciEndpoint->HcdTailP->PhysicalAddress;
+ TD->AltNextHcdTD = EhciEndpoint->HcdTailP;
+
+ TD->HwTD.Token.InterruptOnComplete = 1;
+
+ if (TransferParameters->TransferFlags & USBD_TRANSFER_DIRECTION_IN)
+ TD->HwTD.Token.PIDCode = EHCI_TD_TOKEN_PID_IN;
+ else
+ TD->HwTD.Token.PIDCode = EHCI_TD_TOKEN_PID_OUT;
+
+ TD->HwTD.Token.Status = (UCHAR)EHCI_TOKEN_STATUS_ACTIVE;
+ TD->HwTD.Token.DataToggle = 1;
+
+ TransferedLen = EHCI_MapAsyncTransferToTd(EhciExtension,
+ EhciEndpoint->EndpointProperties.MaxPacketSize,
+ TransferedLen,
+ 0,
+ EhciTransfer,
+ TD,
+ SgList);
+
+ PrevTD = TD;
+ }
+ }
+ else
+ {
+ TD = EHCI_AllocTd(EhciExtension, EhciEndpoint);
+
+ if (!TD)
+ {
+ RegPacket.UsbPortBugCheck(EhciExtension);
+ return MP_STATUS_FAILURE;
+ }
+
+ EhciTransfer->PendingTDs++;
+
+ TD->TdFlags |= EHCI_HCD_TD_FLAG_PROCESSED;
+ TD->EhciTransfer = EhciTransfer;
+
+ TD->HwTD.Buffer[0] = 0;
+ TD->HwTD.Buffer[1] = 0;
+ TD->HwTD.Buffer[2] = 0;
+ TD->HwTD.Buffer[3] = 0;
+ TD->HwTD.Buffer[4] = 0;
+
+ TD->HwTD.NextTD = TERMINATE_POINTER;
+ TD->HwTD.AlternateNextTD = TERMINATE_POINTER;
+
+ TD->HwTD.Token.AsULONG = 0;
+ TD->HwTD.Token.ErrorCounter = 3;
+
+ TD->NextHcdTD = NULL;
+
+ ASSERT(EhciTransfer->PendingTDs == 1);
+
+ FirstTD = TD;
+
+ TD->HwTD.AlternateNextTD = EhciEndpoint->HcdTailP->PhysicalAddress;
+ TD->AltNextHcdTD = EhciEndpoint->HcdTailP;
+
+ TD->HwTD.Token.InterruptOnComplete = 1;
+
+ if (TransferParameters->TransferFlags & USBD_TRANSFER_DIRECTION_IN)
+ TD->HwTD.Token.PIDCode = EHCI_TD_TOKEN_PID_IN;
+ else
+ TD->HwTD.Token.PIDCode = EHCI_TD_TOKEN_PID_OUT;
+
+ TD->HwTD.Buffer[0] = TD->PhysicalAddress;
+
+ TD->HwTD.Token.Status = (UCHAR)EHCI_TOKEN_STATUS_ACTIVE;
+ TD->HwTD.Token.DataToggle = 1;
+
+ TD->LengthThisTD = 0;
+ }
+
+ TD->HwTD.NextTD = EhciEndpoint->HcdTailP->PhysicalAddress;
+ TD->NextHcdTD = EhciEndpoint->HcdTailP;
+
+ EHCI_EnableAsyncList(EhciExtension);
+ EHCI_LinkTransferToQueue(EhciExtension, EhciEndpoint, FirstTD);
+
+ ASSERT(EhciEndpoint->HcdTailP->NextHcdTD == 0);
+ ASSERT(EhciEndpoint->HcdTailP->AltNextHcdTD == 0);
+
+ return MP_STATUS_SUCCESS;
+}
+
+MPSTATUS
+NTAPI
+EHCI_InterruptTransfer(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_ENDPOINT EhciEndpoint,
+ IN PUSBPORT_TRANSFER_PARAMETERS TransferParameters,
+ IN PEHCI_TRANSFER EhciTransfer,
+ IN PUSBPORT_SCATTER_GATHER_LIST SgList)
+{
+ PEHCI_HCD_TD TD;
+ PEHCI_HCD_TD FirstTD;
+ PEHCI_HCD_TD PrevTD = NULL;
+ ULONG TransferedLen = 0;
+
+ DPRINT_EHCI("EHCI_InterruptTransfer: EhciEndpoint - %p, EhciTransfer - %p\n",
+ EhciEndpoint,
+ EhciTransfer);
+
+ if (!EhciEndpoint->RemainTDs)
+ {
+ DPRINT1("EHCI_InterruptTransfer: EhciEndpoint - %p\n", EhciEndpoint);
+ DbgBreakPoint();
+ return MP_STATUS_FAILURE;
+ }
+
+ EhciEndpoint->PendingTDs++;
+
+ if (!TransferParameters->TransferBufferLength)
+ {
+ DPRINT1("EHCI_InterruptTransfer: EhciEndpoint - %p\n", EhciEndpoint);
+ DbgBreakPoint();
+ return MP_STATUS_FAILURE;
+ }
+
+ while (TransferedLen < TransferParameters->TransferBufferLength)
+ {
+ TD = EHCI_AllocTd(EhciExtension, EhciEndpoint);
+
+ if (!TD)
+ {
+ DPRINT1("EHCI_InterruptTransfer: EhciEndpoint - %p\n", EhciEndpoint);
+ RegPacket.UsbPortBugCheck(EhciExtension);
+ return MP_STATUS_FAILURE;
+ }
+
+ EhciTransfer->PendingTDs++;
+
+ TD->TdFlags |= EHCI_HCD_TD_FLAG_PROCESSED;
+ TD->EhciTransfer = EhciTransfer;
+
+ TD->HwTD.Buffer[0] = 0;
+ TD->HwTD.Buffer[1] = 0;
+ TD->HwTD.Buffer[2] = 0;
+ TD->HwTD.Buffer[3] = 0;
+ TD->HwTD.Buffer[4] = 0;
+
+ TD->HwTD.NextTD = TERMINATE_POINTER;
+ TD->HwTD.AlternateNextTD = TERMINATE_POINTER;
+
+ TD->HwTD.Token.AsULONG = 0;
+ TD->HwTD.Token.ErrorCounter = 3;
+
+ TD->NextHcdTD = NULL;
+
+ if (EhciTransfer->PendingTDs == 1)
+ {
+ FirstTD = TD;
+ }
+ else if (PrevTD)
+ {
+ PrevTD->HwTD.NextTD = TD->PhysicalAddress;
+ PrevTD->NextHcdTD = TD;
+ }
+
+ if (TransferParameters->TransferFlags & USBD_TRANSFER_DIRECTION_IN)
+ TD->HwTD.Token.PIDCode = EHCI_TD_TOKEN_PID_IN;
+ else
+ TD->HwTD.Token.PIDCode = EHCI_TD_TOKEN_PID_OUT;
+
+ TD->HwTD.Token.Status = (UCHAR)EHCI_TOKEN_STATUS_ACTIVE;
+ TD->HwTD.Token.DataToggle = 1;
+
+ TransferedLen = EHCI_MapAsyncTransferToTd(EhciExtension,
+ EhciEndpoint->EndpointProperties.TotalMaxPacketSize,
+ TransferedLen,
+ NULL,
+ EhciTransfer,
+ TD,
+ SgList);
+
+ PrevTD = TD;
+ }
+
+ TD->HwTD.Token.InterruptOnComplete = 1;
+
+ DPRINT_EHCI("EHCI_InterruptTransfer: PendingTDs - %x, TD->PhysicalAddress - %p, FirstTD - %p\n",
+ EhciTransfer->PendingTDs,
+ TD->PhysicalAddress,
+ FirstTD);
+
+ TD->HwTD.NextTD = EhciEndpoint->HcdTailP->PhysicalAddress;
+ TD->NextHcdTD = EhciEndpoint->HcdTailP;
+
+ EHCI_LinkTransferToQueue(EhciExtension, EhciEndpoint, FirstTD);
+
+ ASSERT(EhciEndpoint->HcdTailP->NextHcdTD == NULL);
+ ASSERT(EhciEndpoint->HcdTailP->AltNextHcdTD == NULL);
+
+ EHCI_EnablePeriodicList(EhciExtension);
+
+ return MP_STATUS_SUCCESS;
+}
+
+MPSTATUS
+NTAPI
+EHCI_SubmitTransfer(IN PVOID ehciExtension,
+ IN PVOID ehciEndpoint,
+ IN PUSBPORT_TRANSFER_PARAMETERS TransferParameters,
+ IN PVOID ehciTransfer,
+ IN PUSBPORT_SCATTER_GATHER_LIST SgList)
+{
+ PEHCI_EXTENSION EhciExtension = ehciExtension;
+ PEHCI_ENDPOINT EhciEndpoint = ehciEndpoint;
+ PEHCI_TRANSFER EhciTransfer = ehciTransfer;
+ MPSTATUS MPStatus;
+
+ DPRINT_EHCI("EHCI_SubmitTransfer: EhciEndpoint - %p, EhciTransfer - %p\n",
+ EhciEndpoint,
+ EhciTransfer);
+
+ RtlZeroMemory(EhciTransfer, sizeof(EHCI_TRANSFER));
+
+ EhciTransfer->TransferParameters = TransferParameters;
+ EhciTransfer->USBDStatus = USBD_STATUS_SUCCESS;
+ EhciTransfer->EhciEndpoint = EhciEndpoint;
+
+ switch (EhciEndpoint->EndpointProperties.TransferType)
+ {
+ case USBPORT_TRANSFER_TYPE_CONTROL:
+ MPStatus = EHCI_ControlTransfer(EhciExtension,
+ EhciEndpoint,
+ TransferParameters,
+ EhciTransfer,
+ SgList);
+ break;
+
+ case USBPORT_TRANSFER_TYPE_BULK:
+ MPStatus = EHCI_BulkTransfer(EhciExtension,
+ EhciEndpoint,
+ TransferParameters,
+ EhciTransfer,
+ SgList);
+ break;
+
+ case USBPORT_TRANSFER_TYPE_INTERRUPT:
+ MPStatus = EHCI_InterruptTransfer(EhciExtension,
+ EhciEndpoint,
+ TransferParameters,
+ EhciTransfer,
+ SgList);
+ break;
+
+ default:
+ DbgBreakPoint();
+ MPStatus = MP_STATUS_NOT_SUPPORTED;
+ break;
+ }
+
+ return MPStatus;
+}
+
+MPSTATUS
+NTAPI
+EHCI_SubmitIsoTransfer(IN PVOID ehciExtension,
+ IN PVOID ehciEndpoint,
+ IN PUSBPORT_TRANSFER_PARAMETERS TransferParameters,
+ IN PVOID ehciTransfer,
+ IN PVOID isoParameters)
+{
+ DPRINT1("EHCI_SubmitIsoTransfer: UNIMPLEMENTED. FIXME\n");
+ return MP_STATUS_SUCCESS;
+}
+
+VOID
+NTAPI
+EHCI_AbortIsoTransfer(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_ENDPOINT EhciEndpoint,
+ IN PEHCI_TRANSFER EhciTransfer)
+{
+ DPRINT1("EHCI_AbortIsoTransfer: UNIMPLEMENTED. FIXME\n");
+}
+
+VOID
+NTAPI
+EHCI_AbortAsyncTransfer(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_ENDPOINT EhciEndpoint,
+ IN PEHCI_TRANSFER EhciTransfer)
+{
+ PEHCI_HCD_QH QH;
+ PEHCI_HCD_TD TD;
+ ULONG TransferLength;
+ PEHCI_HCD_TD CurrentTD;
+ PEHCI_TRANSFER CurrentTransfer;
+ ULONG FirstTdPA;
+ PEHCI_HCD_TD LastTD;
+ PEHCI_HCD_TD PrevTD;
+ ULONG NextTD;
+
+ DPRINT("EHCI_AbortAsyncTransfer: EhciEndpoint - %p, EhciTransfer - %p\n",
+ EhciEndpoint,
+ EhciTransfer);
+
+ QH = EhciEndpoint->QH;
+ TD = EhciEndpoint->HcdHeadP;
+
+ ASSERT(EhciEndpoint->PendingTDs);
+ EhciEndpoint->PendingTDs--;
+
+ if (TD->EhciTransfer == EhciTransfer)
+ {
+ TransferLength = 0;
+
+ while (TD != EhciEndpoint->HcdTailP &&
+ TD->EhciTransfer == EhciTransfer)
+ {
+ TransferLength += TD->LengthThisTD - TD->HwTD.Token.TransferBytes;
+
+ TD->HwTD.NextTD = 0;
+ TD->HwTD.AlternateNextTD = 0;
+
+ TD->TdFlags = 0;
+ TD->EhciTransfer = NULL;
+
+ EhciEndpoint->RemainTDs++;
+
+ TD = TD->NextHcdTD;
+ }
+
+ if (TransferLength)
+ EhciTransfer->TransferLen += TransferLength;
+
+ QH->sqh.HwQH.CurrentTD = EhciEndpoint->DmaBufferPA;
+ QH->sqh.HwQH.NextTD = TD->PhysicalAddress;
+ QH->sqh.HwQH.AlternateNextTD = TD->HwTD.AlternateNextTD;
+
+ QH->sqh.HwQH.Token.TransferBytes = 0;
+ QH->sqh.HwQH.Token.Status = (UCHAR)~(EHCI_TOKEN_STATUS_ACTIVE |
+ EHCI_TOKEN_STATUS_HALTED);
+
+ EhciEndpoint->HcdHeadP = TD;
+ }
+ else
+ {
+ DPRINT("EHCI_AbortAsyncTransfer: TD->EhciTransfer - %p\n", TD->EhciTransfer);
+
+ CurrentTD = RegPacket.UsbPortGetMappedVirtualAddress(QH->sqh.HwQH.CurrentTD,
+ EhciExtension,
+ EhciEndpoint);
+
+ CurrentTransfer = CurrentTD->EhciTransfer;
+ TD = EhciEndpoint->HcdHeadP;
+
+ while (TD && TD->EhciTransfer != EhciTransfer)
+ {
+ PrevTD = TD;
+ TD = TD->NextHcdTD;
+ }
+
+ FirstTdPA = TD->PhysicalAddress;
+
+ while (TD && TD->EhciTransfer == EhciTransfer)
+ {
+ TD->HwTD.NextTD = 0;
+ TD->HwTD.AlternateNextTD = 0;
+
+ TD->TdFlags = 0;
+ TD->EhciTransfer = NULL;
+
+ EhciEndpoint->RemainTDs++;
+
+ TD = TD->NextHcdTD;
+ }
+
+ LastTD = TD;
+ NextTD = LastTD->PhysicalAddress + FIELD_OFFSET(EHCI_HCD_TD, HwTD.NextTD);
+
+ PrevTD->HwTD.NextTD = LastTD->PhysicalAddress;
+ PrevTD->HwTD.AlternateNextTD = LastTD->PhysicalAddress;
+
+ PrevTD->NextHcdTD = LastTD;
+ PrevTD->AltNextHcdTD = LastTD;
+
+ if (CurrentTransfer == EhciTransfer)
+ {
+ QH->sqh.HwQH.CurrentTD = EhciEndpoint->DmaBufferPA;
+
+ QH->sqh.HwQH.Token.Status = (UCHAR)~EHCI_TOKEN_STATUS_ACTIVE;
+ QH->sqh.HwQH.Token.TransferBytes = 0;
+
+ QH->sqh.HwQH.NextTD = NextTD;
+ QH->sqh.HwQH.AlternateNextTD = TERMINATE_POINTER;
+
+ return;
+ }
+
+ if (PrevTD->EhciTransfer == CurrentTransfer)
+ {
+ if (QH->sqh.HwQH.NextTD == FirstTdPA)
+ QH->sqh.HwQH.NextTD = NextTD;
+
+ if (QH->sqh.HwQH.AlternateNextTD == FirstTdPA)
+ QH->sqh.HwQH.AlternateNextTD = NextTD;
+
+ for (TD = EhciEndpoint->HcdHeadP;
+ TD;
+ TD = TD->NextHcdTD)
+ {
+ if (TD->EhciTransfer == CurrentTransfer)
+ {
+ TD->HwTD.AlternateNextTD = NextTD;
+ TD->AltNextHcdTD = LastTD;
+ }
+ }
+ }
+ }
+}
+
+VOID
+NTAPI
+EHCI_AbortTransfer(IN PVOID ehciExtension,
+ IN PVOID ehciEndpoint,
+ IN PVOID ehciTransfer,
+ IN PULONG CompletedLength)
+{
+ PEHCI_EXTENSION EhciExtension = ehciExtension;
+ PEHCI_ENDPOINT EhciEndpoint = ehciEndpoint;
+ PEHCI_TRANSFER EhciTransfer = ehciTransfer;
+ ULONG TransferType;
+
+ DPRINT("EHCI_AbortTransfer: EhciTransfer - %p, CompletedLength - %x\n",
+ EhciTransfer,
+ CompletedLength);
+
+ TransferType = EhciEndpoint->EndpointProperties.TransferType;
+
+ if (TransferType == USBPORT_TRANSFER_TYPE_ISOCHRONOUS)
+ EHCI_AbortIsoTransfer(EhciExtension, EhciEndpoint, EhciTransfer);
+ else
+ EHCI_AbortAsyncTransfer(EhciExtension, EhciEndpoint, EhciTransfer);
+}
+
+ULONG
+NTAPI
+EHCI_GetEndpointState(IN PVOID ehciExtension,
+ IN PVOID ehciEndpoint)
+{
+ DPRINT1("EHCI_GetEndpointState: UNIMPLEMENTED. FIXME\n");
+ return 0;
+}
+
+VOID
+NTAPI
+EHCI_RemoveQhFromPeriodicList(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_ENDPOINT EhciEndpoint)
+{
+ PEHCI_HCD_QH QH;
+ PEHCI_HCD_QH NextHead;
+ ULONG NextQhPA;
+ PEHCI_HCD_QH PrevHead;
+
+ QH = EhciEndpoint->QH;
+
+ if (!(QH->sqh.QhFlags & EHCI_QH_FLAG_IN_SCHEDULE))
+ return;
+
+ DPRINT("EHCI_RemoveQhFromPeriodicList: EhciEndpoint - %p, QH - %X, EhciEndpoint->StaticQH - %p\n",
+ EhciEndpoint,
+ QH,
+ EhciEndpoint->StaticQH);
+
+ NextHead = QH->sqh.NextHead;
+ PrevHead = QH->sqh.PrevHead;
+
+ PrevHead->sqh.NextHead = NextHead;
+
+ if (NextHead)
+ {
+ if (!(NextHead->sqh.QhFlags & EHCI_QH_FLAG_STATIC))
+ NextHead->sqh.PrevHead = PrevHead;
+
+ NextQhPA = NextHead->sqh.PhysicalAddress;
+ NextQhPA &= LINK_POINTER_MASK + TERMINATE_POINTER;
+ NextQhPA |= (EHCI_LINK_TYPE_QH << 1);
+
+ PrevHead->sqh.HwQH.HorizontalLink.AsULONG = NextQhPA;
+ }
+ else
+ {
+ PrevHead->sqh.HwQH.HorizontalLink.Terminate = 1;
+ }
+
+ QH->sqh.QhFlags &= ~EHCI_QH_FLAG_IN_SCHEDULE;
+
+ QH->sqh.NextHead = NULL;
+ QH->sqh.PrevHead = NULL;
+}
+
+VOID
+NTAPI
+EHCI_RemoveQhFromAsyncList(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_HCD_QH QH)
+{
+ PEHCI_HCD_QH NextHead;
+ ULONG NextHeadPA;
+ PEHCI_HCD_QH PrevHead;
+ PEHCI_STATIC_QH AsyncHead;
+ ULONG AsyncHeadPA;
+
+ DPRINT("EHCI_RemoveQhFromAsyncList: QH - %p\n", QH);
+
+ if (QH->sqh.QhFlags & EHCI_QH_FLAG_IN_SCHEDULE)
+ {
+ NextHead = QH->sqh.NextHead;
+ PrevHead = QH->sqh.PrevHead;
+
+ AsyncHead = EhciExtension->AsyncHead;
+
+ AsyncHeadPA = AsyncHead->PhysicalAddress;
+ AsyncHeadPA &= LINK_POINTER_MASK + TERMINATE_POINTER;
+ AsyncHeadPA |= (EHCI_LINK_TYPE_QH << 1);
+
+ NextHeadPA = NextHead->sqh.PhysicalAddress;
+ NextHeadPA &= LINK_POINTER_MASK + TERMINATE_POINTER;
+ NextHeadPA |= (EHCI_LINK_TYPE_QH << 1);
+
+ PrevHead->sqh.HwQH.HorizontalLink.AsULONG = NextHeadPA;
+
+ PrevHead->sqh.NextHead = NextHead;
+ NextHead->sqh.PrevHead = PrevHead;
+
+ EHCI_FlushAsyncCache(EhciExtension);
+
+ if (READ_REGISTER_ULONG(&EhciExtension->OperationalRegs->AsyncListBase) ==
+ QH->sqh.PhysicalAddress)
+ {
+ WRITE_REGISTER_ULONG(&EhciExtension->OperationalRegs->AsyncListBase,
+ AsyncHeadPA);
+ }
+
+ QH->sqh.QhFlags &= ~EHCI_QH_FLAG_IN_SCHEDULE;
+ }
+}
+
+VOID
+NTAPI
+EHCI_InsertQhInPeriodicList(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_ENDPOINT EhciEndpoint)
+{
+ PEHCI_STATIC_QH StaticQH;
+ PEHCI_HCD_QH QH;
+ ULONG QhPA;
+ PEHCI_HCD_QH NextHead;
+ PEHCI_HCD_QH PrevHead;
+
+ QH = EhciEndpoint->QH;
+ StaticQH = EhciEndpoint->StaticQH;
+
+ ASSERT((QH->sqh.QhFlags & EHCI_QH_FLAG_IN_SCHEDULE) == 0);
+ ASSERT(StaticQH->QhFlags & EHCI_QH_FLAG_STATIC);
+
+ NextHead = StaticQH->NextHead;
+
+ QH->sqh.Period = EhciEndpoint->EndpointProperties.Period;
+ QH->sqh.Ordinal = EhciEndpoint->EndpointProperties.Reserved6;
+
+ DPRINT("EHCI_InsertQhInPeriodicList: EhciEndpoint - %p, QH - %X, EhciEndpoint->StaticQH - %p\n",
+ EhciEndpoint,
+ QH,
+ EhciEndpoint->StaticQH);
+
+ PrevHead = (PEHCI_HCD_QH)StaticQH;
+
+ if ((StaticQH->QhFlags & EHCI_QH_FLAG_STATIC) &&
+ (!NextHead || (NextHead->sqh.QhFlags & EHCI_QH_FLAG_STATIC)))
+ {
+ DPRINT("EHCI_InsertQhInPeriodicList: StaticQH - %p, StaticQH->NextHead - %p\n",
+ StaticQH,
+ StaticQH->NextHead);
+ }
+ else
+ {
+ while (NextHead &&
+ !(NextHead->sqh.QhFlags & EHCI_QH_FLAG_STATIC) &&
+ QH->sqh.Ordinal > NextHead->sqh.Ordinal)
+ {
+ PrevHead = NextHead;
+ NextHead = NextHead->sqh.NextHead;
+ }
+ }
+
+ QH->sqh.NextHead = NextHead;
+ QH->sqh.PrevHead = PrevHead;
+
+ if (NextHead && !(NextHead->sqh.QhFlags & EHCI_QH_FLAG_STATIC))
+ NextHead->sqh.PrevHead = QH;
+
+ QH->sqh.QhFlags |= EHCI_QH_FLAG_IN_SCHEDULE;
+ QH->sqh.HwQH.HorizontalLink = PrevHead->sqh.HwQH.HorizontalLink;
+
+ PrevHead->sqh.NextHead = QH;
+
+ QhPA = QH->sqh.PhysicalAddress;
+ QhPA &= LINK_POINTER_MASK + TERMINATE_POINTER;
+ QhPA |= (EHCI_LINK_TYPE_QH << 1);
+
+ PrevHead->sqh.HwQH.HorizontalLink.AsULONG = QhPA;
+}
+
+VOID
+NTAPI
+EHCI_InsertQhInAsyncList(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_HCD_QH QH)
+{
+ PEHCI_STATIC_QH AsyncHead;
+ ULONG QhPA;
+ PEHCI_HCD_QH NextHead;
+
+ DPRINT("EHCI_InsertQhInAsyncList: QH - %p\n", QH);
+
+ ASSERT((QH->sqh.QhFlags & EHCI_QH_FLAG_IN_SCHEDULE) == 0);
+ ASSERT((QH->sqh.QhFlags & EHCI_QH_FLAG_NUKED) == 0);
+
+ AsyncHead = EhciExtension->AsyncHead;
+ NextHead = AsyncHead->NextHead;
+
+ QH->sqh.HwQH.HorizontalLink = AsyncHead->HwQH.HorizontalLink;
+ QH->sqh.QhFlags |= EHCI_QH_FLAG_IN_SCHEDULE;
+ QH->sqh.NextHead = NextHead;
+ QH->sqh.PrevHead = (PEHCI_HCD_QH)AsyncHead;
+
+ NextHead->sqh.PrevHead = QH;
+
+ QhPA = QH->sqh.PhysicalAddress;
+ QhPA &= LINK_POINTER_MASK + TERMINATE_POINTER;
+ QhPA |= (EHCI_LINK_TYPE_QH << 1);
+
+ AsyncHead->HwQH.HorizontalLink.AsULONG = QhPA;
+
+ AsyncHead->NextHead = QH;
+}
+
+VOID
+NTAPI
+EHCI_SetIsoEndpointState(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_ENDPOINT EhciEndpoint,
+ IN ULONG EndpointState)
+{
+ DPRINT1("EHCI_SetIsoEndpointState: UNIMPLEMENTED. FIXME\n");
+}
+
+VOID
+NTAPI
+EHCI_SetAsyncEndpointState(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_ENDPOINT EhciEndpoint,
+ IN ULONG EndpointState)
+{
+ PEHCI_HCD_QH QH;
+ ULONG TransferType;
+
+ DPRINT("EHCI_SetAsyncEndpointState: EhciEndpoint - %p, EndpointState - %x\n",
+ EhciEndpoint,
+ EndpointState);
+
+ QH = EhciEndpoint->QH;
+
+ TransferType = EhciEndpoint->EndpointProperties.TransferType;
+
+ switch (EndpointState)
+ {
+ case USBPORT_ENDPOINT_PAUSED:
+ if (TransferType == USBPORT_TRANSFER_TYPE_INTERRUPT)
+ EHCI_RemoveQhFromPeriodicList(EhciExtension, EhciEndpoint);
+ else
+ EHCI_RemoveQhFromAsyncList(EhciExtension, EhciEndpoint->QH);
+
+ break;
+
+ case USBPORT_ENDPOINT_ACTIVE:
+ if (TransferType == USBPORT_TRANSFER_TYPE_INTERRUPT)
+ EHCI_InsertQhInPeriodicList(EhciExtension, EhciEndpoint);
+ else
+ EHCI_InsertQhInAsyncList(EhciExtension, EhciEndpoint->QH);
+
+ break;
+
+ case USBPORT_ENDPOINT_REMOVE:
+ QH->sqh.QhFlags |= EHCI_QH_FLAG_CLOSED;
+
+ if (TransferType == USBPORT_TRANSFER_TYPE_INTERRUPT)
+ EHCI_RemoveQhFromPeriodicList(EhciExtension, EhciEndpoint);
+ else
+ EHCI_RemoveQhFromAsyncList(EhciExtension, EhciEndpoint->QH);
+
+ break;
+
+ default:
+ DbgBreakPoint();
+ break;
+ }
+
+ EhciEndpoint->EndpointState = EndpointState;
+}
+
+VOID
+NTAPI
+EHCI_SetEndpointState(IN PVOID ehciExtension,
+ IN PVOID ehciEndpoint,
+ IN ULONG EndpointState)
+{
+ PEHCI_ENDPOINT EhciEndpoint;
+ ULONG TransferType;
+
+ DPRINT("EHCI_SetEndpointState: ... \n");
+
+ EhciEndpoint = ehciEndpoint;
+ TransferType = EhciEndpoint->EndpointProperties.TransferType;
+
+ if (TransferType == USBPORT_TRANSFER_TYPE_CONTROL ||
+ TransferType == USBPORT_TRANSFER_TYPE_BULK ||
+ TransferType == USBPORT_TRANSFER_TYPE_INTERRUPT)
+ {
+ EHCI_SetAsyncEndpointState((PEHCI_EXTENSION)ehciExtension,
+ EhciEndpoint,
+ EndpointState);
+ }
+ else if (TransferType == USBPORT_TRANSFER_TYPE_ISOCHRONOUS)
+ {
+ EHCI_SetIsoEndpointState((PEHCI_EXTENSION)ehciExtension,
+ EhciEndpoint,
+ EndpointState);
+ }
+ else
+ {
+ RegPacket.UsbPortBugCheck(ehciExtension);
+ }
+}
+
+VOID
+NTAPI
+EHCI_InterruptNextSOF(IN PVOID ehciExtension)
+{
+ PEHCI_EXTENSION EhciExtension = ehciExtension;
+
+ DPRINT_EHCI("EHCI_InterruptNextSOF: ... \n");
+
+ RegPacket.UsbPortInvalidateController(EhciExtension,
+ USBPORT_INVALIDATE_CONTROLLER_SOFT_INTERRUPT);
+}
+
+USBD_STATUS
+NTAPI
+EHCI_GetErrorFromTD(IN PEHCI_HCD_TD TD)
+{
+ EHCI_TD_TOKEN Token;
+
+ DPRINT_EHCI("EHCI_GetErrorFromTD: ... \n");
+
+ ASSERT(TD->HwTD.Token.Status & EHCI_TOKEN_STATUS_HALTED);
+
+ Token = TD->HwTD.Token;
+
+ if (Token.Status & EHCI_TOKEN_STATUS_TRANSACTION_ERROR)
+ {
+ DPRINT("EHCI_GetErrorFromTD: TD - %p, TRANSACTION_ERROR\n", TD);
+ return USBD_STATUS_XACT_ERROR;
+ }
+
+ if (Token.Status & EHCI_TOKEN_STATUS_BABBLE_DETECTED)
+ {
+ DPRINT("EHCI_GetErrorFromTD: TD - %p, BABBLE_DETECTED\n", TD);
+ return USBD_STATUS_BABBLE_DETECTED;
+ }
+
+ if (Token.Status & EHCI_TOKEN_STATUS_DATA_BUFFER_ERROR)
+ {
+ DPRINT("EHCI_GetErrorFromTD: TD - %p, DATA_BUFFER_ERROR\n", TD);
+ return USBD_STATUS_DATA_BUFFER_ERROR;
+ }
+
+ if (Token.Status & EHCI_TOKEN_STATUS_MISSED_MICROFRAME)
+ {
+ DPRINT("EHCI_GetErrorFromTD: TD - %p, MISSED_MICROFRAME\n", TD);
+ return USBD_STATUS_XACT_ERROR;
+ }
+
+ DPRINT("EHCI_GetErrorFromTD: TD - %p, STALL_PID\n", TD);
+ return USBD_STATUS_STALL_PID;
+}
+
+VOID
+NTAPI
+EHCI_ProcessDoneAsyncTd(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_HCD_TD TD)
+{
+ PEHCI_TRANSFER EhciTransfer;
+ PUSBPORT_TRANSFER_PARAMETERS TransferParameters;
+ ULONG TransferType;
+ PEHCI_ENDPOINT EhciEndpoint;
+ ULONG LengthTransfered;
+ USBD_STATUS USBDStatus;
+ PEHCI_HW_REGISTERS OperationalRegs;
+ EHCI_USB_COMMAND Command;
+
+ DPRINT_EHCI("EHCI_ProcessDoneAsyncTd: TD - %p\n", TD);
+
+ EhciTransfer = TD->EhciTransfer;
+
+ TransferParameters = EhciTransfer->TransferParameters;
+ EhciTransfer->PendingTDs--;
+
+ EhciEndpoint = EhciTransfer->EhciEndpoint;
+
+ if (!(TD->TdFlags & EHCI_HCD_TD_FLAG_ACTIVE))
+ {
+
+ if (TD->HwTD.Token.Status & EHCI_TOKEN_STATUS_HALTED)
+ USBDStatus = EHCI_GetErrorFromTD(TD);
+ else
+ USBDStatus = USBD_STATUS_SUCCESS;
+
+ LengthTransfered = TD->LengthThisTD - TD->HwTD.Token.TransferBytes;
+
+ if (TD->HwTD.Token.PIDCode != EHCI_TD_TOKEN_PID_SETUP)
+ EhciTransfer->TransferLen += LengthTransfered;
+
+ if (USBDStatus != USBD_STATUS_SUCCESS)
+ EhciTransfer->USBDStatus = USBDStatus;
+ }
+
+ TD->HwTD.NextTD = 0;
+ TD->HwTD.AlternateNextTD = 0;
+
+ TD->TdFlags = 0;
+ TD->EhciTransfer = NULL;
+
+ EhciEndpoint->RemainTDs++;
+
+ if (EhciTransfer->PendingTDs == 0)
+ {
+ EhciEndpoint->PendingTDs--;
+
+ TransferType = EhciEndpoint->EndpointProperties.TransferType;
+
+ if (TransferType == USBPORT_TRANSFER_TYPE_CONTROL ||
+ TransferType == USBPORT_TRANSFER_TYPE_BULK)
+ {
+ EhciExtension->PendingTransfers--;
+
+ if (EhciExtension->PendingTransfers == 0)
+ {
+ OperationalRegs = EhciExtension->OperationalRegs;
+ Command.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcCommand.AsULONG);
+
+ if (!Command.InterruptAdvanceDoorbell &&
+ (EhciExtension->Flags & EHCI_FLAGS_IDLE_SUPPORT))
+ {
+ EHCI_DisableAsyncList(EhciExtension);
+ }
+ }
+ }
+
+ RegPacket.UsbPortCompleteTransfer(EhciExtension,
+ EhciEndpoint,
+ TransferParameters,
+ EhciTransfer->USBDStatus,
+ EhciTransfer->TransferLen);
+ }
+}
+
+VOID
+NTAPI
+EHCI_PollActiveAsyncEndpoint(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_ENDPOINT EhciEndpoint)
+{
+ PEHCI_HCD_QH QH;
+ PEHCI_HCD_TD TD;
+ PEHCI_HCD_TD CurrentTD;
+ ULONG CurrentTDPhys;
+ BOOLEAN IsScheduled;
+
+ DPRINT_EHCI("EHCI_PollActiveAsyncEndpoint: ... \n");
+
+ QH = EhciEndpoint->QH;
+
+ CurrentTDPhys = QH->sqh.HwQH.CurrentTD & LINK_POINTER_MASK;
+ ASSERT(CurrentTDPhys);
+
+ CurrentTD = RegPacket.UsbPortGetMappedVirtualAddress(CurrentTDPhys,
+ EhciExtension,
+ EhciEndpoint);
+
+ if (CurrentTD == EhciEndpoint->DmaBufferVA)
+ return;
+
+ IsScheduled = QH->sqh.QhFlags & EHCI_QH_FLAG_IN_SCHEDULE;
+
+ if (!EHCI_HardwarePresent(EhciExtension, 0))
+ IsScheduled = 0;
+
+ TD = EhciEndpoint->HcdHeadP;
+
+ if (TD == CurrentTD)
+ {
+ if (TD != EhciEndpoint->HcdTailP &&
+ !(TD->HwTD.Token.Status & EHCI_TOKEN_STATUS_ACTIVE))
+ {
+ if (TD->NextHcdTD && TD->HwTD.NextTD != TD->NextHcdTD->PhysicalAddress)
+ TD->HwTD.NextTD = TD->NextHcdTD->PhysicalAddress;
+
+ if (TD->AltNextHcdTD &&
+ TD->HwTD.AlternateNextTD != TD->AltNextHcdTD->PhysicalAddress)
+ {
+ TD->HwTD.AlternateNextTD = TD->AltNextHcdTD->PhysicalAddress;
+ }
+
+ if (QH->sqh.HwQH.CurrentTD == TD->PhysicalAddress &&
+ !(TD->HwTD.Token.Status & EHCI_TOKEN_STATUS_ACTIVE) &&
+ (QH->sqh.HwQH.NextTD != TD->HwTD.NextTD ||
+ QH->sqh.HwQH.AlternateNextTD != TD->HwTD.AlternateNextTD))
+ {
+ QH->sqh.HwQH.NextTD = TD->HwTD.NextTD;
+ QH->sqh.HwQH.AlternateNextTD = TD->HwTD.AlternateNextTD;
+ }
+
+ EHCI_InterruptNextSOF(EhciExtension);
+ }
+ }
+ else
+ {
+ while (TD != CurrentTD)
+ {
+ ASSERT((TD->TdFlags & EHCI_HCD_TD_FLAG_DUMMY) == 0);
+
+ TD->TdFlags |= EHCI_HCD_TD_FLAG_DONE;
+
+ if (TD->HwTD.Token.Status & EHCI_TOKEN_STATUS_ACTIVE)
+ TD->TdFlags |= EHCI_HCD_TD_FLAG_ACTIVE;
+
+ InsertTailList(&EhciEndpoint->ListTDs, &TD->DoneLink);
+ TD = TD->NextHcdTD;
+ }
+ }
+
+ if (CurrentTD->HwTD.Token.Status & EHCI_TOKEN_STATUS_ACTIVE)
+ {
+ ASSERT(TD != NULL);
+ EhciEndpoint->HcdHeadP = TD;
+ return;
+ }
+
+ if ((CurrentTD->NextHcdTD != EhciEndpoint->HcdTailP) &&
+ (CurrentTD->AltNextHcdTD != EhciEndpoint->HcdTailP ||
+ CurrentTD->HwTD.Token.TransferBytes == 0))
+ {
+ ASSERT(TD != NULL);
+ EhciEndpoint->HcdHeadP = TD;
+ return;
+ }
+
+ if (IsScheduled)
+ {
+ EHCI_LockQH(EhciExtension,
+ QH,
+ EhciEndpoint->EndpointProperties.TransferType);
+ }
+
+ QH->sqh.HwQH.CurrentTD = EhciEndpoint->DmaBufferPA;
+
+ CurrentTD->TdFlags |= EHCI_HCD_TD_FLAG_DONE;
+ InsertTailList(&EhciEndpoint->ListTDs, &CurrentTD->DoneLink);
+
+ if (CurrentTD->HwTD.Token.TransferBytes &&
+ CurrentTD->AltNextHcdTD == EhciEndpoint->HcdTailP)
+ {
+ TD = CurrentTD->NextHcdTD;
+
+ while (TD != EhciEndpoint->HcdTailP)
+ {
+ TD->TdFlags |= EHCI_HCD_TD_FLAG_ACTIVE;
+ InsertTailList(&EhciEndpoint->ListTDs, &TD->DoneLink);
+ TD = TD->NextHcdTD;
+ }
+ }
+
+ QH->sqh.HwQH.CurrentTD = EhciEndpoint->HcdTailP->PhysicalAddress;
+ QH->sqh.HwQH.NextTD = TERMINATE_POINTER;
+ QH->sqh.HwQH.AlternateNextTD = TERMINATE_POINTER;
+ QH->sqh.HwQH.Token.TransferBytes = 0;
+
+ EhciEndpoint->HcdHeadP = EhciEndpoint->HcdTailP;
+
+ if (IsScheduled)
+ EHCI_UnlockQH(EhciExtension, QH);
+}
+
+VOID
+NTAPI
+EHCI_PollHaltedAsyncEndpoint(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_ENDPOINT EhciEndpoint)
+{
+ PEHCI_HCD_QH QH;
+ PEHCI_HCD_TD CurrentTD;
+ ULONG CurrentTdPA;
+ PEHCI_HCD_TD TD;
+ PEHCI_TRANSFER Transfer;
+ BOOLEAN IsScheduled;
+
+ DPRINT("EHCI_PollHaltedAsyncEndpoint: EhciEndpoint - %p\n", EhciEndpoint);
+
+ QH = EhciEndpoint->QH;
+ EHCI_DumpHwQH(QH);
+
+ CurrentTdPA = QH->sqh.HwQH.CurrentTD & LINK_POINTER_MASK;
+ ASSERT(CurrentTdPA);
+
+ IsScheduled = QH->sqh.QhFlags & EHCI_QH_FLAG_IN_SCHEDULE;
+
+ if (!EHCI_HardwarePresent(EhciExtension, 0))
+ IsScheduled = 0;
+
+ CurrentTD = RegPacket.UsbPortGetMappedVirtualAddress(CurrentTdPA,
+ EhciExtension,
+ EhciEndpoint);
+
+ DPRINT("EHCI_PollHaltedAsyncEndpoint: CurrentTD - %p\n", CurrentTD);
+
+ if (CurrentTD == EhciEndpoint->DmaBufferVA)
+ return;
+
+ ASSERT(EhciEndpoint->HcdTailP != CurrentTD);
+
+ if (IsScheduled)
+ {
+ EHCI_LockQH(EhciExtension,
+ QH,
+ EhciEndpoint->EndpointProperties.TransferType);
+ }
+
+ TD = EhciEndpoint->HcdHeadP;
+
+ while (TD != CurrentTD)
+ {
+ DPRINT("EHCI_PollHaltedAsyncEndpoint: TD - %p\n", TD);
+
+ ASSERT((TD->TdFlags & EHCI_HCD_TD_FLAG_DUMMY) == 0);
+
+ if (TD->HwTD.Token.Status & EHCI_TOKEN_STATUS_ACTIVE)
+ TD->TdFlags |= EHCI_HCD_TD_FLAG_ACTIVE;
+
+ TD->TdFlags |= EHCI_HCD_TD_FLAG_DONE;
+
+ InsertTailList(&EhciEndpoint->ListTDs, &TD->DoneLink);
+
+ TD = TD->NextHcdTD;
+ }
+
+ TD = CurrentTD;
+
+ Transfer = CurrentTD->EhciTransfer;
+
+ do
+ {
+ DPRINT("EHCI_PollHaltedAsyncEndpoint: TD - %p\n", TD);
+
+ if (TD->HwTD.Token.Status & EHCI_TOKEN_STATUS_ACTIVE)
+ TD->TdFlags |= EHCI_HCD_TD_FLAG_ACTIVE;
+
+ TD->TdFlags |= EHCI_HCD_TD_FLAG_DONE;
+
+ InsertTailList(&EhciEndpoint->ListTDs, &TD->DoneLink);
+
+ TD = TD->NextHcdTD;
+ }
+ while (TD->EhciTransfer == Transfer);
+
+ EhciEndpoint->HcdHeadP = TD;
+
+ QH->sqh.HwQH.CurrentTD = EhciEndpoint->DmaBufferPA;
+ QH->sqh.HwQH.NextTD = TD->PhysicalAddress;
+ QH->sqh.HwQH.AlternateNextTD = TERMINATE_POINTER;
+ QH->sqh.HwQH.Token.TransferBytes = 0;
+
+ if (IsScheduled)
+ EHCI_UnlockQH(EhciExtension, QH);
+
+ if (EhciEndpoint->EndpointStatus & USBPORT_ENDPOINT_CONTROL)
+ {
+ EhciEndpoint->EndpointStatus &= ~USBPORT_ENDPOINT_HALT;
+ QH->sqh.HwQH.Token.ErrorCounter = 0;
+ QH->sqh.HwQH.Token.Status &= (UCHAR)~(EHCI_TOKEN_STATUS_ACTIVE |
+ EHCI_TOKEN_STATUS_HALTED);
+
+ }
+}
+
+VOID
+NTAPI
+EHCI_PollAsyncEndpoint(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_ENDPOINT EhciEndpoint)
+{
+ PEHCI_HCD_QH QH;
+ PLIST_ENTRY DoneList;
+ PEHCI_HCD_TD TD;
+
+ //DPRINT_EHCI("EHCI_PollAsyncEndpoint: EhciEndpoint - %p\n", EhciEndpoint);
+
+ if (!EhciEndpoint->PendingTDs)
+ return;
+
+ QH = EhciEndpoint->QH;
+
+ if (QH->sqh.QhFlags & EHCI_QH_FLAG_CLOSED)
+ return;
+
+ if (QH->sqh.HwQH.Token.Status & EHCI_TOKEN_STATUS_ACTIVE ||
+ !(QH->sqh.HwQH.Token.Status & EHCI_TOKEN_STATUS_HALTED))
+ {
+ EHCI_PollActiveAsyncEndpoint(EhciExtension, EhciEndpoint);
+ }
+ else
+ {
+ EhciEndpoint->EndpointStatus |= USBPORT_ENDPOINT_HALT;
+ EHCI_PollHaltedAsyncEndpoint(EhciExtension, EhciEndpoint);
+ }
+
+ DoneList = &EhciEndpoint->ListTDs;
+
+ while (!IsListEmpty(DoneList))
+ {
+ TD = CONTAINING_RECORD(DoneList->Flink,
+ EHCI_HCD_TD,
+ DoneLink);
+
+ RemoveHeadList(DoneList);
+
+ ASSERT((TD->TdFlags & (EHCI_HCD_TD_FLAG_PROCESSED |
+ EHCI_HCD_TD_FLAG_DONE)));
+
+ EHCI_ProcessDoneAsyncTd(EhciExtension, TD);
+ }
+}
+
+VOID
+NTAPI
+EHCI_PollIsoEndpoint(IN PEHCI_EXTENSION EhciExtension,
+ IN PEHCI_ENDPOINT EhciEndpoint)
+{
+ DPRINT1("EHCI_PollIsoEndpoint: UNIMPLEMENTED. FIXME\n");
+}
+
+VOID
+NTAPI
+EHCI_PollEndpoint(IN PVOID ehciExtension,
+ IN PVOID ehciEndpoint)
+{
+ PEHCI_EXTENSION EhciExtension = ehciExtension;
+ PEHCI_ENDPOINT EhciEndpoint = ehciEndpoint;
+ ULONG TransferType;
+
+ //DPRINT_EHCI("EHCI_PollEndpoint: EhciEndpoint - %p\n", EhciEndpoint);
+
+ TransferType = EhciEndpoint->EndpointProperties.TransferType;
+
+ if (TransferType == USBPORT_TRANSFER_TYPE_ISOCHRONOUS)
+ EHCI_PollIsoEndpoint(EhciExtension, EhciEndpoint);
+ else
+ EHCI_PollAsyncEndpoint(EhciExtension, EhciEndpoint);
+}
+
+VOID
+NTAPI
+EHCI_CheckController(IN PVOID ehciExtension)
+{
+ PEHCI_EXTENSION EhciExtension = ehciExtension;
+
+ //DPRINT_EHCI("EHCI_CheckController: ... \n");
+
+ if (EhciExtension->IsStarted)
+ EHCI_HardwarePresent(EhciExtension, TRUE);
+}
+
+ULONG
+NTAPI
+EHCI_Get32BitFrameNumber(IN PVOID ehciExtension)
+{
+ PEHCI_EXTENSION EhciExtension = ehciExtension;
+ ULONG FrameIdx;
+ ULONG FrameIndex;
+ ULONG FrameNumber;
+
+ //DPRINT_EHCI("EHCI_Get32BitFrameNumber: EhciExtension - %p\n", EhciExtension);
+
+ FrameIdx = EhciExtension->FrameIndex;
+ FrameIndex = READ_REGISTER_ULONG(&EhciExtension->OperationalRegs->FrameIndex);
+
+ FrameNumber = (USHORT)FrameIdx ^ ((FrameIndex / EHCI_MICROFRAMES) & EHCI_FRINDEX_FRAME_MASK);
+ FrameNumber &= EHCI_FRAME_LIST_MAX_ENTRIES;
+ FrameNumber += FrameIndex | ((FrameIndex / EHCI_MICROFRAMES) & EHCI_FRINDEX_INDEX_MASK);
+
+ return FrameNumber;
+}
+
+VOID
+NTAPI
+EHCI_EnableInterrupts(IN PVOID ehciExtension)
+{
+ PEHCI_EXTENSION EhciExtension = ehciExtension;
+
+ DPRINT("EHCI_EnableInterrupts: EhciExtension->InterruptMask - %x\n",
+ EhciExtension->InterruptMask.AsULONG);
+
+ WRITE_REGISTER_ULONG(&EhciExtension->OperationalRegs->HcInterruptEnable.AsULONG,
+ EhciExtension->InterruptMask.AsULONG);
+}
+
+VOID
+NTAPI
+EHCI_DisableInterrupts(IN PVOID ehciExtension)
+{
+ PEHCI_EXTENSION EhciExtension = ehciExtension;
+
+ DPRINT("EHCI_DisableInterrupts: ... \n");
+
+ WRITE_REGISTER_ULONG(&EhciExtension->OperationalRegs->HcInterruptEnable.AsULONG,
+ 0);
+}
+
+VOID
+NTAPI
+EHCI_PollController(IN PVOID ehciExtension)
+{
+ PEHCI_EXTENSION EhciExtension = ehciExtension;
+ PEHCI_HW_REGISTERS OperationalRegs;
+ ULONG Port;
+ EHCI_PORT_STATUS_CONTROL PortSC;
+
+ DPRINT_EHCI("EHCI_PollController: ... \n");
+
+ OperationalRegs = EhciExtension->OperationalRegs;
+
+ if (!(EhciExtension->Flags & EHCI_FLAGS_CONTROLLER_SUSPEND))
+ {
+ RegPacket.UsbPortInvalidateRootHub(EhciExtension);
+ return;
+ }
+
+ if (EhciExtension->NumberOfPorts)
+ {
+ for (Port = 0; Port < EhciExtension->NumberOfPorts; Port++)
+ {
+ PortSC.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->PortControl[Port].AsULONG);
+
+ if (PortSC.ConnectStatusChange)
+ RegPacket.UsbPortInvalidateRootHub(EhciExtension);
+ }
+ }
+}
+
+VOID
+NTAPI
+EHCI_SetEndpointDataToggle(IN PVOID ehciExtension,
+ IN PVOID ehciEndpoint,
+ IN ULONG DataToggle)
+{
+ PEHCI_ENDPOINT EhciEndpoint;
+ ULONG TransferType;
+
+ EhciEndpoint = ehciEndpoint;
+
+ DPRINT("EHCI_SetEndpointDataToggle: EhciEndpoint - %p, DataToggle - %x\n",
+ EhciEndpoint,
+ DataToggle);
+
+ TransferType = EhciEndpoint->EndpointProperties.TransferType;
+
+ if (TransferType == USBPORT_TRANSFER_TYPE_BULK ||
+ TransferType == USBPORT_TRANSFER_TYPE_INTERRUPT)
+ {
+ EhciEndpoint->QH->sqh.HwQH.Token.DataToggle = DataToggle;
+ }
+}
+
+ULONG
+NTAPI
+EHCI_GetEndpointStatus(IN PVOID ehciExtension,
+ IN PVOID ehciEndpoint)
+{
+ PEHCI_ENDPOINT EhciEndpoint;
+ ULONG TransferType;
+ ULONG EndpointStatus = USBPORT_ENDPOINT_RUN;
+
+ EhciEndpoint = ehciEndpoint;
+
+ DPRINT("EHCI_GetEndpointStatus: EhciEndpoint - %p\n", EhciEndpoint);
+
+ TransferType = EhciEndpoint->EndpointProperties.TransferType;
+
+ if (TransferType == USBPORT_TRANSFER_TYPE_ISOCHRONOUS)
+ return EndpointStatus;
+
+ if (EhciEndpoint->EndpointStatus & USBPORT_ENDPOINT_HALT)
+ EndpointStatus = USBPORT_ENDPOINT_HALT;
+
+ return EndpointStatus;
+}
+
+VOID
+NTAPI
+EHCI_SetEndpointStatus(IN PVOID ehciExtension,
+ IN PVOID ehciEndpoint,
+ IN ULONG EndpointStatus)
+{
+ PEHCI_ENDPOINT EhciEndpoint;
+ ULONG TransferType;
+ PEHCI_HCD_QH QH;
+
+ EhciEndpoint = ehciEndpoint;
+
+ DPRINT("EHCI_SetEndpointStatus: EhciEndpoint - %p, EndpointStatus - %x\n",
+ EhciEndpoint,
+ EndpointStatus);
+
+ TransferType = EhciEndpoint->EndpointProperties.TransferType;
+
+ if (TransferType != USBPORT_TRANSFER_TYPE_ISOCHRONOUS)
+ {
+
+ if (EndpointStatus == USBPORT_ENDPOINT_RUN)
+ {
+ EhciEndpoint->EndpointStatus &= ~USBPORT_ENDPOINT_HALT;
+
+ QH = EhciEndpoint->QH;
+ QH->sqh.HwQH.Token.Status &= (UCHAR)~EHCI_TOKEN_STATUS_HALTED;
+
+ return;
+ }
+
+ if (EndpointStatus == USBPORT_ENDPOINT_HALT)
+ DbgBreakPoint();
+ }
+}
+
+VOID
+NTAPI
+EHCI_ResetController(IN PVOID ehciExtension)
+{
+ DPRINT1("EHCI_ResetController: UNIMPLEMENTED. FIXME\n");
+}
+
+MPSTATUS
+NTAPI
+EHCI_StartSendOnePacket(IN PVOID ehciExtension,
+ IN PVOID PacketParameters,
+ IN PVOID Data,
+ IN PULONG pDataLength,
+ IN PVOID BufferVA,
+ IN PVOID BufferPA,
+ IN ULONG BufferLength,
+ IN USBD_STATUS * pUSBDStatus)
+{
+ DPRINT1("EHCI_StartSendOnePacket: UNIMPLEMENTED. FIXME\n");
+ return MP_STATUS_SUCCESS;
+}
+
+MPSTATUS
+NTAPI
+EHCI_EndSendOnePacket(IN PVOID ehciExtension,
+ IN PVOID PacketParameters,
+ IN PVOID Data,
+ IN PULONG pDataLength,
+ IN PVOID BufferVA,
+ IN PVOID BufferPA,
+ IN ULONG BufferLength,
+ IN USBD_STATUS * pUSBDStatus)
+{
+ DPRINT1("EHCI_EndSendOnePacket: UNIMPLEMENTED. FIXME\n");
+ return MP_STATUS_SUCCESS;
+}
+
+MPSTATUS
+NTAPI
+EHCI_PassThru(IN PVOID ehciExtension,
+ IN PVOID passThruParameters,
+ IN ULONG ParameterLength,
+ IN PVOID pParameters)
+{
+ DPRINT1("EHCI_PassThru: UNIMPLEMENTED. FIXME\n");
+ return MP_STATUS_SUCCESS;
+}
+
+VOID
+NTAPI
+EHCI_RebalanceEndpoint(IN PVOID ohciExtension,
+ IN PUSBPORT_ENDPOINT_PROPERTIES EndpointProperties,
+ IN PVOID ohciEndpoint)
+{
+ DPRINT1("EHCI_RebalanceEndpoint: UNIMPLEMENTED. FIXME\n");
+}
+
+VOID
+NTAPI
+EHCI_FlushInterrupts(IN PVOID ehciExtension)
+{
+ PEHCI_EXTENSION EhciExtension = ehciExtension;
+ PEHCI_HW_REGISTERS OperationalRegs;
+ EHCI_USB_STATUS Status;
+
+ DPRINT("EHCI_FlushInterrupts: ... \n");
+
+ OperationalRegs = EhciExtension->OperationalRegs;
+
+ Status.AsULONG = READ_REGISTER_ULONG(&OperationalRegs->HcStatus.AsULONG);
+ WRITE_REGISTER_ULONG(&OperationalRegs->HcStatus.AsULONG, Status.AsULONG);
+}
+
+VOID
+NTAPI
+EHCI_TakePortControl(IN PVOID ohciExtension)
+{
+ DPRINT1("EHCI_TakePortControl: UNIMPLEMENTED. FIXME\n");
+}
+
+VOID
+NTAPI
+EHCI_Unload(IN PDRIVER_OBJECT DriverObject)
+{
+#if DBG
+ DPRINT1("EHCI_Unload: Not supported\n");
+#endif
+ return;
+}
+
+NTSTATUS
+NTAPI
+DriverEntry(IN PDRIVER_OBJECT DriverObject,
+ IN PUNICODE_STRING RegistryPath)
+{
+ DPRINT("DriverEntry: DriverObject - %p, RegistryPath - %wZ\n",
+ DriverObject,
+ RegistryPath);
+
+ if (USBPORT_GetHciMn() != USBPORT_HCI_MN)
+ return STATUS_INSUFFICIENT_RESOURCES;
+
+ RtlZeroMemory(&RegPacket, sizeof(USBPORT_REGISTRATION_PACKET));
+
+ RegPacket.MiniPortVersion = USB_MINIPORT_VERSION_EHCI;
+
+ RegPacket.MiniPortFlags = USB_MINIPORT_FLAGS_INTERRUPT |
+ USB_MINIPORT_FLAGS_MEMORY_IO |
+ USB_MINIPORT_FLAGS_USB2 |
+ USB_MINIPORT_FLAGS_POLLING |
+ USB_MINIPORT_FLAGS_WAKE_SUPPORT;
+
+ RegPacket.MiniPortBusBandwidth = TOTAL_USB20_BUS_BANDWIDTH;
+
+ RegPacket.MiniPortExtensionSize = sizeof(EHCI_EXTENSION);
+ RegPacket.MiniPortEndpointSize = sizeof(EHCI_ENDPOINT);
+ RegPacket.MiniPortTransferSize = sizeof(EHCI_TRANSFER);
+ RegPacket.MiniPortResourcesSize = sizeof(EHCI_HC_RESOURCES);
+
+ RegPacket.OpenEndpoint = EHCI_OpenEndpoint;
+ RegPacket.ReopenEndpoint = EHCI_ReopenEndpoint;
+ RegPacket.QueryEndpointRequirements = EHCI_QueryEndpointRequirements;
+ RegPacket.CloseEndpoint = EHCI_CloseEndpoint;
+ RegPacket.StartController = EHCI_StartController;
+ RegPacket.StopController = EHCI_StopController;
+ RegPacket.SuspendController = EHCI_SuspendController;
+ RegPacket.ResumeController = EHCI_ResumeController;
+ RegPacket.InterruptService = EHCI_InterruptService;
+ RegPacket.InterruptDpc = EHCI_InterruptDpc;
+ RegPacket.SubmitTransfer = EHCI_SubmitTransfer;
+ RegPacket.SubmitIsoTransfer = EHCI_SubmitIsoTransfer;
+ RegPacket.AbortTransfer = EHCI_AbortTransfer;
+ RegPacket.GetEndpointState = EHCI_GetEndpointState;
+ RegPacket.SetEndpointState = EHCI_SetEndpointState;
+ RegPacket.PollEndpoint = EHCI_PollEndpoint;
+ RegPacket.CheckController = EHCI_CheckController;
+ RegPacket.Get32BitFrameNumber = EHCI_Get32BitFrameNumber;
+ RegPacket.InterruptNextSOF = EHCI_InterruptNextSOF;
+ RegPacket.EnableInterrupts = EHCI_EnableInterrupts;
+ RegPacket.DisableInterrupts = EHCI_DisableInterrupts;
+ RegPacket.PollController = EHCI_PollController;
+ RegPacket.SetEndpointDataToggle = EHCI_SetEndpointDataToggle;
+ RegPacket.GetEndpointStatus = EHCI_GetEndpointStatus;
+ RegPacket.SetEndpointStatus = EHCI_SetEndpointStatus;
+ RegPacket.RH_GetRootHubData = EHCI_RH_GetRootHubData;
+ RegPacket.RH_GetStatus = EHCI_RH_GetStatus;
+ RegPacket.RH_GetPortStatus = EHCI_RH_GetPortStatus;
+ RegPacket.RH_GetHubStatus = EHCI_RH_GetHubStatus;
+ RegPacket.RH_SetFeaturePortReset = EHCI_RH_SetFeaturePortReset;
+ RegPacket.RH_SetFeaturePortPower = EHCI_RH_SetFeaturePortPower;
+ RegPacket.RH_SetFeaturePortEnable = EHCI_RH_SetFeaturePortEnable;
+ RegPacket.RH_SetFeaturePortSuspend = EHCI_RH_SetFeaturePortSuspend;
+ RegPacket.RH_ClearFeaturePortEnable = EHCI_RH_ClearFeaturePortEnable;
+ RegPacket.RH_ClearFeaturePortPower = EHCI_RH_ClearFeaturePortPower;
+ RegPacket.RH_ClearFeaturePortSuspend = EHCI_RH_ClearFeaturePortSuspend;
+ RegPacket.RH_ClearFeaturePortEnableChange = EHCI_RH_ClearFeaturePortEnableChange;
+ RegPacket.RH_ClearFeaturePortConnectChange = EHCI_RH_ClearFeaturePortConnectChange;
+ RegPacket.RH_ClearFeaturePortResetChange = EHCI_RH_ClearFeaturePortResetChange;
+ RegPacket.RH_ClearFeaturePortSuspendChange = EHCI_RH_ClearFeaturePortSuspendChange;
+ RegPacket.RH_ClearFeaturePortOvercurrentChange = EHCI_RH_ClearFeaturePortOvercurrentChange;
+ RegPacket.RH_DisableIrq = EHCI_RH_DisableIrq;
+ RegPacket.RH_EnableIrq = EHCI_RH_EnableIrq;
+ RegPacket.StartSendOnePacket = EHCI_StartSendOnePacket;
+ RegPacket.EndSendOnePacket = EHCI_EndSendOnePacket;
+ RegPacket.PassThru = EHCI_PassThru;
+ RegPacket.RebalanceEndpoint = EHCI_RebalanceEndpoint;
+ RegPacket.FlushInterrupts = EHCI_FlushInterrupts;
+ RegPacket.RH_ChirpRootPort = EHCI_RH_ChirpRootPort;
+ RegPacket.TakePortControl = EHCI_TakePortControl;
+
+ DriverObject->DriverUnload = EHCI_Unload;
+
+ return USBPORT_RegisterUSBPortDriver(DriverObject,
+ USB20_MINIPORT_INTERFACE_VERSION,
+ &RegPacket);
+}