Upstream/CloverBootloader
1
0
Fork 0
mirror of https://github.com/CloverHackyColor/CloverBootloader.git synced 2024-11-14 10:05:43 +01:00
Code Issues Packages Projects Releases Wiki Activity
109d1f581c
CloverBootloader/Drivers/OhciDxe/Ohci.c
SergeySlice d7c710f9e3 fix some addresses issue, format text 
Signed-off-by: SergeySlice <sergey.slice@gmail.com>
2020-04-28 13:49:24 +03:00

2519 lines
85 KiB
C
Raw Blame History

/** @file
This file contains the implementation of Usb Hc Protocol.
Copyright(c) 2013 Intel Corporation. All rights reserved.
Redistribution and use in source and binary forms, with or without
modification, are permitted provided that the following conditions
are met:
* Redistributions of source code must retain the above copyright
notice, this list of conditions and the following disclaimer.
* Redistributions in binary form must reproduce the above copyright
notice, this list of conditions and the following disclaimer in
the documentation and/or other materials provided with the
distribution.
* Neither the name of Intel Corporation nor the names of its
contributors may be used to endorse or promote products derived
from this software without specific prior written permission.
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
"AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
(INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
**/
#include "Ohci.h"
/**
Provides software reset for the USB host controller.
@param This This EFI_USB_HC_PROTOCOL instance.
@param Attributes A bit mask of the reset operation to perform.
@retval EFI_SUCCESS The reset operation succeeded.
@retval EFI_INVALID_PARAMETER Attributes is not valid.
@retval EFI_UNSUPPOURTED The type of reset specified by Attributes is
not currently supported by the host controller.
@retval EFI_DEVICE_ERROR Host controller isn't halted to reset.
**/
EFI_STATUS
EFIAPI
OhciReset (
IN EFI_USB_HC_PROTOCOL *This,
IN UINT16 Attributes
)
{
EFI_STATUS Status;
USB_OHCI_HC_DEV *Ohc;
UINT8 Index;
UINT8 NumOfPorts;
UINT32 PowerOnGoodTime;
UINT32 Data32;
BOOLEAN Flag = FALSE;
if ((Attributes & ~(EFI_USB_HC_RESET_GLOBAL | EFI_USB_HC_RESET_HOST_CONTROLLER)) != 0) {
return EFI_INVALID_PARAMETER;
}
Status = EFI_SUCCESS;
Ohc = USB_OHCI_HC_DEV_FROM_THIS (This);
if ((Attributes & EFI_USB_HC_RESET_HOST_CONTROLLER) != 0) {
gBS->Stall (50 * 1000);
Status = OhciSetHcCommandStatus (Ohc, HC_RESET, HC_RESET);
if (EFI_ERROR(Status)) {
return EFI_DEVICE_ERROR;
}
gBS->Stall (50 * 1000);
//
// Wait for host controller reset.
//
PowerOnGoodTime = 50;
do {
gBS->Stall (1 * 1000);
Data32 = OhciGetOperationalReg (Ohc->PciIo, HC_COMMAND_STATUS );
if (EFI_ERROR(Status)) {
return EFI_DEVICE_ERROR;
}
if ((Data32 & HC_RESET) == 0) {
Flag = TRUE;
break;
}
}while(PowerOnGoodTime--);
if (!Flag){
return EFI_DEVICE_ERROR;
}
}
OhciFreeIntTransferMemory (Ohc);
Status = OhciInitializeInterruptList (Ohc);
OhciSetFrameInterval (Ohc, FRAME_INTERVAL, 0x2edf);
if ((Attributes & EFI_USB_HC_RESET_GLOBAL) != 0) {
Status = OhciSetHcControl (Ohc, HC_FUNCTIONAL_STATE, HC_STATE_RESET);
if (EFI_ERROR(Status)) {
return EFI_DEVICE_ERROR;
}
gBS->Stall (50 * 1000);
}
//
// Initialize host controller operational registers
//
OhciSetFrameInterval (Ohc, FS_LARGEST_DATA_PACKET, 0x2778);
OhciSetFrameInterval (Ohc, FRAME_INTERVAL, 0x2edf);
OhciSetPeriodicStart (Ohc, 0x2a2f);
OhciSetHcControl (Ohc, CONTROL_BULK_RATIO, 0x3);
OhciSetHcCommandStatus (Ohc, CONTROL_LIST_FILLED | BULK_LIST_FILLED, 0);
OhciSetRootHubDescriptor (Ohc, RH_PSWITCH_MODE, 0);
OhciSetRootHubDescriptor (Ohc, RH_NO_PSWITCH | RH_NOC_PROT, 1);
//OhciSetRootHubDescriptor (Hc, RH_PSWITCH_MODE | RH_NO_PSWITCH, 0);
//OhciSetRootHubDescriptor (Hc, RH_PSWITCH_MODE | RH_NOC_PROT, 1);
OhciSetRootHubDescriptor (Ohc, RH_DEV_REMOVABLE, 0);
OhciSetRootHubDescriptor (Ohc, RH_PORT_PWR_CTRL_MASK, 0xffff);
OhciSetRootHubStatus (Ohc, RH_LOCAL_PSTAT_CHANGE);
OhciSetRootHubPortStatus (Ohc, 0, RH_SET_PORT_POWER);
OhciGetRootHubNumOfPorts (This, &NumOfPorts);
for (Index = 0; Index < NumOfPorts; Index++) {
if (!EFI_ERROR(OhciSetRootHubPortFeature (This, Index, EfiUsbPortReset))) {
gBS->Stall (200 * 1000);
OhciClearRootHubPortFeature (This, Index, EfiUsbPortReset);
gBS->Stall (1000);
OhciSetRootHubPortFeature (This, Index, EfiUsbPortEnable);
gBS->Stall (1000);
}
}
OhciSetMemoryPointer (Ohc, HC_HCCA, Ohc->HccaMemoryBlock);
OhciSetMemoryPointer (Ohc, HC_CONTROL_HEAD, NULL);
OhciSetMemoryPointer (Ohc, HC_BULK_HEAD, NULL);
OhciSetHcControl (Ohc, PERIODIC_ENABLE | CONTROL_ENABLE | BULK_ENABLE, 1); /*ISOCHRONOUS_ENABLE*/
OhciSetHcControl (Ohc, HC_FUNCTIONAL_STATE, HC_STATE_OPERATIONAL);
gBS->Stall (50*1000);
//
// Wait till first SOF occurs, and then clear it
//
while (OhciGetHcInterruptStatus (Ohc, START_OF_FRAME) == 0);
OhciClearInterruptStatus (Ohc, START_OF_FRAME);
gBS->Stall (1000);
return Status;
}
/**
Retrieve the current state of the USB host controller.
@param This This EFI_USB_HC_PROTOCOL instance.
@param State Variable to return the current host controller
state.
@retval EFI_SUCCESS Host controller state was returned in State.
@retval EFI_INVALID_PARAMETER State is NULL.
@retval EFI_DEVICE_ERROR An error was encountered while attempting to
retrieve the host controller's current state.
**/
EFI_STATUS
EFIAPI
OhciGetState (
IN EFI_USB_HC_PROTOCOL *This,
OUT EFI_USB_HC_STATE *State
)
{
USB_OHCI_HC_DEV *Ohc;
UINT32 FuncState;
if (State == NULL) {
return EFI_INVALID_PARAMETER;
}
Ohc = USB_OHCI_HC_DEV_FROM_THIS (This);
FuncState = OhciGetHcControl (Ohc, HC_FUNCTIONAL_STATE);
switch (FuncState) {
case HC_STATE_RESET:
case HC_STATE_RESUME:
*State = EfiUsbHcStateHalt;
break;
case HC_STATE_OPERATIONAL:
*State = EfiUsbHcStateOperational;
break;
case HC_STATE_SUSPEND:
*State = EfiUsbHcStateSuspend;
break;
default:
ASSERT (FALSE);
}
return EFI_SUCCESS;
}
/**
Sets the USB host controller to a specific state.
@param This This EFI_USB_HC_PROTOCOL instance.
@param State The state of the host controller that will be set.
@retval EFI_SUCCESS The USB host controller was successfully placed
in the state specified by State.
@retval EFI_INVALID_PARAMETER State is invalid.
@retval EFI_DEVICE_ERROR Failed to set the state due to device error.
**/
EFI_STATUS
EFIAPI
OhciSetState(
IN EFI_USB_HC_PROTOCOL *This,
IN EFI_USB_HC_STATE State
)
{
EFI_STATUS Status;
USB_OHCI_HC_DEV *Ohc;
Ohc = USB_OHCI_HC_DEV_FROM_THIS(This);
switch (State) {
case EfiUsbHcStateHalt:
Status = OhciSetHcControl (Ohc, HC_FUNCTIONAL_STATE, HC_STATE_RESET);
break;
case EfiUsbHcStateOperational:
Status = OhciSetHcControl (Ohc, HC_FUNCTIONAL_STATE, HC_STATE_OPERATIONAL);
break;
case EfiUsbHcStateSuspend:
Status = OhciSetHcControl (Ohc, HC_FUNCTIONAL_STATE, HC_STATE_SUSPEND);
break;
default:
Status = EFI_INVALID_PARAMETER;
}
gBS->Stall (1000);
return Status;
}
/**
Submits control transfer to a target USB device.
@param This A pointer to the EFI_USB_HC_PROTOCOL instance.
@param DeviceAddress Represents the address of the target device on the USB,
which is assigned during USB enumeration.
@param IsSlowDevice Indicates whether the target device is slow device
or full-speed device.
@param MaxPaketLength Indicates the maximum packet size that the
default control transfer endpoint is capable of
sending or receiving.
@param Request A pointer to the USB device request that will be sent
to the USB device.
@param TransferDirection Specifies the data direction for the transfer.
There are three values available, DataIn, DataOut
and NoData.
@param Data A pointer to the buffer of data that will be transmitted
to USB device or received from USB device.
@param DataLength Indicates the size, in bytes, of the data buffer
specified by Data.
@param TimeOut Indicates the maximum time, in microseconds,
which the transfer is allowed to complete.
@param TransferResult A pointer to the detailed result information generated
by this control transfer.
@retval EFI_SUCCESS The control transfer was completed successfully.
@retval EFI_OUT_OF_RESOURCES The control transfer could not be completed due to a lack of resources.
@retval EFI_INVALID_PARAMETER Some parameters are invalid.
@retval EFI_TIMEOUT The control transfer failed due to timeout.
@retval EFI_DEVICE_ERROR The control transfer failed due to host controller or device error.
Caller should check TranferResult for detailed error information.
--*/
EFI_STATUS
EFIAPI
OhciControlTransfer (
IN EFI_USB_HC_PROTOCOL *This,
IN UINT8 DeviceAddress,
IN BOOLEAN IsSlowDevice,
IN UINT8 MaxPacketLength,
IN EFI_USB_DEVICE_REQUEST *Request,
IN EFI_USB_DATA_DIRECTION TransferDirection,
IN OUT VOID *Data OPTIONAL,
IN OUT UINTN *DataLength OPTIONAL,
IN UINTN TimeOut,
OUT UINT32 *TransferResult
)
{
USB_OHCI_HC_DEV *Ohc;
ED_DESCRIPTOR *HeadEd;
ED_DESCRIPTOR *Ed;
TD_DESCRIPTOR *HeadTd;
TD_DESCRIPTOR *SetupTd;
TD_DESCRIPTOR *DataTd;
TD_DESCRIPTOR *StatusTd;
TD_DESCRIPTOR *EmptyTd;
EFI_STATUS Status;
UINT32 DataPidDir;
UINT32 StatusPidDir;
UINTN TimeCount;
OHCI_ED_RESULT EdResult;
EFI_PCI_IO_PROTOCOL_OPERATION MapOp;
UINTN ActualSendLength;
UINTN LeftLength;
UINT8 DataToggle;
VOID *ReqMapping = NULL;
UINTN ReqMapLength = 0;
EFI_PHYSICAL_ADDRESS ReqMapPhyAddr = 0;
VOID *DataMapping = NULL;
UINTN DataMapLength = 0;
EFI_PHYSICAL_ADDRESS DataMapPhyAddr = 0;
HeadTd = NULL;
DataTd = NULL;
if ((TransferDirection != EfiUsbDataOut && TransferDirection != EfiUsbDataIn &&
TransferDirection != EfiUsbNoData) ||
Request == NULL || DataLength == NULL || TransferResult == NULL ||
(TransferDirection == EfiUsbNoData && (*DataLength != 0 || Data != NULL)) ||
(TransferDirection != EfiUsbNoData && (*DataLength == 0 || Data == NULL)) ||
(IsSlowDevice && MaxPacketLength != 8) ||
(MaxPacketLength != 8 && MaxPacketLength != 16 &&
MaxPacketLength != 32 && MaxPacketLength != 64)) {
return EFI_INVALID_PARAMETER;
}
if (*DataLength > MAX_BYTES_PER_TD) {
DEBUG ((EFI_D_ERROR, "OhciControlTransfer: Request data size is too large\r\n"));
return EFI_INVALID_PARAMETER;
}
Ohc = USB_OHCI_HC_DEV_FROM_THIS(This);
if (TransferDirection == EfiUsbDataIn) {
DataPidDir = TD_IN_PID;
StatusPidDir = TD_OUT_PID;
} else {
DataPidDir = TD_OUT_PID;
StatusPidDir = TD_IN_PID;
}
Status = OhciSetHcControl (Ohc, CONTROL_ENABLE, 0);
if (EFI_ERROR(Status)) {
DEBUG ((EFI_D_INFO, "OhciControlTransfer: fail to disable CONTROL_ENABLE\r\n"));
*TransferResult = EFI_USB_ERR_SYSTEM;
return EFI_DEVICE_ERROR;
}
Status = OhciSetHcCommandStatus (Ohc, CONTROL_LIST_FILLED, 0);
if (EFI_ERROR(Status)) {
DEBUG ((EFI_D_INFO, "OhciControlTransfer: fail to disable CONTROL_LIST_FILLED\r\n"));
*TransferResult = EFI_USB_ERR_SYSTEM;
return EFI_DEVICE_ERROR;
}
gBS->Stall(20 * 1000);
OhciSetMemoryPointer (Ohc, HC_CONTROL_HEAD, NULL);
Ed = OhciCreateED (Ohc);
if (Ed == NULL) {
Status = EFI_OUT_OF_RESOURCES;
DEBUG ((EFI_D_INFO, "OhciControlTransfer: Fail to allocate ED buffer\r\n"));
goto CTRL_EXIT;
}
OhciSetEDField (Ed, ED_SKIP, 1);
OhciSetEDField (Ed, ED_FUNC_ADD, DeviceAddress);
OhciSetEDField (Ed, ED_ENDPT_NUM, 0);
OhciSetEDField (Ed, ED_DIR, ED_FROM_TD_DIR);
OhciSetEDField (Ed, ED_SPEED, IsSlowDevice);
OhciSetEDField (Ed, ED_FORMAT | ED_HALTED | ED_DTTOGGLE, 0);
OhciSetEDField (Ed, ED_MAX_PACKET, MaxPacketLength);
OhciSetEDField (Ed, ED_PDATA, 0);
OhciSetEDField (Ed, ED_ZERO, 0);
OhciSetEDField (Ed, ED_TDHEAD_PTR, 0);
OhciSetEDField (Ed, ED_TDTAIL_PTR, 0);
OhciSetEDField (Ed, ED_NEXT_EDPTR, 0);
HeadEd = OhciAttachEDToList (Ohc, CONTROL_LIST, Ed, NULL);
//
// Setup Stage
//
if(Request != NULL) {
ReqMapLength = sizeof(EFI_USB_DEVICE_REQUEST);
MapOp = EfiPciIoOperationBusMasterRead;
Status = Ohc->PciIo->Map (Ohc->PciIo, MapOp, (UINT8 *)Request, &ReqMapLength, &ReqMapPhyAddr, &ReqMapping);
if (EFI_ERROR(Status)) {
DEBUG ((EFI_D_INFO, "OhciControlTransfer: Fail to Map Request Buffer\r\n"));
goto FREE_ED_BUFF;
}
}
SetupTd = OhciCreateTD (Ohc);
if (SetupTd == NULL) {
Status = EFI_OUT_OF_RESOURCES;
DEBUG ((EFI_D_INFO, "OhciControlTransfer: Fail to allocate Setup TD buffer\r\n"));
goto UNMAP_SETUP_BUFF;
}
HeadTd = SetupTd;
OhciSetTDField (SetupTd, TD_PDATA, 0);
OhciSetTDField (SetupTd, TD_BUFFER_ROUND, 1);
OhciSetTDField (SetupTd, TD_DIR_PID, TD_SETUP_PID);
OhciSetTDField (SetupTd, TD_DELAY_INT, TD_NO_DELAY);
OhciSetTDField (SetupTd, TD_DT_TOGGLE, 2);
OhciSetTDField (SetupTd, TD_ERROR_CNT, 0);
OhciSetTDField (SetupTd, TD_COND_CODE, TD_TOBE_PROCESSED);
OhciSetTDField (SetupTd, TD_CURR_BUFFER_PTR, (UINT32)ReqMapPhyAddr);
OhciSetTDField (SetupTd, TD_NEXT_PTR, 0);
OhciSetTDField (SetupTd, TD_BUFFER_END_PTR, (UINT32)(ReqMapPhyAddr + sizeof (EFI_USB_DEVICE_REQUEST) - 1));
SetupTd->ActualSendLength = sizeof (EFI_USB_DEVICE_REQUEST);
SetupTd->DataBuffer = (UINT32)(UINTN)ReqMapPhyAddr;
SetupTd->NextTDPointer = 0;
if (TransferDirection == EfiUsbDataIn) {
MapOp = EfiPciIoOperationBusMasterWrite;
} else {
MapOp = EfiPciIoOperationBusMasterRead;
}
DataMapLength = *DataLength;
if ((Data != NULL) && (DataMapLength != 0)) {
Status = Ohc->PciIo->Map (Ohc->PciIo, MapOp, Data, &DataMapLength, &DataMapPhyAddr, &DataMapping);
if (EFI_ERROR(Status)) {
DEBUG ((EFI_D_INFO, "OhciControlTransfer: Fail To Map Data Buffer\r\n"));
goto FREE_TD_BUFF;
}
}
//
//Data Stage
//
LeftLength = DataMapLength;
ActualSendLength = DataMapLength;
DataToggle = 1;
while (LeftLength > 0) {
ActualSendLength = LeftLength;
if (LeftLength > MaxPacketLength) {
ActualSendLength = MaxPacketLength;
}
DataTd = OhciCreateTD (Ohc);
if (DataTd == NULL) {
DEBUG ((EFI_D_INFO, "OhciControlTransfer: Fail to allocate buffer for Data Stage TD\r\n"));
Status = EFI_OUT_OF_RESOURCES;
goto UNMAP_DATA_BUFF;
}
OhciSetTDField (DataTd, TD_PDATA, 0);
OhciSetTDField (DataTd, TD_BUFFER_ROUND, 1);
OhciSetTDField (DataTd, TD_DIR_PID, DataPidDir);
OhciSetTDField (DataTd, TD_DELAY_INT, TD_NO_DELAY);
OhciSetTDField (DataTd, TD_DT_TOGGLE, DataToggle);
OhciSetTDField (DataTd, TD_ERROR_CNT, 0);
OhciSetTDField (DataTd, TD_COND_CODE, TD_TOBE_PROCESSED);
OhciSetTDField (DataTd, TD_CURR_BUFFER_PTR, (UINT32) DataMapPhyAddr);
OhciSetTDField (DataTd, TD_BUFFER_END_PTR, (UINT32)(DataMapPhyAddr + ActualSendLength - 1));
OhciSetTDField (DataTd, TD_NEXT_PTR, 0);
DataTd->ActualSendLength = (UINT32)ActualSendLength;
DataTd->DataBuffer = (UINT32)(UINTN)DataMapPhyAddr;
DataTd->NextTDPointer = 0;
OhciLinkTD (HeadTd, DataTd);
DataToggle ^= 1;
DataMapPhyAddr += ActualSendLength;
LeftLength -= ActualSendLength;
}
//
// Status Stage
//
StatusTd = OhciCreateTD (Ohc);
if (StatusTd == NULL) {
DEBUG ((EFI_D_INFO, "OhciControlTransfer: Fail to allocate buffer for Status Stage TD\r\n"));
Status = EFI_OUT_OF_RESOURCES;
goto UNMAP_DATA_BUFF;
}
OhciSetTDField (StatusTd, TD_PDATA, 0);
OhciSetTDField (StatusTd, TD_BUFFER_ROUND, 1);
OhciSetTDField (StatusTd, TD_DIR_PID, StatusPidDir);
OhciSetTDField (StatusTd, TD_DELAY_INT, 7);
OhciSetTDField (StatusTd, TD_DT_TOGGLE, 3);
OhciSetTDField (StatusTd, TD_ERROR_CNT, 0);
OhciSetTDField (StatusTd, TD_COND_CODE, TD_TOBE_PROCESSED);
OhciSetTDField (StatusTd, TD_CURR_BUFFER_PTR, 0);
OhciSetTDField (StatusTd, TD_NEXT_PTR, 0);
OhciSetTDField (StatusTd, TD_BUFFER_END_PTR, 0);
StatusTd->ActualSendLength = 0;
StatusTd->DataBuffer = 0;
StatusTd->NextTDPointer = 0;
OhciLinkTD (HeadTd, StatusTd);
//
// Empty Stage
//
EmptyTd = OhciCreateTD (Ohc);
if (EmptyTd == NULL) {
Status = EFI_OUT_OF_RESOURCES;
goto UNMAP_DATA_BUFF;
}
OhciSetTDField (EmptyTd, TD_PDATA, 0);
OhciSetTDField (EmptyTd, TD_BUFFER_ROUND, 0);
OhciSetTDField (EmptyTd, TD_DIR_PID, 0);
OhciSetTDField (EmptyTd, TD_DELAY_INT, 0);
//OhciSetTDField (EmptyTd, TD_DT_TOGGLE, CurrentToggle);
EmptyTd->Word0.DataToggle = 0;
OhciSetTDField (EmptyTd, TD_ERROR_CNT, 0);
OhciSetTDField (EmptyTd, TD_COND_CODE, 0);
OhciSetTDField (EmptyTd, TD_CURR_BUFFER_PTR, 0);
OhciSetTDField (EmptyTd, TD_BUFFER_END_PTR, 0);
OhciSetTDField (EmptyTd, TD_NEXT_PTR, 0);
EmptyTd->ActualSendLength = 0;
EmptyTd->DataBuffer = 0;
EmptyTd->NextTDPointer = 0;
OhciLinkTD (HeadTd, EmptyTd);
Ed->TdTailPointer = (UINT32)(UINTN)EmptyTd;
OhciAttachTDListToED (Ed, HeadTd);
//
// For debugging, dump ED & TD buffer befor transferring
//
//
//OhciDumpEdTdInfo (Ohc, Ed, HeadTd, TRUE);
//
OhciSetEDField (Ed, ED_SKIP, 0);
Status = OhciSetHcControl (Ohc, CONTROL_ENABLE, 1);
if (EFI_ERROR(Status)) {
DEBUG ((EFI_D_INFO, "OhciControlTransfer: fail to enable CONTROL_ENABLE\r\n"));
*TransferResult = EFI_USB_ERR_SYSTEM;
Status = EFI_DEVICE_ERROR;
goto UNMAP_DATA_BUFF;
}
Status = OhciSetHcCommandStatus (Ohc, CONTROL_LIST_FILLED, 1);
if (EFI_ERROR(Status)) {
DEBUG ((EFI_D_INFO, "OhciControlTransfer: fail to enable CONTROL_LIST_FILLED\r\n"));
*TransferResult = EFI_USB_ERR_SYSTEM;
Status = EFI_DEVICE_ERROR;
goto UNMAP_DATA_BUFF;
}
gBS->Stall(20 * 1000);
TimeCount = 0;
Status = CheckIfDone (Ohc, CONTROL_LIST, Ed, HeadTd, &EdResult);
while (Status == EFI_NOT_READY && TimeCount <= TimeOut) {
gBS->Stall (1000);
TimeCount++;
Status = CheckIfDone (Ohc, CONTROL_LIST, Ed, HeadTd, &EdResult);
}
//
// For debugging, dump ED & TD buffer after transferring
//
//OhciDumpEdTdInfo (Ohc, Ed, HeadTd, FALSE);
//
*TransferResult = ConvertErrorCode (EdResult.ErrorCode);
if (EdResult.ErrorCode != TD_NO_ERROR) {
if (EdResult.ErrorCode == TD_TOBE_PROCESSED) {
DEBUG ((EFI_D_INFO, "Control pipe timeout, > %d mS\r\n", TimeOut));
} else {
DEBUG ((EFI_D_INFO, "Control pipe broken\r\n"));
}
*DataLength = 0;
} else {
DEBUG ((EFI_D_INFO, "Control transfer successed\r\n"));
}
UNMAP_DATA_BUFF:
OhciSetEDField (Ed, ED_SKIP, 1);
if (HeadEd == Ed) {
OhciSetMemoryPointer (Ohc, HC_CONTROL_HEAD, NULL);
} else {
HeadEd->NextED = Ed->NextED;
}
if(DataMapping != NULL) {
Ohc->PciIo->Unmap(Ohc->PciIo, DataMapping);
}
FREE_TD_BUFF:
while (HeadTd) {
DataTd = HeadTd;
HeadTd = (TD_DESCRIPTOR *)(UINTN)(HeadTd->NextTDPointer);
UsbHcFreeMem(Ohc->MemPool, DataTd, sizeof(TD_DESCRIPTOR));
}
UNMAP_SETUP_BUFF:
if(ReqMapping != NULL) {
Ohc->PciIo->Unmap(Ohc->PciIo, ReqMapping);
}
FREE_ED_BUFF:
UsbHcFreeMem(Ohc->MemPool, Ed, sizeof(ED_DESCRIPTOR));
CTRL_EXIT:
return Status;
}
/**
Submits bulk transfer to a bulk endpoint of a USB device.
@param This A pointer to the EFI_USB_HC_PROTOCOL instance.
@param DeviceAddress Represents the address of the target device on the USB,
which is assigned during USB enumeration.
@param EndPointAddress The combination of an endpoint number and an
endpoint direction of the target USB device.
Each endpoint address supports data transfer in
one direction except the control endpoint
(whose default endpoint address is 0).
It is the caller's responsibility to make sure that
the EndPointAddress represents a bulk endpoint.
@param MaximumPacketLength Indicates the maximum packet size the target endpoint
is capable of sending or receiving.
@param Data A pointer to the buffer of data that will be transmitted
to USB device or received from USB device.
@param DataLength When input, indicates the size, in bytes, of the data buffer
specified by Data. When output, indicates the actually
transferred data size.
@param DataToggle A pointer to the data toggle value. On input, it indicates
the initial data toggle value the bulk transfer should adopt;
on output, it is updated to indicate the data toggle value
of the subsequent bulk transfer.
@param TimeOut Indicates the maximum time, in microseconds, which the
transfer is allowed to complete.
TransferResult A pointer to the detailed result information of the
bulk transfer.
@retval EFI_SUCCESS The bulk transfer was completed successfully.
@retval EFI_OUT_OF_RESOURCES The bulk transfer could not be submitted due to lack of resource.
@retval EFI_INVALID_PARAMETER Some parameters are invalid.
@retval EFI_TIMEOUT The bulk transfer failed due to timeout.
@retval EFI_DEVICE_ERROR The bulk transfer failed due to host controller or device error.
Caller should check TranferResult for detailed error information.
**/
EFI_STATUS
EFIAPI
OhciBulkTransfer(
IN EFI_USB_HC_PROTOCOL *This,
IN UINT8 DeviceAddress,
IN UINT8 EndPointAddress,
IN UINT8 MaxPacketLength,
IN OUT VOID *Data,
IN OUT UINTN *DataLength,
IN OUT UINT8 *DataToggle,
IN UINTN TimeOut,
OUT UINT32 *TransferResult
)
{
USB_OHCI_HC_DEV *Ohc;
ED_DESCRIPTOR *HeadEd;
ED_DESCRIPTOR *Ed;
UINT8 EdDir;
UINT32 DataPidDir;
TD_DESCRIPTOR *HeadTd;
TD_DESCRIPTOR *DataTd;
TD_DESCRIPTOR *EmptyTd;
EFI_STATUS Status;
EFI_USB_DATA_DIRECTION TransferDirection;
UINT8 EndPointNum;
UINTN TimeCount;
OHCI_ED_RESULT EdResult;
EFI_PCI_IO_PROTOCOL_OPERATION MapOp;
VOID *Mapping;
UINTN MapLength;
EFI_PHYSICAL_ADDRESS MapPyhAddr;
UINTN LeftLength;
UINTN ActualSendLength;
BOOLEAN FirstTD;
Mapping = NULL;
MapLength = 0;
MapPyhAddr = 0;
LeftLength = 0;
Status = EFI_SUCCESS;
if (Data == NULL || DataLength == NULL || DataToggle == NULL || TransferResult == NULL ||
*DataLength == 0 || (*DataToggle != 0 && *DataToggle != 1) ||
(MaxPacketLength != 8 && MaxPacketLength != 16 &&
MaxPacketLength != 32 && MaxPacketLength != 64)) {
return EFI_INVALID_PARAMETER;
}
Ohc = USB_OHCI_HC_DEV_FROM_THIS (This);
if ((EndPointAddress & 0x80) != 0) {
TransferDirection = EfiUsbDataIn;
EdDir = ED_IN_DIR;
DataPidDir = TD_IN_PID;
MapOp = EfiPciIoOperationBusMasterWrite;
} else {
TransferDirection = EfiUsbDataOut;
EdDir = ED_OUT_DIR;
DataPidDir = TD_OUT_PID;
MapOp = EfiPciIoOperationBusMasterRead;
}
EndPointNum = (EndPointAddress & 0xF);
EdResult.NextToggle = *DataToggle;
Status = OhciSetHcControl (Ohc, BULK_ENABLE, 0);
if (EFI_ERROR(Status)) {
DEBUG ((EFI_D_INFO, "OhciControlTransfer: fail to disable BULK_ENABLE\r\n"));
*TransferResult = EFI_USB_ERR_SYSTEM;
return EFI_DEVICE_ERROR;
}
Status = OhciSetHcCommandStatus (Ohc, BULK_LIST_FILLED, 0);
if (EFI_ERROR(Status)) {
DEBUG ((EFI_D_INFO, "OhciControlTransfer: fail to disable BULK_LIST_FILLED\r\n"));
*TransferResult = EFI_USB_ERR_SYSTEM;
return EFI_DEVICE_ERROR;
}
gBS->Stall(20 * 1000);
OhciSetMemoryPointer (Ohc, HC_BULK_HEAD, NULL);
Ed = OhciCreateED (Ohc);
if (Ed == NULL) {
return EFI_OUT_OF_RESOURCES;
}
OhciSetEDField (Ed, ED_SKIP, 1);
OhciSetEDField (Ed, ED_FUNC_ADD, DeviceAddress);
OhciSetEDField (Ed, ED_ENDPT_NUM, EndPointNum);
OhciSetEDField (Ed, ED_DIR, ED_FROM_TD_DIR);
OhciSetEDField (Ed, ED_SPEED, HI_SPEED);
OhciSetEDField (Ed, ED_FORMAT | ED_HALTED | ED_DTTOGGLE, 0);
OhciSetEDField (Ed, ED_MAX_PACKET, MaxPacketLength);
OhciSetEDField (Ed, ED_PDATA, 0);
OhciSetEDField (Ed, ED_ZERO, 0);
OhciSetEDField (Ed, ED_TDHEAD_PTR, 0);
OhciSetEDField (Ed, ED_TDTAIL_PTR, 0);
OhciSetEDField (Ed, ED_NEXT_EDPTR, 0);
HeadEd = OhciAttachEDToList (Ohc, BULK_LIST, Ed, NULL);
if(Data != NULL) {
MapLength = *DataLength;
Status = Ohc->PciIo->Map (Ohc->PciIo, MapOp, (UINT8 *)Data, &MapLength, &MapPyhAddr, &Mapping);
if (EFI_ERROR(Status)) {
DEBUG ((EFI_D_INFO, "OhciBulkTransfer: Fail to Map Data Buffer for Bulk\r\n"));
goto FREE_ED_BUFF;
}
}
//
//Data Stage
//
LeftLength = MapLength;
ActualSendLength = MapLength;
HeadTd = NULL;
FirstTD = TRUE;
while (LeftLength > 0) {
ActualSendLength = LeftLength;
if (LeftLength > MaxPacketLength) {
ActualSendLength = MaxPacketLength;
}
DataTd = OhciCreateTD (Ohc);
if (DataTd == NULL) {
DEBUG ((EFI_D_INFO, "OhciBulkTransfer: Fail to allocate buffer for Data Stage TD\r\n"));
Status = EFI_OUT_OF_RESOURCES;
goto FREE_OHCI_TDBUFF;
}
OhciSetTDField (DataTd, TD_PDATA, 0);
OhciSetTDField (DataTd, TD_BUFFER_ROUND, 1);
OhciSetTDField (DataTd, TD_DIR_PID, DataPidDir);
OhciSetTDField (DataTd, TD_DELAY_INT, TD_NO_DELAY);
OhciSetTDField (DataTd, TD_DT_TOGGLE, *DataToggle);
OhciSetTDField (DataTd, TD_ERROR_CNT, 0);
OhciSetTDField (DataTd, TD_COND_CODE, TD_TOBE_PROCESSED);
OhciSetTDField (DataTd, TD_CURR_BUFFER_PTR, (UINT32) MapPyhAddr);
OhciSetTDField (DataTd, TD_BUFFER_END_PTR, (UINT32)(MapPyhAddr + ActualSendLength - 1));
OhciSetTDField (DataTd, TD_NEXT_PTR, 0);
DataTd->ActualSendLength = (UINT32)ActualSendLength;
DataTd->DataBuffer = (UINT32)(UINTN)MapPyhAddr;
DataTd->NextTDPointer = 0;
if (FirstTD) {
HeadTd = DataTd;
FirstTD = FALSE;
} else {
OhciLinkTD (HeadTd, DataTd);
}
*DataToggle ^= 1;
MapPyhAddr += ActualSendLength;
LeftLength -= ActualSendLength;
}
//
// Empty Stage
//
EmptyTd = OhciCreateTD (Ohc);
if (EmptyTd == NULL) {
Status = EFI_OUT_OF_RESOURCES;
DEBUG ((EFI_D_INFO, "OhciBulkTransfer: Fail to allocate buffer for Empty TD\r\n"));
goto FREE_OHCI_TDBUFF;
}
OhciSetTDField (EmptyTd, TD_PDATA, 0);
OhciSetTDField (EmptyTd, TD_BUFFER_ROUND, 0);
OhciSetTDField (EmptyTd, TD_DIR_PID, 0);
OhciSetTDField (EmptyTd, TD_DELAY_INT, 0);
//OhciSetTDField (EmptyTd, TD_DT_TOGGLE, CurrentToggle);
EmptyTd->Word0.DataToggle = 0;
OhciSetTDField (EmptyTd, TD_ERROR_CNT, 0);
OhciSetTDField (EmptyTd, TD_COND_CODE, 0);
OhciSetTDField (EmptyTd, TD_CURR_BUFFER_PTR, 0);
OhciSetTDField (EmptyTd, TD_BUFFER_END_PTR, 0);
OhciSetTDField (EmptyTd, TD_NEXT_PTR, 0);
EmptyTd->ActualSendLength = 0;
EmptyTd->DataBuffer = 0;
EmptyTd->NextTDPointer = 0;
OhciLinkTD (HeadTd, EmptyTd);
Ed->TdTailPointer = (UINT32)(UINTN)EmptyTd;
OhciAttachTDListToED (Ed, HeadTd);
OhciSetEDField (Ed, ED_SKIP, 0);
Status = OhciSetHcCommandStatus (Ohc, BULK_LIST_FILLED, 1);
if (EFI_ERROR(Status)) {
*TransferResult = EFI_USB_ERR_SYSTEM;
Status = EFI_DEVICE_ERROR;
DEBUG ((EFI_D_INFO, "OhciControlTransfer: Fail to enable BULK_LIST_FILLED\r\n"));
goto FREE_OHCI_TDBUFF;
}
Status = OhciSetHcControl (Ohc, BULK_ENABLE, 1);
if (EFI_ERROR(Status)) {
*TransferResult = EFI_USB_ERR_SYSTEM;
Status = EFI_DEVICE_ERROR;
DEBUG ((EFI_D_INFO, "OhciControlTransfer: Fail to enable BULK_ENABLE\r\n"));
goto FREE_OHCI_TDBUFF;
}
gBS->Stall(20 * 1000);
TimeCount = 0;
Status = CheckIfDone (Ohc, BULK_LIST, Ed, HeadTd, &EdResult);
while (Status == EFI_NOT_READY && TimeCount <= TimeOut) {
gBS->Stall (1000);
TimeCount++;
Status = CheckIfDone (Ohc, BULK_LIST, Ed, HeadTd, &EdResult);
}
*TransferResult = ConvertErrorCode (EdResult.ErrorCode);
if (EdResult.ErrorCode != TD_NO_ERROR) {
if (EdResult.ErrorCode == TD_TOBE_PROCESSED) {
DEBUG ((EFI_D_INFO, "Bulk pipe timeout, > %d mS\r\n", TimeOut));
} else {
DEBUG ((EFI_D_INFO, "Bulk pipe broken\r\n"));
*DataToggle = EdResult.NextToggle;
}
*DataLength = 0;
} else {
DEBUG ((EFI_D_INFO, "Bulk transfer successed\r\n"));
}
//*DataToggle = (UINT8) OhciGetEDField (Ed, ED_DTTOGGLE);
FREE_OHCI_TDBUFF:
OhciSetEDField (Ed, ED_SKIP, 1);
if (HeadEd == Ed) {
OhciSetMemoryPointer (Ohc, HC_BULK_HEAD, NULL);
}else {
HeadEd->NextED = Ed->NextED;
}
while (HeadTd) {
DataTd = HeadTd;
HeadTd = (TD_DESCRIPTOR *)(UINTN)(HeadTd->NextTDPointer);
UsbHcFreeMem(Ohc->MemPool, DataTd, sizeof(TD_DESCRIPTOR));
}
if(Mapping != NULL) {
Ohc->PciIo->Unmap(Ohc->PciIo, Mapping);
}
FREE_ED_BUFF:
UsbHcFreeMem(Ohc->MemPool, Ed, sizeof(ED_DESCRIPTOR));
return Status;
}
/**
Submits an interrupt transfer to an interrupt endpoint of a USB device.
@param Ohc Device private data
@param DeviceAddress Represents the address of the target device on the USB,
which is assigned during USB enumeration.
@param EndPointAddress The combination of an endpoint number and an endpoint
direction of the target USB device. Each endpoint address
supports data transfer in one direction except the
control endpoint (whose default endpoint address is 0).
It is the caller's responsibility to make sure that
the EndPointAddress represents an interrupt endpoint.
@param IsSlowDevice Indicates whether the target device is slow device
or full-speed device.
@param MaxPacketLength Indicates the maximum packet size the target endpoint
is capable of sending or receiving.
@param IsNewTransfer If TRUE, an asynchronous interrupt pipe is built between
the host and the target interrupt endpoint.
If FALSE, the specified asynchronous interrupt pipe
is canceled.
@param DataToggle A pointer to the data toggle value. On input, it is valid
when IsNewTransfer is TRUE, and it indicates the initial
data toggle value the asynchronous interrupt transfer
should adopt.
On output, it is valid when IsNewTransfer is FALSE,
and it is updated to indicate the data toggle value of
the subsequent asynchronous interrupt transfer.
@param PollingInterval Indicates the interval, in milliseconds, that the
asynchronous interrupt transfer is polled.
This parameter is required when IsNewTransfer is TRUE.
@param UCBuffer Uncacheable buffer
@param DataLength Indicates the length of data to be received at the
rate specified by PollingInterval from the target
asynchronous interrupt endpoint. This parameter
is only required when IsNewTransfer is TRUE.
@param CallBackFunction The Callback function.This function is called at the
rate specified by PollingInterval.This parameter is
only required when IsNewTransfer is TRUE.
@param Context The context that is passed to the CallBackFunction.
This is an optional parameter and may be NULL.
@param IsPeriodic Periodic interrupt or not
@param OutputED The correspoding ED carried out
@param OutputTD The correspoding TD carried out
@retval EFI_SUCCESS The asynchronous interrupt transfer request has been successfully
submitted or canceled.
@retval EFI_INVALID_PARAMETER Some parameters are invalid.
@retval EFI_OUT_OF_RESOURCES The request could not be completed due to a lack of resources.
**/
EFI_STATUS
OhciInterruptTransfer (
IN USB_OHCI_HC_DEV *Ohc,
IN UINT8 DeviceAddress,
IN UINT8 EndPointAddress,
IN BOOLEAN IsSlowDevice,
IN UINT8 MaxPacketLength,
IN BOOLEAN IsNewTransfer,
IN OUT UINT8 *DataToggle OPTIONAL,
IN UINTN PollingInterval OPTIONAL,
IN VOID *UCBuffer OPTIONAL,
IN UINTN DataLength OPTIONAL,
IN EFI_ASYNC_USB_TRANSFER_CALLBACK CallBackFunction OPTIONAL,
IN VOID *Context OPTIONAL,
IN BOOLEAN IsPeriodic OPTIONAL,
OUT ED_DESCRIPTOR **OutputED OPTIONAL,
OUT TD_DESCRIPTOR **OutputTD OPTIONAL
)
{
ED_DESCRIPTOR *Ed;
UINT8 EdDir;
ED_DESCRIPTOR *HeadEd;
TD_DESCRIPTOR *HeadTd;
TD_DESCRIPTOR *DataTd;
TD_DESCRIPTOR *EmptTd;
UINTN Depth;
UINTN Index;
EFI_STATUS Status;
UINT8 EndPointNum;
UINT32 DataPidDir;
EFI_USB_DATA_DIRECTION TransferDirection;
INTERRUPT_CONTEXT_ENTRY *Entry;
EFI_TPL OldTpl;
BOOLEAN FirstTD;
VOID *Mapping;
UINTN MapLength;
EFI_PHYSICAL_ADDRESS MapPyhAddr;
UINTN LeftLength;
UINTN ActualSendLength;
if (DataLength > MAX_BYTES_PER_TD) {
DEBUG ((EFI_D_ERROR, "OhciInterruptTransfer: Error param\r\n"));
return EFI_INVALID_PARAMETER;
}
if ((EndPointAddress & 0x80) != 0) {
TransferDirection = EfiUsbDataIn;
EdDir = ED_IN_DIR;
DataPidDir = TD_IN_PID;
} else {
TransferDirection = EfiUsbDataOut;
EdDir = ED_OUT_DIR;
DataPidDir = TD_OUT_PID;
}
EndPointNum = (EndPointAddress & 0xF);
if (!IsNewTransfer) {
OldTpl = gBS->RaiseTPL (TPL_NOTIFY);
OhciSetHcControl (Ohc, PERIODIC_ENABLE, 0);
OhciFreeInterruptContext (Ohc, DeviceAddress, EndPointAddress, DataToggle);
Status = OhciFreeInterruptEdByAddr (Ohc, DeviceAddress, EndPointNum);
OhciSetHcControl (Ohc, PERIODIC_ENABLE, 1);
gBS->RestoreTPL (OldTpl);
return Status;
}
MapLength = DataLength;
Status = Ohc->PciIo->Map(
Ohc->PciIo,
EfiPciIoOperationBusMasterWrite,
UCBuffer,
&MapLength,
&MapPyhAddr,
&Mapping
);
if (EFI_ERROR(Status)) {
DEBUG ((EFI_D_ERROR, "OhciInterruptTransfer: Failt to PciIo->Map buffer \r\n"));
goto EXIT;
}
Depth = 5;
Index = 1;
while (PollingInterval >= Index * 2 && Depth > 0) {
Index *= 2;
Depth--;
}
//
//ED Stage
//
HeadEd = OhciFindMinInterruptEDList (Ohc, (UINT32)Depth);
if ((Ed = OhciFindWorkingEd (HeadEd, DeviceAddress, EndPointNum, EdDir)) != NULL) {
OhciSetEDField (Ed, ED_SKIP, 1);
} else {
Ed = OhciCreateED (Ohc);
if (Ed == NULL) {
Status = EFI_OUT_OF_RESOURCES;
DEBUG ((EFI_D_ERROR, "OhciInterruptTransfer: Fail to allocate buffer for ED\r\n"));
goto UNMAP_OHCI_XBUFF;
}
OhciSetEDField (Ed, ED_SKIP, 1);
OhciSetEDField (Ed, ED_FUNC_ADD, DeviceAddress);
OhciSetEDField (Ed, ED_ENDPT_NUM, EndPointNum);
OhciSetEDField (Ed, ED_DIR, ED_FROM_TD_DIR);
OhciSetEDField (Ed, ED_SPEED, IsSlowDevice);
OhciSetEDField (Ed, ED_FORMAT, 0);
OhciSetEDField (Ed, ED_MAX_PACKET, MaxPacketLength);
OhciSetEDField (Ed, ED_PDATA | ED_ZERO | ED_HALTED | ED_DTTOGGLE, 0);
OhciSetEDField (Ed, ED_TDHEAD_PTR, 0);
OhciSetEDField (Ed, ED_TDTAIL_PTR, 0);
OhciSetEDField (Ed, ED_NEXT_EDPTR, 0);
OhciAttachEDToList (Ohc, INTERRUPT_LIST, Ed, HeadEd);
}
//
//Data Stage
//
LeftLength = MapLength;
ActualSendLength = MapLength;
HeadTd = NULL;
FirstTD = TRUE;
while (LeftLength > 0) {
ActualSendLength = LeftLength;
if (LeftLength > MaxPacketLength) {
ActualSendLength = MaxPacketLength;
}
DataTd = OhciCreateTD (Ohc);
if (DataTd == NULL) {
Status = EFI_OUT_OF_RESOURCES;
DEBUG ((EFI_D_ERROR, "OhciInterruptTransfer: Fail to allocate buffer for Data Stage TD\r\n"));
goto FREE_OHCI_TDBUFF;
}
OhciSetTDField (DataTd, TD_PDATA, 0);
OhciSetTDField (DataTd, TD_BUFFER_ROUND, 1);
OhciSetTDField (DataTd, TD_DIR_PID, DataPidDir);
OhciSetTDField (DataTd, TD_DELAY_INT, TD_NO_DELAY);
OhciSetTDField (DataTd, TD_DT_TOGGLE, *DataToggle);
OhciSetTDField (DataTd, TD_ERROR_CNT, 0);
OhciSetTDField (DataTd, TD_COND_CODE, TD_TOBE_PROCESSED);
OhciSetTDField (DataTd, TD_CURR_BUFFER_PTR, (UINT32) MapPyhAddr);
OhciSetTDField (DataTd, TD_BUFFER_END_PTR, (UINT32)(MapPyhAddr + ActualSendLength - 1));
OhciSetTDField (DataTd, TD_NEXT_PTR, 0);
DataTd->ActualSendLength = (UINT32)ActualSendLength;
DataTd->DataBuffer = (UINT32)(UINTN)MapPyhAddr;
DataTd->NextTDPointer = 0;
if (FirstTD) {
HeadTd = DataTd;
FirstTD = FALSE;
} else {
OhciLinkTD (HeadTd, DataTd);
}
*DataToggle ^= 1;
MapPyhAddr += ActualSendLength;
LeftLength -= ActualSendLength;
}
EmptTd = OhciCreateTD (Ohc);
if (EmptTd == NULL) {
Status = EFI_OUT_OF_RESOURCES;
DEBUG ((EFI_D_ERROR, "OhciInterruptTransfer: Fail to allocate buffer for Empty Stage TD\r\n"));
goto FREE_OHCI_TDBUFF;
}
OhciSetTDField (EmptTd, TD_PDATA, 0);
OhciSetTDField (EmptTd, TD_BUFFER_ROUND, 0);
OhciSetTDField (EmptTd, TD_DIR_PID, 0);
OhciSetTDField (EmptTd, TD_DELAY_INT, 0);
//OhciSetTDField (EmptTd, TD_DT_TOGGLE, CurrentToggle);
EmptTd->Word0.DataToggle = 0;
OhciSetTDField (EmptTd, TD_ERROR_CNT, 0);
OhciSetTDField (EmptTd, TD_COND_CODE, 0);
OhciSetTDField (EmptTd, TD_CURR_BUFFER_PTR, 0);
OhciSetTDField (EmptTd, TD_BUFFER_END_PTR, 0);
OhciSetTDField (EmptTd, TD_NEXT_PTR, 0);
EmptTd->ActualSendLength = 0;
EmptTd->DataBuffer = 0;
EmptTd->NextTDPointer = 0;
OhciLinkTD (HeadTd, EmptTd);
Ed->TdTailPointer = (UINT32)(UINTN)EmptTd;
OhciAttachTDListToED (Ed, HeadTd);
if (OutputED != NULL) {
*OutputED = Ed;
}
if (OutputTD != NULL) {
*OutputTD = HeadTd;
}
if (CallBackFunction != NULL) {
Entry = AllocatePool (sizeof (INTERRUPT_CONTEXT_ENTRY));
if (Entry == NULL) {
goto FREE_OHCI_TDBUFF;
}
Entry->DeviceAddress = DeviceAddress;
Entry->EndPointAddress = EndPointAddress;
Entry->Ed = Ed;
Entry->DataTd = HeadTd;
Entry->IsSlowDevice = IsSlowDevice;
Entry->MaxPacketLength = MaxPacketLength;
Entry->PollingInterval = PollingInterval;
Entry->CallBackFunction = CallBackFunction;
Entry->Context = Context;
Entry->IsPeriodic = IsPeriodic;
Entry->UCBuffer = UCBuffer;
Entry->UCBufferMapping = Mapping;
Entry->DataLength = DataLength;
Entry->Toggle = DataToggle;
Entry->NextEntry = NULL;
OhciAddInterruptContextEntry (Ohc, Entry);
}
OhciSetEDField (Ed, ED_SKIP, 0);
if (OhciGetHcControl (Ohc, PERIODIC_ENABLE) == 0) {
Status = OhciSetHcControl (Ohc, PERIODIC_ENABLE, 1);
gBS->Stall (1000);
}
return EFI_SUCCESS;
FREE_OHCI_TDBUFF:
while (HeadTd) {
DataTd = HeadTd;
HeadTd = (TD_DESCRIPTOR *)(UINTN)(HeadTd->NextTDPointer);
UsbHcFreeMem(Ohc->MemPool, DataTd, sizeof(TD_DESCRIPTOR));
}
//FREE_OHCI_EDBUFF:
if ((HeadEd != Ed) && HeadEd && Ed) {
while(HeadEd->NextED != (UINT32)(UINTN)Ed) {
HeadEd = (ED_DESCRIPTOR *)(UINTN)(HeadEd->NextED);
}
HeadEd->NextED = Ed->NextED;
UsbHcFreeMem(Ohc->MemPool, Ed, sizeof(ED_DESCRIPTOR));
}
UNMAP_OHCI_XBUFF:
Ohc->PciIo->Unmap(Ohc->PciIo, Mapping);
EXIT:
return Status;
}
/**
Submits an asynchronous interrupt transfer to an interrupt endpoint of a USB device.
@param This A pointer to the EFI_USB_HC_PROTOCOL instance.
@param DeviceAddress Represents the address of the target device on the USB,
which is assigned during USB enumeration.
@param EndPointAddress The combination of an endpoint number and an endpoint
direction of the target USB device. Each endpoint address
supports data transfer in one direction except the
control endpoint (whose default endpoint address is 0).
It is the caller's responsibility to make sure that
the EndPointAddress represents an interrupt endpoint.
@param IsSlowDevice Indicates whether the target device is slow device
or full-speed device.
@param MaxiumPacketLength Indicates the maximum packet size the target endpoint
is capable of sending or receiving.
@param IsNewTransfer If TRUE, an asynchronous interrupt pipe is built between
the host and the target interrupt endpoint.
If FALSE, the specified asynchronous interrupt pipe
is canceled.
@param DataToggle A pointer to the data toggle value. On input, it is valid
when IsNewTransfer is TRUE, and it indicates the initial
data toggle value the asynchronous interrupt transfer
should adopt.
On output, it is valid when IsNewTransfer is FALSE,
and it is updated to indicate the data toggle value of
the subsequent asynchronous interrupt transfer.
@param PollingInterval Indicates the interval, in milliseconds, that the
asynchronous interrupt transfer is polled.
This parameter is required when IsNewTransfer is TRUE.
@param DataLength Indicates the length of data to be received at the
rate specified by PollingInterval from the target
asynchronous interrupt endpoint. This parameter
is only required when IsNewTransfer is TRUE.
@param CallBackFunction The Callback function.This function is called at the
rate specified by PollingInterval.This parameter is
only required when IsNewTransfer is TRUE.
@param Context The context that is passed to the CallBackFunction.
This is an optional parameter and may be NULL.
@retval EFI_SUCCESS The asynchronous interrupt transfer request has been successfully
submitted or canceled.
@retval EFI_INVALID_PARAMETER Some parameters are invalid.
@retval EFI_OUT_OF_RESOURCES The request could not be completed due to a lack of resources.
**/
EFI_STATUS
EFIAPI
OhciAsyncInterruptTransfer (
IN EFI_USB_HC_PROTOCOL *This,
IN UINT8 DeviceAddress,
IN UINT8 EndPointAddress,
IN BOOLEAN IsSlowDevice,
IN UINT8 MaxPacketLength,
IN BOOLEAN IsNewTransfer,
IN OUT UINT8 *DataToggle OPTIONAL,
IN UINTN PollingInterval OPTIONAL,
IN UINTN DataLength OPTIONAL,
IN EFI_ASYNC_USB_TRANSFER_CALLBACK CallBackFunction OPTIONAL,
IN VOID *Context OPTIONAL
)
{
EFI_STATUS Status;
USB_OHCI_HC_DEV *Ohc;
VOID *UCBuffer;
if (DataToggle == NULL || (EndPointAddress & 0x80) == 0 ||
(IsNewTransfer && (DataLength == 0 ||
(*DataToggle != 0 && *DataToggle != 1) || (PollingInterval < 1 || PollingInterval > 255)))) {
return EFI_INVALID_PARAMETER;
}
Ohc = USB_OHCI_HC_DEV_FROM_THIS (This);
if ( IsNewTransfer ) {
UCBuffer = AllocatePool(DataLength);
if (UCBuffer == NULL) {
return EFI_OUT_OF_RESOURCES;
}
} else {
UCBuffer = NULL;
}
Status = OhciInterruptTransfer (
Ohc,
DeviceAddress,
EndPointAddress,
IsSlowDevice,
MaxPacketLength,
IsNewTransfer,
DataToggle,
PollingInterval,
UCBuffer,
DataLength,
CallBackFunction,
Context,
TRUE,
NULL,
NULL
);
if ( UCBuffer ) {
// if (EFI_ERROR(Status)) {
gBS->FreePool(UCBuffer);
// }
}
return Status;
}
/**
Submits synchronous interrupt transfer to an interrupt endpoint
of a USB device.
@param This A pointer to the EFI_USB_HC_PROTOCOL instance.
@param DeviceAddress Represents the address of the target device on the USB,
which is assigned during USB enumeration.
@param EndPointAddress The combination of an endpoint number and an endpoint
direction of the target USB device. Each endpoint
address supports data transfer in one direction
except the control endpoint (whose default
endpoint address is 0). It is the caller's responsibility
to make sure that the EndPointAddress represents
an interrupt endpoint.
@param IsSlowDevice Indicates whether the target device is slow device
or full-speed device.
@param MaxPacketLength Indicates the maximum packet size the target endpoint
is capable of sending or receiving.
@param Data A pointer to the buffer of data that will be transmitted
to USB device or received from USB device.
@param DataLength On input, the size, in bytes, of the data buffer specified
by Data. On output, the number of bytes transferred.
@param DataToggle A pointer to the data toggle value. On input, it indicates
the initial data toggle value the synchronous interrupt
transfer should adopt;
on output, it is updated to indicate the data toggle value
of the subsequent synchronous interrupt transfer.
@param TimeOut Indicates the maximum time, in microseconds, which the
transfer is allowed to complete.
@param TransferResult A pointer to the detailed result information from
the synchronous interrupt transfer.
@retval EFI_UNSUPPORTED This interface not available.
@retval EFI_INVALID_PARAMETER Parameters not follow spec
**/
EFI_STATUS
EFIAPI
OhciSyncInterruptTransfer (
IN EFI_USB_HC_PROTOCOL *This,
IN UINT8 DeviceAddress,
IN UINT8 EndPointAddress,
IN BOOLEAN IsSlowDevice,
IN UINT8 MaxPacketLength,
IN OUT VOID *Data,
IN OUT UINTN *DataLength,
IN OUT UINT8 *DataToggle,
IN UINTN TimeOut,
OUT UINT32 *TransferResult
)
{
USB_OHCI_HC_DEV *Ohc;
EFI_STATUS Status;
ED_DESCRIPTOR *Ed;
TD_DESCRIPTOR *HeadTd;
OHCI_ED_RESULT EdResult;
VOID *UCBuffer;
if ((EndPointAddress & 0x80) == 0 || Data == NULL || DataLength == NULL || *DataLength == 0 ||
(IsSlowDevice && MaxPacketLength > 8) || (!IsSlowDevice && MaxPacketLength > 64) ||
DataToggle == NULL || (*DataToggle != 0 && *DataToggle != 1) || TransferResult == NULL) {
return EFI_INVALID_PARAMETER;
}
Ohc = USB_OHCI_HC_DEV_FROM_THIS (This);
UCBuffer = AllocatePool (*DataLength);
if (UCBuffer == NULL) {
return EFI_OUT_OF_RESOURCES;
}
Status = OhciInterruptTransfer (
Ohc,
DeviceAddress,
EndPointAddress,
IsSlowDevice,
MaxPacketLength,
TRUE,
DataToggle,
1,
UCBuffer,
*DataLength,
NULL,
NULL,
FALSE,
&Ed,
&HeadTd
);
if (!EFI_ERROR(Status)) {
Status = CheckIfDone (Ohc, INTERRUPT_LIST, Ed, HeadTd, &EdResult);
while (Status == EFI_NOT_READY && TimeOut > 0) {
gBS->Stall (1000);
TimeOut--;
Status = CheckIfDone (Ohc, INTERRUPT_LIST, Ed, HeadTd, &EdResult);
}
*TransferResult = ConvertErrorCode (EdResult.ErrorCode);
}
CopyMem(Data, UCBuffer, *DataLength);
Status = OhciInterruptTransfer (
Ohc,
DeviceAddress,
EndPointAddress,
IsSlowDevice,
MaxPacketLength,
FALSE,
DataToggle,
0,
NULL,
0,
NULL,
NULL,
FALSE,
NULL,
NULL
);
gBS->FreePool(UCBuffer);
return Status;
}
/**
Submits isochronous transfer to a target USB device.
@param This A pointer to the EFI_USB_HC_PROTOCOL instance.
@param DeviceAddress Represents the address of the target device on the USB,
which is assigned during USB enumeration.
@param EndPointAddress End point address
@param MaximumPacketLength Indicates the maximum packet size that the
default control transfer endpoint is capable of
sending or receiving.
@param Data A pointer to the buffer of data that will be transmitted
to USB device or received from USB device.
@param DataLength Indicates the size, in bytes, of the data buffer
specified by Data.
@param TransferResult A pointer to the detailed result information generated
by this control transfer.
@retval EFI_UNSUPPORTED This interface not available
@retval EFI_INVALID_PARAMETER Data is NULL or DataLength is 0 or TransferResult is NULL
**/
EFI_STATUS
EFIAPI
OhciIsochronousTransfer (
IN EFI_USB_HC_PROTOCOL *This,
IN UINT8 DeviceAddress,
IN UINT8 EndPointAddress,
IN UINT8 MaximumPacketLength,
IN OUT VOID *Data,
IN OUT UINTN DataLength,
OUT UINT32 *TransferResult
)
{
if (Data == NULL || DataLength == 0 || TransferResult == NULL) {
return EFI_INVALID_PARAMETER;
}
return EFI_UNSUPPORTED;
}
/**
Submits Async isochronous transfer to a target USB device.
@param his A pointer to the EFI_USB_HC_PROTOCOL instance.
@param DeviceAddress Represents the address of the target device on the USB,
which is assigned during USB enumeration.
@param EndPointAddress End point address
@param MaximumPacketLength Indicates the maximum packet size that the
default control transfer endpoint is capable of
sending or receiving.
@param Data A pointer to the buffer of data that will be transmitted
to USB device or received from USB device.
@param IsochronousCallBack When the transfer complete, the call back function will be called
@param Context Pass to the call back function as parameter
@retval EFI_UNSUPPORTED This interface not available
@retval EFI_INVALID_PARAMETER Data is NULL or Datalength is 0
**/
EFI_STATUS
EFIAPI
OhciAsyncIsochronousTransfer (
IN EFI_USB_HC_PROTOCOL *This,
IN UINT8 DeviceAddress,
IN UINT8 EndPointAddress,
IN UINT8 MaximumPacketLength,
IN OUT VOID *Data,
IN OUT UINTN DataLength,
IN EFI_ASYNC_USB_TRANSFER_CALLBACK IsochronousCallBack,
IN VOID *Context OPTIONAL
)
{
if (Data == NULL || DataLength == 0) {
return EFI_INVALID_PARAMETER;
}
return EFI_UNSUPPORTED;
}
/**
Retrieves the number of root hub ports.
@param This A pointer to the EFI_USB_HC_PROTOCOL instance.
@param NumOfPorts A pointer to the number of the root hub ports.
@retval EFI_SUCCESS The port number was retrieved successfully.
**/
EFI_STATUS
EFIAPI
OhciGetRootHubNumOfPorts (
IN EFI_USB_HC_PROTOCOL *This,
OUT UINT8 *NumOfPorts
)
{
USB_OHCI_HC_DEV *Ohc;
Ohc = USB_OHCI_HC_DEV_FROM_THIS (This);
if (NumOfPorts == NULL) {
return EFI_INVALID_PARAMETER;
}
*NumOfPorts = (UINT8)OhciGetRootHubDescriptor(Ohc, RH_NUM_DS_PORTS);
return EFI_SUCCESS;
}
/**
Retrieves the current status of a USB root hub port.
@param This A pointer to the EFI_USB_HC_PROTOCOL.
@param PortNumber Specifies the root hub port from which the status
is to be retrieved. This value is zero-based. For example,
if a root hub has two ports, then the first port is numbered 0,
and the second port is numbered 1.
@param PortStatus A pointer to the current port status bits and
port status change bits.
@retval EFI_SUCCESS The status of the USB root hub port specified by PortNumber
was returned in PortStatus.
@retval EFI_INVALID_PARAMETER Port number not valid
**/
EFI_STATUS
EFIAPI
OhciGetRootHubPortStatus (
IN EFI_USB_HC_PROTOCOL *This,
IN UINT8 PortNumber,
OUT EFI_USB_PORT_STATUS *PortStatus
)
{
USB_OHCI_HC_DEV *Ohc;
UINT8 NumOfPorts;
Ohc = USB_OHCI_HC_DEV_FROM_THIS (This);
OhciGetRootHubNumOfPorts (This, &NumOfPorts);
if (PortNumber >= NumOfPorts) {
return EFI_INVALID_PARAMETER;
}
PortStatus->PortStatus = 0;
PortStatus->PortChangeStatus = 0;
if (OhciReadRootHubPortStatus (Ohc,PortNumber, RH_CURR_CONNECT_STAT)) {
PortStatus->PortStatus |= USB_PORT_STAT_CONNECTION;
}
if (OhciReadRootHubPortStatus (Ohc,PortNumber, RH_PORT_ENABLE_STAT)) {
PortStatus->PortStatus |= USB_PORT_STAT_ENABLE;
}
if (OhciReadRootHubPortStatus (Ohc,PortNumber, RH_PORT_SUSPEND_STAT)) {
PortStatus->PortStatus |= USB_PORT_STAT_SUSPEND;
}
if (OhciReadRootHubPortStatus (Ohc,PortNumber, RH_PORT_OC_INDICATOR)) {
PortStatus->PortStatus |= USB_PORT_STAT_OVERCURRENT;
}
if (OhciReadRootHubPortStatus (Ohc,PortNumber, RH_PORT_RESET_STAT)) {
PortStatus->PortStatus |= USB_PORT_STAT_RESET;
}
if (OhciReadRootHubPortStatus (Ohc,PortNumber, RH_PORT_POWER_STAT)) {
PortStatus->PortStatus |= USB_PORT_STAT_POWER;
}
if (OhciReadRootHubPortStatus (Ohc,PortNumber, RH_LSDEVICE_ATTACHED)) {
PortStatus->PortStatus |= USB_PORT_STAT_LOW_SPEED;
}
if (OhciReadRootHubPortStatus (Ohc, PortNumber, RH_PORT_ENABLE_STAT_CHANGE)) {
PortStatus->PortChangeStatus |= USB_PORT_STAT_C_ENABLE;
}
if (OhciReadRootHubPortStatus (Ohc, PortNumber, RH_CONNECT_STATUS_CHANGE)) {
PortStatus->PortChangeStatus |= USB_PORT_STAT_C_CONNECTION;
}
if (OhciReadRootHubPortStatus (Ohc, PortNumber, RH_PORT_SUSPEND_STAT_CHANGE)) {
PortStatus->PortChangeStatus |= USB_PORT_STAT_C_SUSPEND;
}
if (OhciReadRootHubPortStatus (Ohc, PortNumber, RH_OC_INDICATOR_CHANGE)) {
PortStatus->PortChangeStatus |= USB_PORT_STAT_C_OVERCURRENT;
}
if (OhciReadRootHubPortStatus (Ohc, PortNumber, RH_PORT_RESET_STAT_CHANGE)) {
PortStatus->PortChangeStatus |= USB_PORT_STAT_C_RESET;
}
return EFI_SUCCESS;
}
/**
Sets a feature for the specified root hub port.
@param This A pointer to the EFI_USB_HC_PROTOCOL.
@param PortNumber Specifies the root hub port whose feature
is requested to be set.
@param PortFeature Indicates the feature selector associated
with the feature set request.
@retval EFI_SUCCESS The feature specified by PortFeature was set for the
USB root hub port specified by PortNumber.
@retval EFI_DEVICE_ERROR Set feature failed because of hardware issue
@retval EFI_INVALID_PARAMETER PortNumber is invalid or PortFeature is invalid.
**/
EFI_STATUS
EFIAPI
OhciSetRootHubPortFeature (
IN EFI_USB_HC_PROTOCOL *This,
IN UINT8 PortNumber,
IN EFI_USB_PORT_FEATURE PortFeature
)
{
USB_OHCI_HC_DEV *Ohc;
EFI_STATUS Status;
UINT8 NumOfPorts;
UINTN RetryTimes;
OhciGetRootHubNumOfPorts (This, &NumOfPorts);
if (PortNumber >= NumOfPorts) {
return EFI_INVALID_PARAMETER;
}
Ohc = USB_OHCI_HC_DEV_FROM_THIS (This);
Status = EFI_SUCCESS;
switch (PortFeature) {
case EfiUsbPortPower:
Status = OhciSetRootHubPortStatus (Ohc, PortNumber, RH_SET_PORT_POWER);
//
// Verify the state
//
RetryTimes = 0;
do {
gBS->Stall (1000);
RetryTimes++;
} while (OhciReadRootHubPortStatus (Ohc, PortNumber, RH_PORT_POWER_STAT) == 0 &&
RetryTimes < MAX_RETRY_TIMES);
if (RetryTimes >= MAX_RETRY_TIMES) {
return EFI_DEVICE_ERROR;
}
break;
case EfiUsbPortReset:
Status = OhciSetRootHubPortStatus (Ohc, PortNumber, RH_SET_PORT_RESET);
//
// Verify the state
//
RetryTimes = 0;
do {
gBS->Stall (1000);
RetryTimes++;
} while ((OhciReadRootHubPortStatus (Ohc, PortNumber, RH_PORT_RESET_STAT_CHANGE) == 0 ||
OhciReadRootHubPortStatus (Ohc, PortNumber, RH_PORT_RESET_STAT) == 1) &&
RetryTimes < MAX_RETRY_TIMES);
if (RetryTimes >= MAX_RETRY_TIMES) {
return EFI_DEVICE_ERROR;
}
OhciSetRootHubPortStatus (Ohc, PortNumber, RH_PORT_RESET_STAT_CHANGE);
break;
case EfiUsbPortEnable:
Status = OhciSetRootHubPortStatus (Ohc, PortNumber, RH_SET_PORT_ENABLE);
//
// Verify the state
//
RetryTimes = 0;
do {
gBS->Stall (1000);
RetryTimes++;
} while (OhciReadRootHubPortStatus (Ohc, PortNumber, RH_PORT_ENABLE_STAT) == 0 &&
RetryTimes < MAX_RETRY_TIMES);
if (RetryTimes >= MAX_RETRY_TIMES) {
return EFI_DEVICE_ERROR;
}
break;
case EfiUsbPortSuspend:
Status = OhciSetRootHubPortStatus (Ohc, PortNumber, RH_SET_PORT_SUSPEND);
//
// Verify the state
//
RetryTimes = 0;
do {
gBS->Stall (1000);
RetryTimes++;
} while (OhciReadRootHubPortStatus (Ohc, PortNumber, RH_PORT_SUSPEND_STAT) == 0 &&
RetryTimes < MAX_RETRY_TIMES);
if (RetryTimes >= MAX_RETRY_TIMES) {
return EFI_DEVICE_ERROR;
}
break;
default:
return EFI_INVALID_PARAMETER;
}
return Status;
}
/**
Clears a feature for the specified root hub port.
@param This A pointer to the EFI_USB_HC_PROTOCOL instance.
@param PortNumber Specifies the root hub port whose feature
is requested to be cleared.
@param PortFeature Indicates the feature selector associated with the
feature clear request.
@retval EFI_SUCCESS The feature specified by PortFeature was cleared for the
USB root hub port specified by PortNumber.
@retval EFI_INVALID_PARAMETER PortNumber is invalid or PortFeature is invalid.
@retval EFI_DEVICE_ERROR Some error happened when clearing feature
**/
EFI_STATUS
EFIAPI
OhciClearRootHubPortFeature (
IN EFI_USB_HC_PROTOCOL *This,
IN UINT8 PortNumber,
IN EFI_USB_PORT_FEATURE PortFeature
)
{
USB_OHCI_HC_DEV *Ohc;
EFI_STATUS Status;
UINT8 NumOfPorts;
UINTN RetryTimes;
OhciGetRootHubNumOfPorts (This, &NumOfPorts);
if (PortNumber >= NumOfPorts) {
return EFI_INVALID_PARAMETER;
}
Ohc = USB_OHCI_HC_DEV_FROM_THIS (This);
Status = EFI_SUCCESS;
switch (PortFeature) {
case EfiUsbPortEnable:
Status = OhciSetRootHubPortStatus (Ohc, PortNumber, RH_CLEAR_PORT_ENABLE);
//
// Verify the state
//
RetryTimes = 0;
do {
gBS->Stall (1000);
RetryTimes++;
} while (OhciReadRootHubPortStatus (Ohc, PortNumber, RH_PORT_ENABLE_STAT) == 1 &&
RetryTimes < MAX_RETRY_TIMES);
if (RetryTimes >= MAX_RETRY_TIMES) {
return EFI_DEVICE_ERROR;
}
break;
case EfiUsbPortSuspend:
Status = OhciSetRootHubPortStatus (Ohc, PortNumber, RH_CLEAR_SUSPEND_STATUS);
//
// Verify the state
//
RetryTimes = 0;
do {
gBS->Stall (1000);
RetryTimes++;
} while (OhciReadRootHubPortStatus (Ohc, PortNumber, RH_PORT_SUSPEND_STAT) == 1 &&
RetryTimes < MAX_RETRY_TIMES);
if (RetryTimes >= MAX_RETRY_TIMES) {
return EFI_DEVICE_ERROR;
}
break;
case EfiUsbPortReset:
break;
case EfiUsbPortPower:
Status = OhciSetRootHubPortStatus (Ohc, PortNumber, RH_CLEAR_PORT_POWER);
//
// Verify the state
//
RetryTimes = 0;
do {
gBS->Stall (1000);
RetryTimes++;
} while (OhciReadRootHubPortStatus (Ohc, PortNumber, RH_PORT_POWER_STAT) == 1 &&
RetryTimes < MAX_RETRY_TIMES);
if (RetryTimes >= MAX_RETRY_TIMES) {
return EFI_DEVICE_ERROR;
}
break;
case EfiUsbPortConnectChange:
Status = OhciSetRootHubPortStatus (Ohc, PortNumber, RH_CONNECT_STATUS_CHANGE);
//
// Verify the state
//
RetryTimes = 0;
do {
gBS->Stall (1000);
RetryTimes++;
} while (OhciReadRootHubPortStatus (Ohc, PortNumber, RH_CONNECT_STATUS_CHANGE) == 1 &&
RetryTimes < MAX_RETRY_TIMES);
if (RetryTimes >= MAX_RETRY_TIMES) {
return EFI_DEVICE_ERROR;
}
break;
case EfiUsbPortResetChange:
Status = OhciSetRootHubPortStatus (Ohc, PortNumber, RH_PORT_RESET_STAT_CHANGE);
//
// Verify the state
//
RetryTimes = 0;
do {
gBS->Stall (1000);
RetryTimes++;
} while (OhciReadRootHubPortStatus (Ohc, PortNumber, RH_PORT_RESET_STAT_CHANGE) == 1 &&
RetryTimes < MAX_RETRY_TIMES);
if (RetryTimes >= MAX_RETRY_TIMES) {
return EFI_DEVICE_ERROR;
}
break;
case EfiUsbPortEnableChange:
Status = OhciSetRootHubPortStatus (Ohc, PortNumber, RH_PORT_ENABLE_STAT_CHANGE);
//
// Verify the state
//
RetryTimes = 0;
do {
gBS->Stall (1000);
RetryTimes++;
} while (OhciReadRootHubPortStatus (Ohc, PortNumber, RH_PORT_ENABLE_STAT_CHANGE) == 1 &&
RetryTimes < MAX_RETRY_TIMES);
if (RetryTimes >= MAX_RETRY_TIMES) {
return EFI_DEVICE_ERROR;
}
break;
case EfiUsbPortSuspendChange:
Status = OhciSetRootHubPortStatus (Ohc, PortNumber, RH_PORT_SUSPEND_STAT_CHANGE);
//
// Verify the state
//
RetryTimes = 0;
do {
gBS->Stall (1000);
RetryTimes++;
} while (OhciReadRootHubPortStatus (Ohc, PortNumber, RH_PORT_SUSPEND_STAT_CHANGE) == 1 &&
RetryTimes < MAX_RETRY_TIMES);
if (RetryTimes >= MAX_RETRY_TIMES) {
return EFI_DEVICE_ERROR;
}
break;
case EfiUsbPortOverCurrentChange:
Status = OhciSetRootHubPortStatus (Ohc, PortNumber, RH_OC_INDICATOR_CHANGE);
//
// Verify the state
//
RetryTimes = 0;
do {
gBS->Stall (1000);
RetryTimes++;
} while (OhciReadRootHubPortStatus (Ohc, PortNumber, RH_OC_INDICATOR_CHANGE) == 1 &&
RetryTimes < MAX_RETRY_TIMES);
if (RetryTimes >= MAX_RETRY_TIMES) {
return EFI_DEVICE_ERROR;
}
break;
default:
return EFI_INVALID_PARAMETER;
}
return Status;
}
EFI_DRIVER_BINDING_PROTOCOL gOhciDriverBinding = {
OHCIDriverBindingSupported,
OHCIDriverBindingStart,
OHCIDriverBindingStop,
0x10,
NULL,
NULL
};
/**
Entry point for EFI drivers.
@param ImageHandle EFI_HANDLE.
@param SystemTable EFI_SYSTEM_TABLE.
@retval EFI_SUCCESS Driver is successfully loaded.
@return Others Failed.
**/
EFI_STATUS
EFIAPI
OHCIDriverEntryPoint (
IN EFI_HANDLE ImageHandle,
IN EFI_SYSTEM_TABLE *SystemTable
)
{
return EfiLibInstallDriverBindingComponentName2 (
ImageHandle,
SystemTable,
&gOhciDriverBinding,
ImageHandle,
&gOhciComponentName,
&gOhciComponentName2
);
}
/**
Test to see if this driver supports ControllerHandle. Any
ControllerHandle that has UsbHcProtocol installed will be supported.
@param This Protocol instance pointer.
@param Controller Handle of device to test.
@param RemainingDevicePath Not used.
@return EFI_SUCCESS This driver supports this device.
@return EFI_UNSUPPORTED This driver does not support this device.
**/
EFI_STATUS
EFIAPI
OHCIDriverBindingSupported (
IN EFI_DRIVER_BINDING_PROTOCOL *This,
IN EFI_HANDLE Controller,
IN EFI_DEVICE_PATH_PROTOCOL *RemainingDevicePath
)
{
EFI_STATUS Status;
EFI_PCI_IO_PROTOCOL *PciIo;
USB_CLASSC UsbClassCReg;
//
// Test whether there is PCI IO Protocol attached on the controller handle.
//
Status = gBS->OpenProtocol (
Controller,
&gEfiPciIoProtocolGuid,
(VOID **) &PciIo,
This->DriverBindingHandle,
Controller,
EFI_OPEN_PROTOCOL_BY_DRIVER
);
if (EFI_ERROR(Status)) {
return EFI_UNSUPPORTED;
}
Status = PciIo->Pci.Read (
PciIo,
EfiPciIoWidthUint8,
PCI_CLASSCODE_OFFSET,
sizeof (USB_CLASSC) / sizeof (UINT8),
&UsbClassCReg
);
if (EFI_ERROR(Status)) {
Status = EFI_UNSUPPORTED;
goto ON_EXIT;
}
//
// Test whether the controller belongs to OHCI type
//
if ((UsbClassCReg.BaseCode != PCI_CLASS_SERIAL) ||
(UsbClassCReg.SubClassCode != PCI_CLASS_SERIAL_USB) ||
(UsbClassCReg.ProgInterface != PCI_IF_OHCI)
) {
Status = EFI_UNSUPPORTED;
}
ON_EXIT:
gBS->CloseProtocol (
Controller,
&gEfiPciIoProtocolGuid,
This->DriverBindingHandle,
Controller
);
return Status;
}
/**
Allocate and initialize the empty OHCI device.
@param PciIo The PCIIO to use.
@param OriginalPciAttributes The original PCI attributes.
@return Allocated OHCI device If err, return NULL.
**/
USB_OHCI_HC_DEV *
OhciAllocateDev (
IN EFI_PCI_IO_PROTOCOL *PciIo,
IN UINT64 OriginalPciAttributes
)
{
USB_OHCI_HC_DEV *Ohc;
EFI_STATUS Status;
VOID *Buf;
EFI_PHYSICAL_ADDRESS PhyAddr;
VOID *Map;
UINTN Pages;
UINTN Bytes;
Ohc = AllocateZeroPool(sizeof (USB_OHCI_HC_DEV));
if (Ohc == NULL) {
return NULL;
}
Ohc->Signature = USB_OHCI_HC_DEV_SIGNATURE;
Ohc->PciIo = PciIo;
Ohc->UsbHc.Reset = OhciReset;
Ohc->UsbHc.GetState = OhciGetState;
Ohc->UsbHc.SetState = OhciSetState;
Ohc->UsbHc.ControlTransfer = OhciControlTransfer;
Ohc->UsbHc.BulkTransfer = OhciBulkTransfer;
Ohc->UsbHc.AsyncInterruptTransfer = OhciAsyncInterruptTransfer;
Ohc->UsbHc.SyncInterruptTransfer = OhciSyncInterruptTransfer;
Ohc->UsbHc.IsochronousTransfer = OhciIsochronousTransfer;
Ohc->UsbHc.AsyncIsochronousTransfer = OhciAsyncIsochronousTransfer;
Ohc->UsbHc.GetRootHubPortNumber = OhciGetRootHubNumOfPorts;
Ohc->UsbHc.GetRootHubPortStatus = OhciGetRootHubPortStatus;
Ohc->UsbHc.SetRootHubPortFeature = OhciSetRootHubPortFeature;
Ohc->UsbHc.ClearRootHubPortFeature = OhciClearRootHubPortFeature;
Ohc->UsbHc.MajorRevision = 0x1;
Ohc->UsbHc.MinorRevision = 0x1;
Ohc->OriginalPciAttributes = OriginalPciAttributes;
Ohc->HccaMemoryBlock = NULL;
Ohc->HccaMemoryMapping = NULL;
Ohc->HccaMemoryBuf = NULL;
Ohc->HccaMemoryPages = 0;
Ohc->InterruptContextList = NULL;
Ohc->ControllerNameTable = NULL;
Ohc->HouseKeeperTimer = NULL;
Ohc->MemPool = UsbHcInitMemPool(PciIo, TRUE, 0);
if(Ohc->MemPool == NULL) {
goto FREE_DEV_BUFFER;
}
Bytes = 4096;
Pages = EFI_SIZE_TO_PAGES (Bytes);
Status = PciIo->AllocateBuffer (
PciIo,
AllocateAnyPages,
EfiBootServicesData,
Pages,
&Buf,
0
);
if (EFI_ERROR(Status)) {
goto FREE_MEM_POOL;
}
Status = PciIo->Map (
PciIo,
EfiPciIoOperationBusMasterCommonBuffer,
Buf,
&Bytes,
&PhyAddr,
&Map
);
if (EFI_ERROR(Status) || (Bytes != 4096)) {
goto FREE_MEM_PAGE;
}
Ohc->HccaMemoryBlock = (HCCA_MEMORY_BLOCK *)(UINTN)PhyAddr;
Ohc->HccaMemoryMapping = Map;
Ohc->HccaMemoryBuf = (VOID *)(UINTN)Buf;
Ohc->HccaMemoryPages = Pages;
return Ohc;
FREE_MEM_PAGE:
PciIo->FreeBuffer (PciIo, Pages, Buf);
FREE_MEM_POOL:
UsbHcFreeMemPool (Ohc->MemPool);
FREE_DEV_BUFFER:
FreePool(Ohc);
return NULL;
}
/**
Free the OHCI device and release its associated resources.
@param Ohc The OHCI device to release.
**/
VOID
OhciFreeDev (
IN USB_OHCI_HC_DEV *Ohc
)
{
OhciFreeFixedIntMemory (Ohc);
if (Ohc->ExitBootServiceEvent != NULL) {
gBS->CloseEvent (Ohc->ExitBootServiceEvent);
}
if (Ohc->HouseKeeperTimer != NULL) {
gBS->CloseEvent (Ohc->HouseKeeperTimer);
}
if (Ohc->MemPool != NULL) {
UsbHcFreeMemPool (Ohc->MemPool);
}
if (Ohc->HccaMemoryMapping != NULL ) {
Ohc->PciIo->FreeBuffer (Ohc->PciIo, Ohc->HccaMemoryPages, Ohc->HccaMemoryBuf);
}
if (Ohc->ControllerNameTable != NULL) {
FreeUnicodeStringTable (Ohc->ControllerNameTable);
}
FreePool(Ohc);
}
/**
Uninstall all Ohci Interface.
@param Controller Controller handle.
@param This Protocol instance pointer.
**/
VOID
OhciCleanDevUp (
IN EFI_HANDLE Controller,
IN EFI_USB_HC_PROTOCOL *This
)
{
USB_OHCI_HC_DEV *Ohc;
//
// Uninstall the USB_HC and USB_HC2 protocol, then disable the controller
//
Ohc = USB_OHCI_HC_DEV_FROM_THIS (This);
OhciSetHcControl (Ohc, PERIODIC_ENABLE | CONTROL_ENABLE | ISOCHRONOUS_ENABLE | BULK_ENABLE, 0);
This->Reset (This, EFI_USB_HC_RESET_GLOBAL);
This->SetState (This, EfiUsbHcStateHalt);
gBS->UninstallProtocolInterface (
Controller,
&gEfiUsbHcProtocolGuid,
&Ohc->UsbHc
);
OhciFreeDynamicIntMemory(Ohc);
//
// Restore original PCI attributes
//
Ohc->PciIo->Attributes (
Ohc->PciIo,
EfiPciIoAttributeOperationSet,
Ohc->OriginalPciAttributes,
NULL
);
OhciFreeDev (Ohc);
return;
}
/**
One notified function to stop the Host Controller when gBS->ExitBootServices() called.
@param Event Pointer to this event
@param Context Event hanlder private data
**/
VOID
EFIAPI
OhcExitBootService (
EFI_EVENT Event,
VOID *Context
)
{
USB_OHCI_HC_DEV *Ohc;
EFI_USB_HC_PROTOCOL *UsbHc;
Ohc = (USB_OHCI_HC_DEV *) Context;
UsbHc = &Ohc->UsbHc;
//
// Stop the Host Controller
//
//OhciStopHc (Ohc, OHC_GENERIC_TIMEOUT);
OhciSetHcControl (Ohc, PERIODIC_ENABLE | CONTROL_ENABLE | ISOCHRONOUS_ENABLE | BULK_ENABLE, 0);
UsbHc->Reset (UsbHc, EFI_USB_HC_RESET_GLOBAL);
UsbHc->SetState (UsbHc, EfiUsbHcStateHalt);
return;
}
/**
Starting the Usb OHCI Driver.
@param This Protocol instance pointer.
@param Controller Handle of device to test.
@param RemainingDevicePath Not used.
@retval EFI_SUCCESS This driver supports this device.
@retval EFI_UNSUPPORTED This driver does not support this device.
@retval EFI_DEVICE_ERROR This driver cannot be started due to device Error.
EFI_OUT_OF_RESOURCES- Failed due to resource shortage.
**/
EFI_STATUS
EFIAPI
OHCIDriverBindingStart (
IN EFI_DRIVER_BINDING_PROTOCOL *This,
IN EFI_HANDLE Controller,
IN EFI_DEVICE_PATH_PROTOCOL *RemainingDevicePath
)
{
EFI_STATUS Status;
EFI_PCI_IO_PROTOCOL *PciIo;
USB_OHCI_HC_DEV *Ohc;
UINT64 Supports;
UINT64 OriginalPciAttributes;
BOOLEAN PciAttributesSaved;
UINTN OhciSegmentNumber;
UINTN OhciBusNumber;
UINTN OhciDeviceNumber;
UINTN OhciFunctionNumber;
UINTN NumberOfControllers;
UINTN Index;
//
// Open PCIIO, then enable the HC device and turn off emulation
//
Ohc = NULL;
Status = gBS->OpenProtocol (
Controller,
&gEfiPciIoProtocolGuid,
(VOID **) &PciIo,
This->DriverBindingHandle,
Controller,
EFI_OPEN_PROTOCOL_BY_DRIVER
);
if (EFI_ERROR(Status)) {
return Status;
}
PciAttributesSaved = FALSE;
//
// Save original PCI attributes
//
Status = PciIo->Attributes (
PciIo,
EfiPciIoAttributeOperationGet,
0,
&OriginalPciAttributes
);
if (EFI_ERROR(Status)) {
goto CLOSE_PCIIO;
}
PciAttributesSaved = TRUE;
//
// Robustnesss improvement such as for UoL
// Default is not required.
//
//if (FeaturePcdGet (PcdTurnOffUsbLegacySupport)) {
// OhciTurnOffUsbEmulation (PciIo);
//}
Status = PciIo->Attributes (
PciIo,
EfiPciIoAttributeOperationSupported,
0,
&Supports
);
if (!EFI_ERROR(Status)) {
Supports &= EFI_PCI_DEVICE_ENABLE;
Status = PciIo->Attributes (
PciIo,
EfiPciIoAttributeOperationEnable,
Supports,
NULL
);
}
if (EFI_ERROR(Status)) {
goto CLOSE_PCIIO;
}
//
//Allocate memory for OHC private data structure
//
Ohc = OhciAllocateDev(PciIo, OriginalPciAttributes);
if (Ohc == NULL){
Status = EFI_OUT_OF_RESOURCES;
goto CLOSE_PCIIO;
}
//Status = OhciInitializeInterruptList ( Uhc );
//if (EFI_ERROR(Status)) {
// goto FREE_OHC;
//}
//
// Set 0.1 s timer
//
Status = gBS->CreateEvent (
EVT_TIMER | EVT_NOTIFY_SIGNAL,
TPL_NOTIFY,
OhciHouseKeeper,
Ohc,
&Ohc->HouseKeeperTimer
);
if (EFI_ERROR(Status)) {
goto FREE_OHC;
}
// Polling at every 0.1s is too slow, use 0.05s like with UhciDxe
//Status = gBS->SetTimer (Ohc->HouseKeeperTimer, TimerPeriodic, 100 * 1000 * 10);
Status = gBS->SetTimer (Ohc->HouseKeeperTimer, TimerPeriodic, 50 * 1000 * 10);
if (EFI_ERROR(Status)) {
goto FREE_OHC;
}
//
// Before initialization on the ohci, for QuarkSCSocId, all the companion controllers
// should have bus master , memory space and io space bits enabled
//
NumberOfControllers = 4;
PciIo->GetLocation (
PciIo,
&OhciSegmentNumber,
&OhciBusNumber,
&OhciDeviceNumber,
&OhciFunctionNumber
);
for (Index = 0; Index < NumberOfControllers; Index++) {
PciOr16 (
PCI_LIB_ADDRESS (OhciBusNumber, OhciDeviceNumber, Index, PCI_COMMAND_OFFSET),
(EFI_PCI_COMMAND_IO_SPACE + EFI_PCI_COMMAND_MEMORY_SPACE + EFI_PCI_COMMAND_BUS_MASTER)
);
}
//
//Install Host Controller Protocol
//
Status = gBS->InstallProtocolInterface (
&Controller,
&gEfiUsbHcProtocolGuid,
EFI_NATIVE_INTERFACE,
&Ohc->UsbHc
);
if (EFI_ERROR(Status)) {
DEBUG ((EFI_D_INFO, "Install protocol error"));
goto FREE_OHC;
}
//
// Create event to stop the HC when exit boot service.
//
Status = gBS->CreateEventEx (
EVT_NOTIFY_SIGNAL,
TPL_NOTIFY,
OhcExitBootService,
Ohc,
&gEfiEventExitBootServicesGuid,
&Ohc->ExitBootServiceEvent
);
if (EFI_ERROR(Status)) {
DEBUG ((EFI_D_INFO, "Create exit boot event error"));
goto UNINSTALL_USBHC;
}
AddUnicodeString2 (
"eng",
gOhciComponentName.SupportedLanguages,
&Ohc->ControllerNameTable,
L"Usb Universal Host Controller",
TRUE
);
AddUnicodeString2 (
"en",
gOhciComponentName2.SupportedLanguages,
&Ohc->ControllerNameTable,
L"Usb Universal Host Controller",
FALSE
);
return EFI_SUCCESS;
UNINSTALL_USBHC:
gBS->UninstallMultipleProtocolInterfaces (
Controller,
&gEfiUsbHcProtocolGuid,
&Ohc->UsbHc,
NULL
);
FREE_OHC:
OhciFreeDev (Ohc);
CLOSE_PCIIO:
if (PciAttributesSaved) {
//
// Restore original PCI attributes
//
PciIo->Attributes (
PciIo,
EfiPciIoAttributeOperationSet,
OriginalPciAttributes,
NULL
);
}
gBS->CloseProtocol (
Controller,
&gEfiPciIoProtocolGuid,
This->DriverBindingHandle,
Controller
);
return Status;
}
/**
Stop this driver on ControllerHandle. Support stoping any child handles
created by this driver.
@param This Protocol instance pointer.
@param Controller Handle of device to stop driver on.
@param NumberOfChildren Number of Children in the ChildHandleBuffer.
@param ChildHandleBuffer List of handles for the children we need to stop.
@return EFI_SUCCESS
@return others
**/
EFI_STATUS
EFIAPI
OHCIDriverBindingStop (
IN EFI_DRIVER_BINDING_PROTOCOL *This,
IN EFI_HANDLE Controller,
IN UINTN NumberOfChildren,
IN EFI_HANDLE *ChildHandleBuffer
)
{
EFI_STATUS Status;
EFI_USB_HC_PROTOCOL *UsbHc;
Status = gBS->OpenProtocol (
Controller,
&gEfiUsbHcProtocolGuid,
(VOID **)&UsbHc,
This->DriverBindingHandle,
Controller,
EFI_OPEN_PROTOCOL_GET_PROTOCOL
);
if (EFI_ERROR(Status)) {
return Status;
}
OhciCleanDevUp(Controller, UsbHc);
gBS->CloseProtocol (
Controller,
&gEfiPciIoProtocolGuid,
This->DriverBindingHandle,
Controller
);
return EFI_SUCCESS;
}
Reference in New Issue View Git Blame Copy Permalink