2008-03-19 04:23:16 +01:00
|
|
|
/**@file
|
2007-06-27 09:00:49 +02:00
|
|
|
|
|
|
|
Copyright (c) 2006 - 2007, Intel Corporation
|
|
|
|
All rights reserved. This program and the accompanying materials
|
|
|
|
are licensed and made available under the terms and conditions of the BSD License
|
|
|
|
which accompanies this distribution. The full text of the license may be found at
|
|
|
|
http://opensource.org/licenses/bsd-license.php
|
|
|
|
|
|
|
|
THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
|
|
|
|
WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
|
|
|
|
|
|
|
|
Module Name:
|
|
|
|
|
|
|
|
WinNtSerialIo.c
|
|
|
|
|
|
|
|
Abstract:
|
|
|
|
|
|
|
|
Our DriverBinding member functions operate on the handles
|
|
|
|
created by the NT Bus driver.
|
|
|
|
|
|
|
|
Handle(1) - WinNtIo - DevicePath(1)
|
|
|
|
|
|
|
|
If a serial port is added to the system this driver creates a new handle.
|
|
|
|
The new handle is required, since the serial device must add an UART device
|
|
|
|
pathnode.
|
|
|
|
|
|
|
|
Handle(2) - SerialIo - DevicePath(1)\UART
|
|
|
|
|
|
|
|
The driver then adds a gEfiWinNtSerialPortGuid as a protocol to Handle(1).
|
|
|
|
The instance data for this protocol is the private data used to create
|
|
|
|
Handle(2).
|
|
|
|
|
|
|
|
Handle(1) - WinNtIo - DevicePath(1) - WinNtSerialPort
|
|
|
|
|
|
|
|
If the driver is unloaded Handle(2) is removed from the system and
|
|
|
|
gEfiWinNtSerialPortGuid is removed from Handle(1).
|
|
|
|
|
|
|
|
Note: Handle(1) is any handle created by the Win NT Bus driver that is passed
|
|
|
|
into the DriverBinding member functions of this driver. This driver requires
|
|
|
|
a Handle(1) to contain a WinNtIo protocol, a DevicePath protocol, and
|
|
|
|
the TypeGuid in the WinNtIo must be gEfiWinNtSerialPortGuid.
|
|
|
|
|
|
|
|
If Handle(1) contains a gEfiWinNtSerialPortGuid protocol then the driver is
|
|
|
|
loaded on the device.
|
|
|
|
|
2008-03-19 04:23:16 +01:00
|
|
|
**/
|
2007-06-27 09:00:49 +02:00
|
|
|
|
|
|
|
#include "WinNtSerialIo.h"
|
|
|
|
|
|
|
|
EFI_DRIVER_BINDING_PROTOCOL gWinNtSerialIoDriverBinding = {
|
|
|
|
WinNtSerialIoDriverBindingSupported,
|
|
|
|
WinNtSerialIoDriverBindingStart,
|
|
|
|
WinNtSerialIoDriverBindingStop,
|
|
|
|
0xa,
|
|
|
|
NULL,
|
|
|
|
NULL
|
|
|
|
};
|
|
|
|
|
2007-09-28 04:34:42 +02:00
|
|
|
//
|
|
|
|
// List of supported baud rate
|
|
|
|
//
|
|
|
|
UINT64 mBaudRateCurrentSupport[] = {50, 75, 110, 134, 150, 300, 600, 1200, 1800, 2000, 2400, 3600, 4800, 7200, 9600, 19200, 38400, 57600, 115200, SERIAL_PORT_MAX_BAUD_RATE + 1};
|
|
|
|
|
2007-06-27 09:00:49 +02:00
|
|
|
/**
|
|
|
|
The user Entry Point for module WinNtSerialIo. The user code starts with this function.
|
|
|
|
|
|
|
|
@param[in] ImageHandle The firmware allocated handle for the EFI image.
|
|
|
|
@param[in] SystemTable A pointer to the EFI System Table.
|
|
|
|
|
|
|
|
@retval EFI_SUCCESS The entry point is executed successfully.
|
|
|
|
@retval other Some error occurs when executing this entry point.
|
|
|
|
|
|
|
|
**/
|
|
|
|
EFI_STATUS
|
|
|
|
EFIAPI
|
|
|
|
InitializeWinNtSerialIo(
|
|
|
|
IN EFI_HANDLE ImageHandle,
|
|
|
|
IN EFI_SYSTEM_TABLE *SystemTable
|
|
|
|
)
|
|
|
|
{
|
|
|
|
EFI_STATUS Status;
|
|
|
|
|
|
|
|
//
|
|
|
|
// Install driver model protocol(s).
|
|
|
|
//
|
2007-09-29 13:25:42 +02:00
|
|
|
Status = EfiLibInstallDriverBindingComponentName2 (
|
2007-06-27 09:00:49 +02:00
|
|
|
ImageHandle,
|
|
|
|
SystemTable,
|
|
|
|
&gWinNtSerialIoDriverBinding,
|
|
|
|
ImageHandle,
|
|
|
|
&gWinNtSerialIoComponentName,
|
2007-09-29 13:25:42 +02:00
|
|
|
&gWinNtSerialIoComponentName2
|
2007-06-27 09:00:49 +02:00
|
|
|
);
|
|
|
|
ASSERT_EFI_ERROR (Status);
|
|
|
|
|
|
|
|
|
|
|
|
return Status;
|
|
|
|
}
|
|
|
|
|
|
|
|
STATIC
|
|
|
|
EFI_STATUS
|
|
|
|
EFIAPI
|
|
|
|
WinNtSerialIoDriverBindingSupported (
|
|
|
|
IN EFI_DRIVER_BINDING_PROTOCOL *This,
|
|
|
|
IN EFI_HANDLE Handle,
|
|
|
|
IN EFI_DEVICE_PATH_PROTOCOL *RemainingDevicePath
|
|
|
|
)
|
|
|
|
/*++
|
|
|
|
|
|
|
|
Routine Description:
|
|
|
|
|
|
|
|
Arguments:
|
|
|
|
|
|
|
|
Returns:
|
|
|
|
|
|
|
|
None
|
|
|
|
|
|
|
|
--*/
|
|
|
|
// TODO: This - add argument and description to function comment
|
|
|
|
// TODO: Handle - add argument and description to function comment
|
|
|
|
// TODO: RemainingDevicePath - add argument and description to function comment
|
|
|
|
// TODO: EFI_SUCCESS - add return value to function comment
|
|
|
|
// TODO: EFI_SUCCESS - add return value to function comment
|
|
|
|
{
|
|
|
|
EFI_STATUS Status;
|
|
|
|
EFI_DEVICE_PATH_PROTOCOL *ParentDevicePath;
|
|
|
|
EFI_WIN_NT_IO_PROTOCOL *WinNtIo;
|
|
|
|
UART_DEVICE_PATH *UartNode;
|
|
|
|
|
|
|
|
//
|
|
|
|
// Open the IO Abstraction(s) needed to perform the supported test
|
|
|
|
//
|
|
|
|
Status = gBS->OpenProtocol (
|
|
|
|
Handle,
|
|
|
|
&gEfiDevicePathProtocolGuid,
|
|
|
|
&ParentDevicePath,
|
|
|
|
This->DriverBindingHandle,
|
|
|
|
Handle,
|
|
|
|
EFI_OPEN_PROTOCOL_BY_DRIVER
|
|
|
|
);
|
|
|
|
if (Status == EFI_ALREADY_STARTED) {
|
|
|
|
return EFI_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (EFI_ERROR (Status)) {
|
|
|
|
return Status;
|
|
|
|
}
|
|
|
|
|
|
|
|
gBS->CloseProtocol (
|
|
|
|
Handle,
|
|
|
|
&gEfiDevicePathProtocolGuid,
|
|
|
|
This->DriverBindingHandle,
|
|
|
|
Handle
|
|
|
|
);
|
|
|
|
|
|
|
|
Status = gBS->OpenProtocol (
|
|
|
|
Handle,
|
|
|
|
&gEfiWinNtIoProtocolGuid,
|
|
|
|
&WinNtIo,
|
|
|
|
This->DriverBindingHandle,
|
|
|
|
Handle,
|
|
|
|
EFI_OPEN_PROTOCOL_BY_DRIVER
|
|
|
|
);
|
|
|
|
if (Status == EFI_ALREADY_STARTED) {
|
|
|
|
return EFI_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (EFI_ERROR (Status)) {
|
|
|
|
return Status;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Make sure that the WinNt Thunk Protocol is valid
|
|
|
|
//
|
|
|
|
if (WinNtIo->WinNtThunk->Signature != EFI_WIN_NT_THUNK_PROTOCOL_SIGNATURE) {
|
|
|
|
Status = EFI_UNSUPPORTED;
|
|
|
|
goto Error;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Check the GUID to see if this is a handle type the driver supports
|
|
|
|
//
|
|
|
|
if (!CompareGuid (WinNtIo->TypeGuid, &gEfiWinNtSerialPortGuid)) {
|
|
|
|
Status = EFI_UNSUPPORTED;
|
|
|
|
goto Error;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (RemainingDevicePath != NULL) {
|
|
|
|
Status = EFI_UNSUPPORTED;
|
|
|
|
UartNode = (UART_DEVICE_PATH *) RemainingDevicePath;
|
|
|
|
if (UartNode->Header.Type != MESSAGING_DEVICE_PATH ||
|
|
|
|
UartNode->Header.SubType != MSG_UART_DP ||
|
|
|
|
DevicePathNodeLength((EFI_DEVICE_PATH_PROTOCOL *)UartNode) != sizeof(UART_DEVICE_PATH)) {
|
|
|
|
goto Error;
|
|
|
|
}
|
|
|
|
if (UartNode->BaudRate < 0 || UartNode->BaudRate > SERIAL_PORT_MAX_BAUD_RATE) {
|
|
|
|
goto Error;
|
|
|
|
}
|
|
|
|
if (UartNode->Parity < NoParity || UartNode->Parity > SpaceParity) {
|
|
|
|
goto Error;
|
|
|
|
}
|
|
|
|
if (UartNode->DataBits < 5 || UartNode->DataBits > 8) {
|
|
|
|
goto Error;
|
|
|
|
}
|
|
|
|
if (UartNode->StopBits < OneStopBit || UartNode->StopBits > TwoStopBits) {
|
|
|
|
goto Error;
|
|
|
|
}
|
|
|
|
if ((UartNode->DataBits == 5) && (UartNode->StopBits == TwoStopBits)) {
|
|
|
|
goto Error;
|
|
|
|
}
|
|
|
|
if ((UartNode->DataBits >= 6) && (UartNode->DataBits <= 8) && (UartNode->StopBits == OneFiveStopBits)) {
|
|
|
|
goto Error;
|
|
|
|
}
|
|
|
|
Status = EFI_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
Error:
|
|
|
|
//
|
|
|
|
// Close the I/O Abstraction(s) used to perform the supported test
|
|
|
|
//
|
|
|
|
gBS->CloseProtocol (
|
|
|
|
Handle,
|
|
|
|
&gEfiWinNtIoProtocolGuid,
|
|
|
|
This->DriverBindingHandle,
|
|
|
|
Handle
|
|
|
|
);
|
|
|
|
|
|
|
|
return Status;
|
|
|
|
}
|
|
|
|
|
|
|
|
STATIC
|
|
|
|
EFI_STATUS
|
|
|
|
EFIAPI
|
|
|
|
WinNtSerialIoDriverBindingStart (
|
|
|
|
IN EFI_DRIVER_BINDING_PROTOCOL *This,
|
|
|
|
IN EFI_HANDLE Handle,
|
|
|
|
IN EFI_DEVICE_PATH_PROTOCOL *RemainingDevicePath
|
|
|
|
)
|
|
|
|
/*++
|
|
|
|
|
|
|
|
Routine Description:
|
|
|
|
|
|
|
|
Arguments:
|
|
|
|
|
|
|
|
Returns:
|
|
|
|
|
|
|
|
None
|
|
|
|
|
|
|
|
--*/
|
|
|
|
// TODO: This - add argument and description to function comment
|
|
|
|
// TODO: Handle - add argument and description to function comment
|
|
|
|
// TODO: RemainingDevicePath - add argument and description to function comment
|
|
|
|
// TODO: EFI_SUCCESS - add return value to function comment
|
|
|
|
// TODO: EFI_SUCCESS - add return value to function comment
|
|
|
|
{
|
|
|
|
EFI_STATUS Status;
|
|
|
|
EFI_WIN_NT_IO_PROTOCOL *WinNtIo;
|
|
|
|
WIN_NT_SERIAL_IO_PRIVATE_DATA *Private;
|
|
|
|
HANDLE NtHandle;
|
|
|
|
UART_DEVICE_PATH Node;
|
|
|
|
EFI_DEVICE_PATH_PROTOCOL *ParentDevicePath;
|
|
|
|
EFI_OPEN_PROTOCOL_INFORMATION_ENTRY *OpenInfoBuffer;
|
|
|
|
UINTN EntryCount;
|
|
|
|
UINTN Index;
|
|
|
|
EFI_SERIAL_IO_PROTOCOL *SerialIo;
|
|
|
|
|
|
|
|
Private = NULL;
|
|
|
|
NtHandle = INVALID_HANDLE_VALUE;
|
|
|
|
|
|
|
|
//
|
|
|
|
// Grab the protocols we need
|
|
|
|
//
|
|
|
|
Status = gBS->OpenProtocol (
|
|
|
|
Handle,
|
|
|
|
&gEfiDevicePathProtocolGuid,
|
|
|
|
&ParentDevicePath,
|
|
|
|
This->DriverBindingHandle,
|
|
|
|
Handle,
|
|
|
|
EFI_OPEN_PROTOCOL_BY_DRIVER
|
|
|
|
);
|
|
|
|
if (EFI_ERROR (Status) && Status != EFI_ALREADY_STARTED) {
|
|
|
|
return Status;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Grab the IO abstraction we need to get any work done
|
|
|
|
//
|
|
|
|
Status = gBS->OpenProtocol (
|
|
|
|
Handle,
|
|
|
|
&gEfiWinNtIoProtocolGuid,
|
|
|
|
&WinNtIo,
|
|
|
|
This->DriverBindingHandle,
|
|
|
|
Handle,
|
|
|
|
EFI_OPEN_PROTOCOL_BY_DRIVER
|
|
|
|
);
|
|
|
|
if (EFI_ERROR (Status) && Status != EFI_ALREADY_STARTED) {
|
|
|
|
gBS->CloseProtocol (
|
|
|
|
Handle,
|
|
|
|
&gEfiDevicePathProtocolGuid,
|
|
|
|
This->DriverBindingHandle,
|
|
|
|
Handle
|
|
|
|
);
|
|
|
|
return Status;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (Status == EFI_ALREADY_STARTED) {
|
|
|
|
|
|
|
|
if (RemainingDevicePath == NULL) {
|
|
|
|
return EFI_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Make sure a child handle does not already exist. This driver can only
|
|
|
|
// produce one child per serial port.
|
|
|
|
//
|
|
|
|
Status = gBS->OpenProtocolInformation (
|
|
|
|
Handle,
|
|
|
|
&gEfiWinNtIoProtocolGuid,
|
|
|
|
&OpenInfoBuffer,
|
|
|
|
&EntryCount
|
|
|
|
);
|
|
|
|
if (EFI_ERROR (Status)) {
|
|
|
|
return Status;
|
|
|
|
}
|
|
|
|
|
|
|
|
Status = EFI_ALREADY_STARTED;
|
|
|
|
for (Index = 0; Index < EntryCount; Index++) {
|
|
|
|
if (OpenInfoBuffer[Index].Attributes & EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER) {
|
|
|
|
Status = gBS->OpenProtocol (
|
|
|
|
OpenInfoBuffer[Index].ControllerHandle,
|
|
|
|
&gEfiSerialIoProtocolGuid,
|
|
|
|
&SerialIo,
|
|
|
|
This->DriverBindingHandle,
|
|
|
|
Handle,
|
|
|
|
EFI_OPEN_PROTOCOL_GET_PROTOCOL
|
|
|
|
);
|
|
|
|
if (!EFI_ERROR (Status)) {
|
|
|
|
CopyMem (&Node, RemainingDevicePath, sizeof (UART_DEVICE_PATH));
|
|
|
|
Status = SerialIo->SetAttributes (
|
|
|
|
SerialIo,
|
|
|
|
Node.BaudRate,
|
|
|
|
SerialIo->Mode->ReceiveFifoDepth,
|
|
|
|
SerialIo->Mode->Timeout,
|
|
|
|
Node.Parity,
|
|
|
|
Node.DataBits,
|
|
|
|
Node.StopBits
|
|
|
|
);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
FreePool (OpenInfoBuffer);
|
|
|
|
return Status;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Check to see if we can access the hardware device. If it's Open in NT we
|
|
|
|
// will not get access.
|
|
|
|
//
|
|
|
|
NtHandle = WinNtIo->WinNtThunk->CreateFile (
|
|
|
|
WinNtIo->EnvString,
|
|
|
|
GENERIC_READ | GENERIC_WRITE,
|
|
|
|
0,
|
|
|
|
NULL,
|
|
|
|
OPEN_EXISTING,
|
|
|
|
0,
|
|
|
|
NULL
|
|
|
|
);
|
|
|
|
if (NtHandle == INVALID_HANDLE_VALUE) {
|
|
|
|
Status = EFI_DEVICE_ERROR;
|
|
|
|
goto Error;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Construct Private data
|
|
|
|
//
|
|
|
|
Private = AllocatePool (sizeof (WIN_NT_SERIAL_IO_PRIVATE_DATA));
|
|
|
|
if (Private == NULL) {
|
|
|
|
goto Error;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// This signature must be valid before any member function is called
|
|
|
|
//
|
|
|
|
Private->Signature = WIN_NT_SERIAL_IO_PRIVATE_DATA_SIGNATURE;
|
|
|
|
Private->NtHandle = NtHandle;
|
|
|
|
Private->ControllerHandle = Handle;
|
|
|
|
Private->Handle = NULL;
|
|
|
|
Private->WinNtThunk = WinNtIo->WinNtThunk;
|
|
|
|
Private->ParentDevicePath = ParentDevicePath;
|
|
|
|
Private->ControllerNameTable = NULL;
|
|
|
|
|
|
|
|
Private->SoftwareLoopbackEnable = FALSE;
|
|
|
|
Private->HardwareLoopbackEnable = FALSE;
|
|
|
|
Private->HardwareFlowControl = FALSE;
|
|
|
|
Private->Fifo.First = 0;
|
|
|
|
Private->Fifo.Last = 0;
|
|
|
|
Private->Fifo.Surplus = SERIAL_MAX_BUFFER_SIZE;
|
|
|
|
|
2007-09-29 13:25:42 +02:00
|
|
|
AddUnicodeString2 (
|
2007-06-27 09:00:49 +02:00
|
|
|
"eng",
|
|
|
|
gWinNtSerialIoComponentName.SupportedLanguages,
|
|
|
|
&Private->ControllerNameTable,
|
2007-09-29 13:25:42 +02:00
|
|
|
WinNtIo->EnvString,
|
|
|
|
TRUE
|
2007-06-27 09:00:49 +02:00
|
|
|
);
|
2007-09-29 13:25:42 +02:00
|
|
|
AddUnicodeString2 (
|
|
|
|
"en",
|
|
|
|
gWinNtSerialIoComponentName2.SupportedLanguages,
|
|
|
|
&Private->ControllerNameTable,
|
|
|
|
WinNtIo->EnvString,
|
|
|
|
FALSE
|
|
|
|
);
|
|
|
|
|
2007-06-27 09:00:49 +02:00
|
|
|
|
|
|
|
Private->SerialIo.Revision = SERIAL_IO_INTERFACE_REVISION;
|
|
|
|
Private->SerialIo.Reset = WinNtSerialIoReset;
|
|
|
|
Private->SerialIo.SetAttributes = WinNtSerialIoSetAttributes;
|
|
|
|
Private->SerialIo.SetControl = WinNtSerialIoSetControl;
|
|
|
|
Private->SerialIo.GetControl = WinNtSerialIoGetControl;
|
|
|
|
Private->SerialIo.Write = WinNtSerialIoWrite;
|
|
|
|
Private->SerialIo.Read = WinNtSerialIoRead;
|
|
|
|
Private->SerialIo.Mode = &Private->SerialIoMode;
|
|
|
|
|
|
|
|
if (RemainingDevicePath != NULL) {
|
|
|
|
//
|
|
|
|
// Match the configuration of the RemainingDevicePath. IsHandleSupported()
|
|
|
|
// already checked to make sure the RemainingDevicePath contains settings
|
|
|
|
// that we can support.
|
|
|
|
//
|
|
|
|
CopyMem (&Private->UartDevicePath, RemainingDevicePath, sizeof (UART_DEVICE_PATH));
|
|
|
|
} else {
|
|
|
|
//
|
|
|
|
// Build the device path by appending the UART node to the ParentDevicePath
|
|
|
|
// from the WinNtIo handle. The Uart setings are zero here, since
|
|
|
|
// SetAttribute() will update them to match the default setings.
|
|
|
|
//
|
|
|
|
ZeroMem (&Private->UartDevicePath, sizeof (UART_DEVICE_PATH));
|
|
|
|
Private->UartDevicePath.Header.Type = MESSAGING_DEVICE_PATH;
|
|
|
|
Private->UartDevicePath.Header.SubType = MSG_UART_DP;
|
|
|
|
SetDevicePathNodeLength ((EFI_DEVICE_PATH_PROTOCOL *) &Private->UartDevicePath, sizeof (UART_DEVICE_PATH));
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Build the device path by appending the UART node to the ParentDevicePath
|
|
|
|
// from the WinNtIo handle. The Uart setings are zero here, since
|
|
|
|
// SetAttribute() will update them to match the current setings.
|
|
|
|
//
|
|
|
|
Private->DevicePath = AppendDevicePathNode (
|
|
|
|
ParentDevicePath,
|
|
|
|
(EFI_DEVICE_PATH_PROTOCOL *) &Private->UartDevicePath
|
|
|
|
);
|
|
|
|
if (Private->DevicePath == NULL) {
|
|
|
|
Status = EFI_OUT_OF_RESOURCES;
|
|
|
|
goto Error;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Fill in Serial I/O Mode structure based on either the RemainingDevicePath or defaults.
|
|
|
|
//
|
|
|
|
Private->SerialIoMode.ControlMask = SERIAL_CONTROL_MASK;
|
|
|
|
Private->SerialIoMode.Timeout = SERIAL_TIMEOUT_DEFAULT;
|
|
|
|
Private->SerialIoMode.BaudRate = Private->UartDevicePath.BaudRate;
|
|
|
|
Private->SerialIoMode.ReceiveFifoDepth = SERIAL_FIFO_DEFAULT;
|
|
|
|
Private->SerialIoMode.DataBits = Private->UartDevicePath.DataBits;
|
|
|
|
Private->SerialIoMode.Parity = Private->UartDevicePath.Parity;
|
|
|
|
Private->SerialIoMode.StopBits = Private->UartDevicePath.StopBits;
|
|
|
|
|
|
|
|
//
|
|
|
|
// Issue a reset to initialize the COM port
|
|
|
|
//
|
|
|
|
Status = Private->SerialIo.Reset (&Private->SerialIo);
|
|
|
|
if (EFI_ERROR (Status)) {
|
|
|
|
goto Error;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Create new child handle
|
|
|
|
//
|
|
|
|
Status = gBS->InstallMultipleProtocolInterfaces (
|
|
|
|
&Private->Handle,
|
|
|
|
&gEfiSerialIoProtocolGuid,
|
|
|
|
&Private->SerialIo,
|
|
|
|
&gEfiDevicePathProtocolGuid,
|
|
|
|
Private->DevicePath,
|
|
|
|
NULL
|
|
|
|
);
|
|
|
|
if (EFI_ERROR (Status)) {
|
|
|
|
goto Error;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Open For Child Device
|
|
|
|
//
|
|
|
|
Status = gBS->OpenProtocol (
|
|
|
|
Handle,
|
|
|
|
&gEfiWinNtIoProtocolGuid,
|
|
|
|
&WinNtIo,
|
|
|
|
This->DriverBindingHandle,
|
|
|
|
Private->Handle,
|
|
|
|
EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER
|
|
|
|
);
|
|
|
|
if (EFI_ERROR (Status)) {
|
|
|
|
goto Error;
|
|
|
|
}
|
|
|
|
|
|
|
|
return EFI_SUCCESS;
|
|
|
|
|
|
|
|
Error:
|
|
|
|
//
|
|
|
|
// Use the Stop() function to free all resources allocated in Start()
|
|
|
|
//
|
|
|
|
if (Private != NULL) {
|
|
|
|
if (Private->Handle != NULL) {
|
|
|
|
This->Stop (This, Handle, 1, &Private->Handle);
|
|
|
|
} else {
|
|
|
|
if (NtHandle != INVALID_HANDLE_VALUE) {
|
|
|
|
Private->WinNtThunk->CloseHandle (NtHandle);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (Private->DevicePath != NULL) {
|
|
|
|
FreePool (Private->DevicePath);
|
|
|
|
}
|
|
|
|
|
|
|
|
FreeUnicodeStringTable (Private->ControllerNameTable);
|
|
|
|
|
|
|
|
FreePool (Private);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
This->Stop (This, Handle, 0, NULL);
|
|
|
|
|
|
|
|
return Status;
|
|
|
|
}
|
|
|
|
|
|
|
|
STATIC
|
|
|
|
EFI_STATUS
|
|
|
|
EFIAPI
|
|
|
|
WinNtSerialIoDriverBindingStop (
|
|
|
|
IN EFI_DRIVER_BINDING_PROTOCOL *This,
|
|
|
|
IN EFI_HANDLE Handle,
|
|
|
|
IN UINTN NumberOfChildren,
|
|
|
|
IN EFI_HANDLE *ChildHandleBuffer
|
|
|
|
)
|
|
|
|
/*++
|
|
|
|
|
|
|
|
Routine Description:
|
|
|
|
|
|
|
|
TODO: Add function description
|
|
|
|
|
|
|
|
Arguments:
|
|
|
|
|
|
|
|
This - TODO: add argument description
|
|
|
|
Handle - TODO: add argument description
|
|
|
|
NumberOfChildren - TODO: add argument description
|
|
|
|
ChildHandleBuffer - TODO: add argument description
|
|
|
|
|
|
|
|
Returns:
|
|
|
|
|
|
|
|
EFI_DEVICE_ERROR - TODO: Add description for return value
|
|
|
|
EFI_SUCCESS - TODO: Add description for return value
|
|
|
|
|
|
|
|
--*/
|
|
|
|
{
|
|
|
|
EFI_STATUS Status;
|
|
|
|
UINTN Index;
|
|
|
|
BOOLEAN AllChildrenStopped;
|
|
|
|
EFI_SERIAL_IO_PROTOCOL *SerialIo;
|
|
|
|
WIN_NT_SERIAL_IO_PRIVATE_DATA *Private;
|
|
|
|
EFI_WIN_NT_IO_PROTOCOL *WinNtIo;
|
|
|
|
|
|
|
|
//
|
|
|
|
// Complete all outstanding transactions to Controller.
|
|
|
|
// Don't allow any new transaction to Controller to be started.
|
|
|
|
//
|
|
|
|
|
|
|
|
if (NumberOfChildren == 0) {
|
|
|
|
//
|
|
|
|
// Close the bus driver
|
|
|
|
//
|
|
|
|
Status = gBS->CloseProtocol (
|
|
|
|
Handle,
|
|
|
|
&gEfiWinNtIoProtocolGuid,
|
|
|
|
This->DriverBindingHandle,
|
|
|
|
Handle
|
|
|
|
);
|
|
|
|
Status = gBS->CloseProtocol (
|
|
|
|
Handle,
|
|
|
|
&gEfiDevicePathProtocolGuid,
|
|
|
|
This->DriverBindingHandle,
|
|
|
|
Handle
|
|
|
|
);
|
|
|
|
return Status;
|
|
|
|
}
|
|
|
|
|
|
|
|
AllChildrenStopped = TRUE;
|
|
|
|
|
|
|
|
for (Index = 0; Index < NumberOfChildren; Index++) {
|
|
|
|
Status = gBS->OpenProtocol (
|
|
|
|
ChildHandleBuffer[Index],
|
|
|
|
&gEfiSerialIoProtocolGuid,
|
|
|
|
&SerialIo,
|
|
|
|
This->DriverBindingHandle,
|
|
|
|
Handle,
|
|
|
|
EFI_OPEN_PROTOCOL_GET_PROTOCOL
|
|
|
|
);
|
|
|
|
if (!EFI_ERROR (Status)) {
|
|
|
|
Private = WIN_NT_SERIAL_IO_PRIVATE_DATA_FROM_THIS (SerialIo);
|
|
|
|
|
|
|
|
ASSERT (Private->Handle == ChildHandleBuffer[Index]);
|
|
|
|
|
|
|
|
Status = gBS->CloseProtocol (
|
|
|
|
Handle,
|
|
|
|
&gEfiWinNtIoProtocolGuid,
|
|
|
|
This->DriverBindingHandle,
|
|
|
|
ChildHandleBuffer[Index]
|
|
|
|
);
|
|
|
|
|
|
|
|
Status = gBS->UninstallMultipleProtocolInterfaces (
|
|
|
|
ChildHandleBuffer[Index],
|
|
|
|
&gEfiSerialIoProtocolGuid,
|
|
|
|
&Private->SerialIo,
|
|
|
|
&gEfiDevicePathProtocolGuid,
|
|
|
|
Private->DevicePath,
|
|
|
|
NULL
|
|
|
|
);
|
|
|
|
|
|
|
|
if (EFI_ERROR (Status)) {
|
|
|
|
gBS->OpenProtocol (
|
|
|
|
Handle,
|
|
|
|
&gEfiWinNtIoProtocolGuid,
|
|
|
|
(VOID **) &WinNtIo,
|
|
|
|
This->DriverBindingHandle,
|
|
|
|
ChildHandleBuffer[Index],
|
|
|
|
EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER
|
|
|
|
);
|
|
|
|
} else {
|
|
|
|
Private->WinNtThunk->CloseHandle (Private->NtHandle);
|
|
|
|
|
|
|
|
FreePool (Private->DevicePath);
|
|
|
|
|
|
|
|
FreeUnicodeStringTable (Private->ControllerNameTable);
|
|
|
|
|
|
|
|
FreePool (Private);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (EFI_ERROR (Status)) {
|
|
|
|
AllChildrenStopped = FALSE;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!AllChildrenStopped) {
|
|
|
|
return EFI_DEVICE_ERROR;
|
|
|
|
}
|
|
|
|
|
|
|
|
return EFI_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Serial IO Protocol member functions
|
|
|
|
//
|
|
|
|
|
|
|
|
STATIC
|
|
|
|
EFI_STATUS
|
|
|
|
EFIAPI
|
|
|
|
WinNtSerialIoReset (
|
|
|
|
IN EFI_SERIAL_IO_PROTOCOL *This
|
|
|
|
)
|
|
|
|
/*++
|
|
|
|
|
|
|
|
Routine Description:
|
|
|
|
|
|
|
|
TODO: Add function description
|
|
|
|
|
|
|
|
Arguments:
|
|
|
|
|
|
|
|
This - TODO: add argument description
|
|
|
|
|
|
|
|
Returns:
|
|
|
|
|
|
|
|
TODO: add return values
|
|
|
|
|
|
|
|
--*/
|
|
|
|
{
|
|
|
|
WIN_NT_SERIAL_IO_PRIVATE_DATA *Private;
|
|
|
|
EFI_TPL Tpl;
|
|
|
|
|
|
|
|
Tpl = gBS->RaiseTPL (TPL_NOTIFY);
|
|
|
|
|
|
|
|
Private = WIN_NT_SERIAL_IO_PRIVATE_DATA_FROM_THIS (This);
|
|
|
|
|
|
|
|
Private->WinNtThunk->PurgeComm (
|
|
|
|
Private->NtHandle,
|
|
|
|
PURGE_TXCLEAR | PURGE_RXCLEAR
|
|
|
|
);
|
|
|
|
|
|
|
|
gBS->RestoreTPL (Tpl);
|
|
|
|
|
|
|
|
return This->SetAttributes (
|
|
|
|
This,
|
|
|
|
This->Mode->BaudRate,
|
|
|
|
This->Mode->ReceiveFifoDepth,
|
|
|
|
This->Mode->Timeout,
|
|
|
|
This->Mode->Parity,
|
|
|
|
(UINT8) This->Mode->DataBits,
|
|
|
|
This->Mode->StopBits
|
|
|
|
);
|
|
|
|
}
|
|
|
|
|
|
|
|
STATIC
|
|
|
|
EFI_STATUS
|
|
|
|
EFIAPI
|
|
|
|
WinNtSerialIoSetAttributes (
|
|
|
|
IN EFI_SERIAL_IO_PROTOCOL *This,
|
|
|
|
IN UINT64 BaudRate,
|
|
|
|
IN UINT32 ReceiveFifoDepth,
|
|
|
|
IN UINT32 Timeout,
|
|
|
|
IN EFI_PARITY_TYPE Parity,
|
|
|
|
IN UINT8 DataBits,
|
|
|
|
IN EFI_STOP_BITS_TYPE StopBits
|
|
|
|
)
|
|
|
|
/*++
|
|
|
|
|
|
|
|
Routine Description:
|
|
|
|
|
|
|
|
This function is used to set the attributes.
|
|
|
|
|
|
|
|
Arguments:
|
|
|
|
|
|
|
|
This - A pointer to the EFI_SERIAL_IO_PROTOCOL structrue.
|
|
|
|
BaudRate - The Baud rate of the serial device.
|
|
|
|
ReceiveFifoDepth - The request depth of fifo on receive side.
|
|
|
|
Timeout - the request timeout for a single charact.
|
|
|
|
Parity - The type of parity used in serial device.
|
|
|
|
DataBits - Number of deata bits used in serial device.
|
|
|
|
StopBits - Number of stop bits used in serial device.
|
|
|
|
|
|
|
|
Returns:
|
|
|
|
Status code
|
|
|
|
|
|
|
|
None
|
|
|
|
|
|
|
|
--*/
|
|
|
|
// TODO: EFI_SUCCESS - add return value to function comment
|
|
|
|
// TODO: EFI_DEVICE_ERROR - add return value to function comment
|
|
|
|
// TODO: EFI_DEVICE_ERROR - add return value to function comment
|
|
|
|
// TODO: EFI_DEVICE_ERROR - add return value to function comment
|
|
|
|
// TODO: EFI_SUCCESS - add return value to function comment
|
|
|
|
// TODO: EFI_DEVICE_ERROR - add return value to function comment
|
|
|
|
// TODO: EFI_SUCCESS - add return value to function comment
|
|
|
|
{
|
|
|
|
EFI_STATUS Status;
|
2007-09-28 04:34:42 +02:00
|
|
|
UINTN Index;
|
2007-06-27 09:00:49 +02:00
|
|
|
WIN_NT_SERIAL_IO_PRIVATE_DATA *Private;
|
|
|
|
COMMTIMEOUTS PortTimeOuts;
|
|
|
|
DWORD ConvertedTime;
|
|
|
|
BOOL Result;
|
|
|
|
EFI_DEVICE_PATH_PROTOCOL *NewDevicePath;
|
|
|
|
EFI_TPL Tpl;
|
|
|
|
|
|
|
|
Private = WIN_NT_SERIAL_IO_PRIVATE_DATA_FROM_THIS (This);
|
|
|
|
|
|
|
|
//
|
|
|
|
// Some of our arguments have defaults if a null value is passed in, and
|
|
|
|
// we must set the default values if a null argument is passed in.
|
|
|
|
//
|
|
|
|
if (BaudRate == 0) {
|
2007-08-16 23:29:09 +02:00
|
|
|
BaudRate = FixedPcdGet64 (PcdUartDefaultBaudRate);
|
2007-06-27 09:00:49 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
if (ReceiveFifoDepth == 0) {
|
|
|
|
ReceiveFifoDepth = SERIAL_FIFO_DEFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (Timeout == 0) {
|
|
|
|
Timeout = SERIAL_TIMEOUT_DEFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (Parity == DefaultParity) {
|
2007-08-16 23:29:09 +02:00
|
|
|
Parity = FixedPcdGet8 (PcdUartDefaultParity);
|
2007-06-27 09:00:49 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
if (DataBits == 0) {
|
2007-08-16 23:29:09 +02:00
|
|
|
DataBits = FixedPcdGet8 (PcdUartDefaultDataBits);
|
2007-06-27 09:00:49 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
if (StopBits == DefaultStopBits) {
|
2007-08-16 23:29:09 +02:00
|
|
|
StopBits = (EFI_STOP_BITS_TYPE) FixedPcdGet8 (PcdUartDefaultStopBits);
|
2007-06-27 09:00:49 +02:00
|
|
|
}
|
2007-09-28 04:34:42 +02:00
|
|
|
|
|
|
|
//
|
|
|
|
// Make sure all parameters are valid
|
|
|
|
//
|
|
|
|
if ((BaudRate > SERIAL_PORT_MAX_BAUD_RATE) || (BaudRate < SERIAL_PORT_MIN_BAUD_RATE)) {
|
|
|
|
return EFI_INVALID_PARAMETER;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
//The lower baud rate supported by the serial device will be selected without exceeding the unsupported BaudRate parameter
|
|
|
|
//
|
|
|
|
|
|
|
|
for (Index = 1; Index < (sizeof (mBaudRateCurrentSupport) / sizeof (mBaudRateCurrentSupport[0])); Index++) {
|
|
|
|
if (BaudRate < mBaudRateCurrentSupport[Index]) {
|
|
|
|
BaudRate = mBaudRateCurrentSupport[Index-1];
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if ((ReceiveFifoDepth < 1) || (ReceiveFifoDepth > SERIAL_PORT_MAX_RECEIVE_FIFO_DEPTH)) {
|
|
|
|
return EFI_INVALID_PARAMETER;
|
|
|
|
}
|
|
|
|
|
|
|
|
if ((Timeout < SERIAL_PORT_MIN_TIMEOUT) || (Timeout > SERIAL_PORT_MAX_TIMEOUT)) {
|
|
|
|
return EFI_INVALID_PARAMETER;
|
|
|
|
}
|
|
|
|
|
|
|
|
if ((Parity < NoParity) || (Parity > SpaceParity)) {
|
|
|
|
return EFI_INVALID_PARAMETER;
|
|
|
|
}
|
|
|
|
|
|
|
|
if ((StopBits < OneStopBit) || (StopBits > TwoStopBits)) {
|
|
|
|
return EFI_INVALID_PARAMETER;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Now we only support DataBits=7,8.
|
|
|
|
//
|
|
|
|
if ((DataBits < 7) || (DataBits > 8)) {
|
|
|
|
return EFI_INVALID_PARAMETER;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Now we only support DataBits=7,8.
|
|
|
|
// for DataBits = 6,7,8, StopBits can not set OneFiveStopBits.
|
|
|
|
//
|
|
|
|
if (StopBits == OneFiveStopBits) {
|
|
|
|
return EFI_INVALID_PARAMETER;
|
|
|
|
}
|
|
|
|
|
2007-06-27 09:00:49 +02:00
|
|
|
//
|
|
|
|
// See if the new attributes already match the current attributes
|
|
|
|
//
|
|
|
|
if (Private->UartDevicePath.BaudRate == BaudRate &&
|
|
|
|
Private->UartDevicePath.DataBits == DataBits &&
|
|
|
|
Private->UartDevicePath.Parity == Parity &&
|
|
|
|
Private->UartDevicePath.StopBits == StopBits &&
|
|
|
|
Private->SerialIoMode.ReceiveFifoDepth == ReceiveFifoDepth &&
|
|
|
|
Private->SerialIoMode.Timeout == Timeout ) {
|
|
|
|
return EFI_SUCCESS;
|
|
|
|
}
|
|
|
|
|
2007-09-28 04:34:42 +02:00
|
|
|
Tpl = gBS->RaiseTPL (TPL_NOTIFY);
|
|
|
|
|
2007-06-27 09:00:49 +02:00
|
|
|
//
|
|
|
|
// Get current values from NT
|
|
|
|
//
|
|
|
|
ZeroMem (&Private->NtDCB, sizeof (DCB));
|
|
|
|
Private->NtDCB.DCBlength = sizeof (DCB);
|
|
|
|
|
|
|
|
if (!Private->WinNtThunk->GetCommState (Private->NtHandle, &Private->NtDCB)) {
|
|
|
|
Private->NtError = Private->WinNtThunk->GetLastError ();
|
|
|
|
DEBUG ((EFI_D_ERROR, "SerialSetAttributes: GetCommState %d\n", Private->NtError));
|
|
|
|
gBS->RestoreTPL (Tpl);
|
|
|
|
return EFI_DEVICE_ERROR;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Map EFI com setting to NT
|
|
|
|
//
|
|
|
|
Private->NtDCB.BaudRate = ConvertBaud2Nt (BaudRate);
|
|
|
|
Private->NtDCB.ByteSize = ConvertData2Nt (DataBits);
|
|
|
|
Private->NtDCB.Parity = ConvertParity2Nt (Parity);
|
|
|
|
Private->NtDCB.StopBits = ConvertStop2Nt (StopBits);
|
|
|
|
|
|
|
|
Private->NtDCB.fBinary = TRUE;
|
|
|
|
Private->NtDCB.fParity = Private->NtDCB.Parity == NOPARITY ? FALSE : TRUE;
|
|
|
|
Private->NtDCB.fOutxCtsFlow = FALSE;
|
|
|
|
Private->NtDCB.fOutxDsrFlow = FALSE;
|
|
|
|
Private->NtDCB.fDtrControl = DTR_CONTROL_ENABLE;
|
|
|
|
Private->NtDCB.fDsrSensitivity = FALSE;
|
|
|
|
Private->NtDCB.fOutX = FALSE;
|
|
|
|
Private->NtDCB.fInX = FALSE;
|
|
|
|
Private->NtDCB.fRtsControl = RTS_CONTROL_ENABLE;
|
|
|
|
Private->NtDCB.fNull = FALSE;
|
|
|
|
|
|
|
|
//
|
|
|
|
// Set new values
|
|
|
|
//
|
|
|
|
Result = Private->WinNtThunk->SetCommState (Private->NtHandle, &Private->NtDCB);
|
|
|
|
if (!Result) {
|
|
|
|
Private->NtError = Private->WinNtThunk->GetLastError ();
|
|
|
|
DEBUG ((EFI_D_ERROR, "SerialSetAttributes: SetCommState %d\n", Private->NtError));
|
|
|
|
gBS->RestoreTPL (Tpl);
|
|
|
|
return EFI_DEVICE_ERROR;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Set com port read/write timeout values
|
|
|
|
//
|
|
|
|
ConvertedTime = ConvertTime2Nt (Timeout);
|
|
|
|
PortTimeOuts.ReadIntervalTimeout = MAXDWORD;
|
|
|
|
PortTimeOuts.ReadTotalTimeoutMultiplier = 0;
|
|
|
|
PortTimeOuts.ReadTotalTimeoutConstant = ConvertedTime;
|
|
|
|
PortTimeOuts.WriteTotalTimeoutMultiplier = ConvertedTime == 0 ? 1 : ConvertedTime;
|
|
|
|
PortTimeOuts.WriteTotalTimeoutConstant = 0;
|
|
|
|
|
|
|
|
if (!Private->WinNtThunk->SetCommTimeouts (Private->NtHandle, &PortTimeOuts)) {
|
|
|
|
Private->NtError = Private->WinNtThunk->GetLastError ();
|
|
|
|
DEBUG ((EFI_D_ERROR, "SerialSetAttributes: SetCommTimeouts %d\n", Private->NtError));
|
|
|
|
gBS->RestoreTPL (Tpl);
|
|
|
|
return EFI_DEVICE_ERROR;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Update mode
|
|
|
|
//
|
|
|
|
Private->SerialIoMode.BaudRate = BaudRate;
|
|
|
|
Private->SerialIoMode.ReceiveFifoDepth = ReceiveFifoDepth;
|
|
|
|
Private->SerialIoMode.Timeout = Timeout;
|
|
|
|
Private->SerialIoMode.Parity = Parity;
|
|
|
|
Private->SerialIoMode.DataBits = DataBits;
|
|
|
|
Private->SerialIoMode.StopBits = StopBits;
|
|
|
|
|
|
|
|
//
|
|
|
|
// See if Device Path Node has actually changed
|
|
|
|
//
|
|
|
|
if (Private->UartDevicePath.BaudRate == BaudRate &&
|
|
|
|
Private->UartDevicePath.DataBits == DataBits &&
|
|
|
|
Private->UartDevicePath.Parity == Parity &&
|
|
|
|
Private->UartDevicePath.StopBits == StopBits ) {
|
|
|
|
gBS->RestoreTPL(Tpl);
|
|
|
|
return EFI_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Update the device path
|
|
|
|
//
|
|
|
|
Private->UartDevicePath.BaudRate = BaudRate;
|
|
|
|
Private->UartDevicePath.DataBits = DataBits;
|
|
|
|
Private->UartDevicePath.Parity = (UINT8) Parity;
|
|
|
|
Private->UartDevicePath.StopBits = (UINT8) StopBits;
|
|
|
|
|
|
|
|
NewDevicePath = AppendDevicePathNode (
|
|
|
|
Private->ParentDevicePath,
|
|
|
|
(EFI_DEVICE_PATH_PROTOCOL *) &Private->UartDevicePath
|
|
|
|
);
|
|
|
|
if (NewDevicePath == NULL) {
|
|
|
|
gBS->RestoreTPL (Tpl);
|
|
|
|
return EFI_DEVICE_ERROR;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (Private->Handle != NULL) {
|
|
|
|
Status = gBS->ReinstallProtocolInterface (
|
|
|
|
Private->Handle,
|
|
|
|
&gEfiDevicePathProtocolGuid,
|
|
|
|
Private->DevicePath,
|
|
|
|
NewDevicePath
|
|
|
|
);
|
|
|
|
if (EFI_ERROR (Status)) {
|
|
|
|
gBS->RestoreTPL (Tpl);
|
|
|
|
return Status;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (Private->DevicePath != NULL) {
|
|
|
|
FreePool (Private->DevicePath);
|
|
|
|
}
|
|
|
|
|
|
|
|
Private->DevicePath = NewDevicePath;
|
|
|
|
|
|
|
|
gBS->RestoreTPL (Tpl);
|
|
|
|
|
|
|
|
return EFI_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
STATIC
|
|
|
|
EFI_STATUS
|
|
|
|
EFIAPI
|
|
|
|
WinNtSerialIoSetControl (
|
|
|
|
IN EFI_SERIAL_IO_PROTOCOL *This,
|
|
|
|
IN UINT32 Control
|
|
|
|
)
|
|
|
|
/*++
|
|
|
|
|
|
|
|
Routine Description:
|
|
|
|
|
|
|
|
TODO: Add function description
|
|
|
|
|
|
|
|
Arguments:
|
|
|
|
|
|
|
|
This - TODO: add argument description
|
|
|
|
Control - TODO: add argument description
|
|
|
|
|
|
|
|
Returns:
|
|
|
|
|
|
|
|
EFI_DEVICE_ERROR - TODO: Add description for return value
|
|
|
|
EFI_DEVICE_ERROR - TODO: Add description for return value
|
|
|
|
EFI_SUCCESS - TODO: Add description for return value
|
|
|
|
|
|
|
|
--*/
|
|
|
|
{
|
|
|
|
WIN_NT_SERIAL_IO_PRIVATE_DATA *Private;
|
|
|
|
BOOL Result;
|
|
|
|
DCB Dcb;
|
|
|
|
EFI_TPL Tpl;
|
|
|
|
|
2007-09-28 04:34:42 +02:00
|
|
|
//
|
|
|
|
// first determine the parameter is invalid
|
|
|
|
//
|
|
|
|
if (Control & (~(EFI_SERIAL_REQUEST_TO_SEND | EFI_SERIAL_DATA_TERMINAL_READY |
|
|
|
|
EFI_SERIAL_HARDWARE_LOOPBACK_ENABLE | EFI_SERIAL_SOFTWARE_LOOPBACK_ENABLE |
|
|
|
|
EFI_SERIAL_HARDWARE_FLOW_CONTROL_ENABLE))) {
|
|
|
|
return EFI_UNSUPPORTED;
|
|
|
|
}
|
|
|
|
|
2007-06-27 09:00:49 +02:00
|
|
|
Tpl = gBS->RaiseTPL (TPL_NOTIFY);
|
|
|
|
|
|
|
|
Private = WIN_NT_SERIAL_IO_PRIVATE_DATA_FROM_THIS (This);
|
|
|
|
|
|
|
|
Result = Private->WinNtThunk->GetCommState (Private->NtHandle, &Dcb);
|
|
|
|
|
|
|
|
if (!Result) {
|
|
|
|
Private->NtError = Private->WinNtThunk->GetLastError ();
|
|
|
|
DEBUG ((EFI_D_ERROR, "SerialSetControl: GetCommState %d\n", Private->NtError));
|
|
|
|
gBS->RestoreTPL (Tpl);
|
|
|
|
return EFI_DEVICE_ERROR;
|
|
|
|
}
|
|
|
|
|
|
|
|
Dcb.fRtsControl = RTS_CONTROL_DISABLE;
|
|
|
|
Dcb.fDtrControl = DTR_CONTROL_DISABLE;
|
|
|
|
Private->HardwareFlowControl = FALSE;
|
|
|
|
Private->SoftwareLoopbackEnable = FALSE;
|
|
|
|
Private->HardwareLoopbackEnable = FALSE;
|
|
|
|
|
|
|
|
if (Control & EFI_SERIAL_REQUEST_TO_SEND) {
|
|
|
|
Dcb.fRtsControl = RTS_CONTROL_ENABLE;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (Control & EFI_SERIAL_DATA_TERMINAL_READY) {
|
|
|
|
Dcb.fDtrControl = DTR_CONTROL_ENABLE;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (Control & EFI_SERIAL_HARDWARE_FLOW_CONTROL_ENABLE) {
|
|
|
|
Private->HardwareFlowControl = TRUE;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (Control & EFI_SERIAL_SOFTWARE_LOOPBACK_ENABLE) {
|
|
|
|
Private->SoftwareLoopbackEnable = TRUE;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (Control & EFI_SERIAL_HARDWARE_LOOPBACK_ENABLE) {
|
|
|
|
Private->HardwareLoopbackEnable = TRUE;
|
|
|
|
}
|
|
|
|
|
|
|
|
Result = Private->WinNtThunk->SetCommState (
|
|
|
|
Private->NtHandle,
|
|
|
|
&Dcb
|
|
|
|
);
|
|
|
|
|
|
|
|
if (!Result) {
|
|
|
|
Private->NtError = Private->WinNtThunk->GetLastError ();
|
|
|
|
DEBUG ((EFI_D_ERROR, "SerialSetControl: SetCommState %d\n", Private->NtError));
|
|
|
|
gBS->RestoreTPL (Tpl);
|
|
|
|
return EFI_DEVICE_ERROR;
|
|
|
|
}
|
|
|
|
|
|
|
|
gBS->RestoreTPL (Tpl);
|
|
|
|
|
|
|
|
return EFI_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
STATIC
|
|
|
|
EFI_STATUS
|
|
|
|
EFIAPI
|
|
|
|
WinNtSerialIoGetControl (
|
|
|
|
IN EFI_SERIAL_IO_PROTOCOL *This,
|
|
|
|
OUT UINT32 *Control
|
|
|
|
)
|
|
|
|
/*++
|
|
|
|
|
|
|
|
Routine Description:
|
|
|
|
|
|
|
|
TODO: Add function description
|
|
|
|
|
|
|
|
Arguments:
|
|
|
|
|
|
|
|
This - TODO: add argument description
|
|
|
|
Control - TODO: add argument description
|
|
|
|
|
|
|
|
Returns:
|
|
|
|
|
|
|
|
EFI_DEVICE_ERROR - TODO: Add description for return value
|
|
|
|
EFI_DEVICE_ERROR - TODO: Add description for return value
|
|
|
|
EFI_DEVICE_ERROR - TODO: Add description for return value
|
|
|
|
EFI_SUCCESS - TODO: Add description for return value
|
|
|
|
|
|
|
|
--*/
|
|
|
|
{
|
|
|
|
WIN_NT_SERIAL_IO_PRIVATE_DATA *Private;
|
|
|
|
DWORD ModemStatus;
|
|
|
|
DWORD Errors;
|
|
|
|
UINT32 Bits;
|
|
|
|
DCB Dcb;
|
|
|
|
EFI_TPL Tpl;
|
|
|
|
|
|
|
|
Tpl = gBS->RaiseTPL (TPL_NOTIFY);
|
|
|
|
|
|
|
|
Private = WIN_NT_SERIAL_IO_PRIVATE_DATA_FROM_THIS (This);
|
|
|
|
|
|
|
|
//
|
|
|
|
// Get modem status
|
|
|
|
//
|
|
|
|
if (!Private->WinNtThunk->GetCommModemStatus (Private->NtHandle, &ModemStatus)) {
|
|
|
|
Private->NtError = Private->WinNtThunk->GetLastError ();
|
|
|
|
gBS->RestoreTPL (Tpl);
|
|
|
|
return EFI_DEVICE_ERROR;
|
|
|
|
}
|
|
|
|
|
|
|
|
Bits = 0;
|
|
|
|
if (ModemStatus & MS_CTS_ON) {
|
|
|
|
Bits |= EFI_SERIAL_CLEAR_TO_SEND;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (ModemStatus & MS_DSR_ON) {
|
|
|
|
Bits |= EFI_SERIAL_DATA_SET_READY;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (ModemStatus & MS_RING_ON) {
|
|
|
|
Bits |= EFI_SERIAL_RING_INDICATE;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (ModemStatus & MS_RLSD_ON) {
|
|
|
|
Bits |= EFI_SERIAL_CARRIER_DETECT;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Get ctrl status
|
|
|
|
//
|
|
|
|
if (!Private->WinNtThunk->GetCommState (Private->NtHandle, &Dcb)) {
|
|
|
|
Private->NtError = Private->WinNtThunk->GetLastError ();
|
|
|
|
DEBUG ((EFI_D_ERROR, "SerialGetControl: GetCommState %d\n", Private->NtError));
|
|
|
|
gBS->RestoreTPL (Tpl);
|
|
|
|
return EFI_DEVICE_ERROR;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (Dcb.fDtrControl == DTR_CONTROL_ENABLE) {
|
|
|
|
Bits |= EFI_SERIAL_DATA_TERMINAL_READY;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (Dcb.fRtsControl == RTS_CONTROL_ENABLE) {
|
|
|
|
Bits |= EFI_SERIAL_REQUEST_TO_SEND;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (Private->HardwareFlowControl) {
|
|
|
|
Bits |= EFI_SERIAL_HARDWARE_FLOW_CONTROL_ENABLE;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (Private->SoftwareLoopbackEnable) {
|
|
|
|
Bits |= EFI_SERIAL_SOFTWARE_LOOPBACK_ENABLE;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (Private->HardwareLoopbackEnable) {
|
|
|
|
Bits |= EFI_SERIAL_HARDWARE_LOOPBACK_ENABLE;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Get input buffer status
|
|
|
|
//
|
|
|
|
if (!Private->WinNtThunk->ClearCommError (Private->NtHandle, &Errors, &Private->NtComStatus)) {
|
|
|
|
Private->NtError = Private->WinNtThunk->GetLastError ();
|
|
|
|
DEBUG ((EFI_D_ERROR, "SerialGetControl: ClearCommError %d\n", Private->NtError));
|
|
|
|
gBS->RestoreTPL (Tpl);
|
|
|
|
return EFI_DEVICE_ERROR;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (Private->NtComStatus.cbInQue == 0) {
|
|
|
|
Bits |= EFI_SERIAL_INPUT_BUFFER_EMPTY;
|
|
|
|
}
|
|
|
|
|
|
|
|
*Control = Bits;
|
|
|
|
|
|
|
|
gBS->RestoreTPL (Tpl);
|
|
|
|
|
|
|
|
return EFI_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
STATIC
|
|
|
|
EFI_STATUS
|
|
|
|
EFIAPI
|
|
|
|
WinNtSerialIoWrite (
|
|
|
|
IN EFI_SERIAL_IO_PROTOCOL *This,
|
|
|
|
IN OUT UINTN *BufferSize,
|
|
|
|
IN VOID *Buffer
|
|
|
|
)
|
|
|
|
/*++
|
|
|
|
|
|
|
|
Routine Description:
|
|
|
|
|
|
|
|
TODO: Add function description
|
|
|
|
|
|
|
|
Arguments:
|
|
|
|
|
|
|
|
This - TODO: add argument description
|
|
|
|
BufferSize - TODO: add argument description
|
|
|
|
Buffer - TODO: add argument description
|
|
|
|
|
|
|
|
Returns:
|
|
|
|
|
|
|
|
EFI_DEVICE_ERROR - TODO: Add description for return value
|
|
|
|
EFI_SUCCESS - TODO: Add description for return value
|
|
|
|
|
|
|
|
--*/
|
|
|
|
{
|
|
|
|
WIN_NT_SERIAL_IO_PRIVATE_DATA *Private;
|
|
|
|
UINT8 *ByteBuffer;
|
|
|
|
UINTN TotalBytesWritten;
|
|
|
|
DWORD BytesToGo;
|
|
|
|
DWORD BytesWritten;
|
|
|
|
BOOL Result;
|
|
|
|
UINT32 Index;
|
|
|
|
UINT32 Control;
|
|
|
|
EFI_TPL Tpl;
|
|
|
|
|
|
|
|
Tpl = gBS->RaiseTPL (TPL_NOTIFY);
|
|
|
|
|
|
|
|
Private = WIN_NT_SERIAL_IO_PRIVATE_DATA_FROM_THIS (This);
|
|
|
|
|
|
|
|
ByteBuffer = (UINT8 *) Buffer;
|
|
|
|
TotalBytesWritten = 0;
|
|
|
|
|
|
|
|
if (Private->SoftwareLoopbackEnable || Private->HardwareLoopbackEnable) {
|
|
|
|
for (Index = 0; Index < *BufferSize; Index++) {
|
|
|
|
if (IsaSerialFifoAdd (&Private->Fifo, ByteBuffer[Index]) == EFI_SUCCESS) {
|
|
|
|
TotalBytesWritten++;
|
|
|
|
} else {
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
BytesToGo = (DWORD) (*BufferSize);
|
|
|
|
|
|
|
|
do {
|
|
|
|
if (Private->HardwareFlowControl) {
|
|
|
|
//
|
|
|
|
// Send RTS
|
|
|
|
//
|
|
|
|
WinNtSerialIoGetControl (&Private->SerialIo, &Control);
|
|
|
|
Control |= EFI_SERIAL_REQUEST_TO_SEND;
|
|
|
|
WinNtSerialIoSetControl (&Private->SerialIo, Control);
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// Do the write
|
|
|
|
//
|
|
|
|
Result = Private->WinNtThunk->WriteFile (
|
|
|
|
Private->NtHandle,
|
|
|
|
&ByteBuffer[TotalBytesWritten],
|
|
|
|
BytesToGo,
|
|
|
|
&BytesWritten,
|
|
|
|
NULL
|
|
|
|
);
|
|
|
|
|
|
|
|
if (Private->HardwareFlowControl) {
|
|
|
|
//
|
|
|
|
// Assert RTS
|
|
|
|
//
|
|
|
|
WinNtSerialIoGetControl (&Private->SerialIo, &Control);
|
|
|
|
Control &= ~ (UINT32) EFI_SERIAL_REQUEST_TO_SEND;
|
|
|
|
WinNtSerialIoSetControl (&Private->SerialIo, Control);
|
|
|
|
}
|
|
|
|
|
|
|
|
TotalBytesWritten += BytesWritten;
|
|
|
|
BytesToGo -= BytesWritten;
|
|
|
|
if (!Result) {
|
|
|
|
Private->NtError = Private->WinNtThunk->GetLastError ();
|
|
|
|
DEBUG ((EFI_D_ERROR, "SerialWrite: FileWrite %d\n", Private->NtError));
|
|
|
|
*BufferSize = TotalBytesWritten;
|
|
|
|
gBS->RestoreTPL (Tpl);
|
|
|
|
return EFI_DEVICE_ERROR;
|
|
|
|
}
|
|
|
|
} while (BytesToGo > 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
*BufferSize = TotalBytesWritten;
|
|
|
|
|
|
|
|
gBS->RestoreTPL (Tpl);
|
|
|
|
|
|
|
|
return EFI_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
STATIC
|
|
|
|
EFI_STATUS
|
|
|
|
EFIAPI
|
|
|
|
WinNtSerialIoRead (
|
|
|
|
IN EFI_SERIAL_IO_PROTOCOL *This,
|
|
|
|
IN OUT UINTN *BufferSize,
|
|
|
|
OUT VOID *Buffer
|
|
|
|
)
|
|
|
|
/*++
|
|
|
|
|
|
|
|
Routine Description:
|
|
|
|
|
|
|
|
TODO: Add function description
|
|
|
|
|
|
|
|
Arguments:
|
|
|
|
|
|
|
|
This - TODO: add argument description
|
|
|
|
BufferSize - TODO: add argument description
|
|
|
|
Buffer - TODO: add argument description
|
|
|
|
|
|
|
|
Returns:
|
|
|
|
|
|
|
|
EFI_DEVICE_ERROR - TODO: Add description for return value
|
|
|
|
|
|
|
|
--*/
|
|
|
|
{
|
|
|
|
WIN_NT_SERIAL_IO_PRIVATE_DATA *Private;
|
|
|
|
BOOL Result;
|
|
|
|
DWORD BytesRead;
|
|
|
|
EFI_STATUS Status;
|
|
|
|
UINT32 Index;
|
|
|
|
UINT8 Data;
|
|
|
|
UINT32 Control;
|
|
|
|
EFI_TPL Tpl;
|
|
|
|
|
|
|
|
Tpl = gBS->RaiseTPL (TPL_NOTIFY);
|
|
|
|
|
|
|
|
Private = WIN_NT_SERIAL_IO_PRIVATE_DATA_FROM_THIS (This);
|
|
|
|
|
|
|
|
//
|
|
|
|
// Do the read
|
|
|
|
//
|
|
|
|
if (Private->SoftwareLoopbackEnable || Private->HardwareLoopbackEnable) {
|
|
|
|
for (Index = 0, BytesRead = 0; Index < *BufferSize; Index++) {
|
|
|
|
if (IsaSerialFifoRemove (&Private->Fifo, &Data) == EFI_SUCCESS) {
|
|
|
|
((UINT8 *) Buffer)[Index] = Data;
|
|
|
|
BytesRead++;
|
|
|
|
} else {
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if (Private->HardwareFlowControl) {
|
|
|
|
WinNtSerialIoGetControl (&Private->SerialIo, &Control);
|
|
|
|
Control |= EFI_SERIAL_DATA_TERMINAL_READY;
|
|
|
|
WinNtSerialIoSetControl (&Private->SerialIo, Control);
|
|
|
|
}
|
|
|
|
|
|
|
|
Result = Private->WinNtThunk->ReadFile (
|
|
|
|
Private->NtHandle,
|
|
|
|
Buffer,
|
|
|
|
(DWORD) *BufferSize,
|
|
|
|
&BytesRead,
|
|
|
|
NULL
|
|
|
|
);
|
|
|
|
|
|
|
|
if (Private->HardwareFlowControl) {
|
|
|
|
WinNtSerialIoGetControl (&Private->SerialIo, &Control);
|
|
|
|
Control &= ~ (UINT32) EFI_SERIAL_DATA_TERMINAL_READY;
|
|
|
|
WinNtSerialIoSetControl (&Private->SerialIo, Control);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!Result) {
|
|
|
|
Private->NtError = Private->WinNtThunk->GetLastError ();
|
|
|
|
gBS->RestoreTPL (Tpl);
|
|
|
|
return EFI_DEVICE_ERROR;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (BytesRead != *BufferSize) {
|
|
|
|
Status = EFI_TIMEOUT;
|
|
|
|
} else {
|
|
|
|
Status = EFI_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
*BufferSize = (UINTN) BytesRead;
|
|
|
|
|
|
|
|
gBS->RestoreTPL (Tpl);
|
|
|
|
|
|
|
|
return Status;
|
|
|
|
}
|
|
|
|
|
|
|
|
BOOLEAN
|
|
|
|
IsaSerialFifoFull (
|
|
|
|
IN SERIAL_DEV_FIFO *Fifo
|
|
|
|
)
|
|
|
|
/*++
|
|
|
|
|
|
|
|
Routine Description:
|
|
|
|
Detect whether specific FIFO is full or not
|
|
|
|
|
|
|
|
Arguments:
|
|
|
|
Fifo SERIAL_DEV_FIFO *: A pointer to the Data Structure SERIAL_DEV_FIFO
|
|
|
|
|
|
|
|
Returns:
|
|
|
|
TRUE: the FIFO is full
|
|
|
|
FALSE: the FIFO is not full
|
|
|
|
|
|
|
|
--*/
|
|
|
|
{
|
|
|
|
if (Fifo->Surplus == 0) {
|
|
|
|
return TRUE;
|
|
|
|
}
|
|
|
|
|
|
|
|
return FALSE;
|
|
|
|
}
|
|
|
|
|
|
|
|
BOOLEAN
|
|
|
|
IsaSerialFifoEmpty (
|
|
|
|
IN SERIAL_DEV_FIFO *Fifo
|
|
|
|
)
|
|
|
|
/*++
|
|
|
|
|
|
|
|
Routine Description:
|
|
|
|
Detect whether specific FIFO is empty or not
|
|
|
|
|
|
|
|
Arguments:
|
|
|
|
Fifo SERIAL_DEV_FIFO *: A pointer to the Data Structure SERIAL_DEV_FIFO
|
|
|
|
|
|
|
|
Returns:
|
|
|
|
TRUE: the FIFO is empty
|
|
|
|
FALSE: the FIFO is not empty
|
|
|
|
|
|
|
|
--*/
|
|
|
|
{
|
|
|
|
if (Fifo->Surplus == SERIAL_MAX_BUFFER_SIZE) {
|
|
|
|
return TRUE;
|
|
|
|
}
|
|
|
|
|
|
|
|
return FALSE;
|
|
|
|
}
|
|
|
|
|
|
|
|
EFI_STATUS
|
|
|
|
IsaSerialFifoAdd (
|
|
|
|
IN SERIAL_DEV_FIFO *Fifo,
|
|
|
|
IN UINT8 Data
|
|
|
|
)
|
|
|
|
/*++
|
|
|
|
|
|
|
|
Routine Description:
|
|
|
|
Add data to specific FIFO
|
|
|
|
|
|
|
|
Arguments:
|
|
|
|
Fifo SERIAL_DEV_FIFO *: A pointer to the Data Structure SERIAL_DEV_FIFO
|
|
|
|
Data UINT8: the data added to FIFO
|
|
|
|
|
|
|
|
Returns:
|
|
|
|
EFI_SUCCESS: Add data to specific FIFO successfully
|
|
|
|
EFI_OUT_RESOURCE: Failed to add data because FIFO is already full
|
|
|
|
|
|
|
|
--*/
|
|
|
|
// TODO: EFI_OUT_OF_RESOURCES - add return value to function comment
|
|
|
|
{
|
|
|
|
//
|
|
|
|
// if FIFO full can not add data
|
|
|
|
//
|
|
|
|
if (IsaSerialFifoFull (Fifo)) {
|
|
|
|
return EFI_OUT_OF_RESOURCES;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// FIFO is not full can add data
|
|
|
|
//
|
|
|
|
Fifo->Data[Fifo->Last] = Data;
|
|
|
|
Fifo->Surplus--;
|
|
|
|
Fifo->Last++;
|
|
|
|
if (Fifo->Last >= SERIAL_MAX_BUFFER_SIZE) {
|
|
|
|
Fifo->Last = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
return EFI_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
EFI_STATUS
|
|
|
|
IsaSerialFifoRemove (
|
|
|
|
IN SERIAL_DEV_FIFO *Fifo,
|
|
|
|
OUT UINT8 *Data
|
|
|
|
)
|
|
|
|
/*++
|
|
|
|
|
|
|
|
Routine Description:
|
|
|
|
Remove data from specific FIFO
|
|
|
|
|
|
|
|
Arguments:
|
|
|
|
Fifo SERIAL_DEV_FIFO *: A pointer to the Data Structure SERIAL_DEV_FIFO
|
|
|
|
Data UINT8*: the data removed from FIFO
|
|
|
|
|
|
|
|
Returns:
|
|
|
|
EFI_SUCCESS: Remove data from specific FIFO successfully
|
|
|
|
EFI_OUT_RESOURCE: Failed to remove data because FIFO is empty
|
|
|
|
|
|
|
|
--*/
|
|
|
|
// TODO: EFI_OUT_OF_RESOURCES - add return value to function comment
|
|
|
|
{
|
|
|
|
//
|
|
|
|
// if FIFO is empty, no data can remove
|
|
|
|
//
|
|
|
|
if (IsaSerialFifoEmpty (Fifo)) {
|
|
|
|
return EFI_OUT_OF_RESOURCES;
|
|
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
// FIFO is not empty, can remove data
|
|
|
|
//
|
|
|
|
*Data = Fifo->Data[Fifo->First];
|
|
|
|
Fifo->Surplus++;
|
|
|
|
Fifo->First++;
|
|
|
|
if (Fifo->First >= SERIAL_MAX_BUFFER_SIZE) {
|
|
|
|
Fifo->First = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
return EFI_SUCCESS;
|
|
|
|
}
|