tyler.durden
/
audk
mirror of https://github.com/acidanthera/audk.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

MdeModulePkg BaseSerialPortLib16550:Implement Get(Set)Control/SetAttributes 

Cc: Michael D Kinney <michael.d.kinney@intel.com>
Cc: Liming Gao <liming.gao@intel.com>
Cc: Feng Tian <feng.tian@intel.com>
Contributed-under: TianoCore Contribution Agreement 1.0
Signed-off-by: Star Zeng <star.zeng@intel.com>
Reviewed-by: Liming Gao <liming.gao@intel.com>
Reviewed-by: Michael D Kinney <michael.d.kinney@intel.com>

git-svn-id: https://svn.code.sf.net/p/edk2/code/trunk/edk2@18965 6f19259b-4bc3-4df7-8a09-765794883524
This commit is contained in:
Star Zeng 2015-11-26 08:47:44 +00:00 committed by lzeng14
parent d63a0df524
commit c0e6c39315
1 changed files with 337 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

337
MdeModulePkg/Library/BaseSerialPortLib16550/BaseSerialPortLib16550.c
View File

@ -40,6 +40,7 @@
#define R_UART_LCR 3 #define R_UART_LCR 3
#define B_UART_LCR_DLAB BIT7 #define B_UART_LCR_DLAB BIT7
#define R_UART_MCR 4 #define R_UART_MCR 4
#define B_UART_MCR_DTRC BIT0
#define B_UART_MCR_RTS BIT1 #define B_UART_MCR_RTS BIT1
#define R_UART_LSR 5 #define R_UART_LSR 5
#define B_UART_LSR_RXRDY BIT0 #define B_UART_LSR_RXRDY BIT0
@ -48,6 +49,8 @@
#define R_UART_MSR 6 #define R_UART_MSR 6
#define B_UART_MSR_CTS BIT4 #define B_UART_MSR_CTS BIT4
#define B_UART_MSR_DSR BIT5 #define B_UART_MSR_DSR BIT5
#define B_UART_MSR_RI BIT6
#define B_UART_MSR_DCD BIT7
// //
// 4-byte structure for each PCI node in PcdSerialPciDeviceInfo // 4-byte structure for each PCI node in PcdSerialPciDeviceInfo
@ -761,3 +764,337 @@ SerialPortPoll (
return FALSE; return FALSE;
} }
/**
Sets the control bits on a serial device.
@param Control Sets the bits of Control that are settable.
@retval RETURN_SUCCESS The new control bits were set on the serial device.
@retval RETURN_UNSUPPORTED The serial device does not support this operation.
@retval RETURN_DEVICE_ERROR The serial device is not functioning correctly.
**/
RETURN_STATUS
EFIAPI
SerialPortSetControl (
IN UINT32 Control
)
{
UINTN SerialRegisterBase;
UINT8 Mcr;
//
// First determine the parameter is invalid.
//
if ((Control & (~(EFI_SERIAL_REQUEST_TO_SEND | EFI_SERIAL_DATA_TERMINAL_READY |
EFI_SERIAL_HARDWARE_FLOW_CONTROL_ENABLE))) != 0) {
return RETURN_UNSUPPORTED;
}
SerialRegisterBase = GetSerialRegisterBase ();
if (SerialRegisterBase ==0) {
return RETURN_UNSUPPORTED;
}
//
// Read the Modem Control Register.
//
Mcr = SerialPortReadRegister (SerialRegisterBase, R_UART_MCR);
Mcr &= (~(B_UART_MCR_DTRC | B_UART_MCR_RTS));
if ((Control & EFI_SERIAL_DATA_TERMINAL_READY) == EFI_SERIAL_DATA_TERMINAL_READY) {
Mcr |= B_UART_MCR_DTRC;
}
if ((Control & EFI_SERIAL_REQUEST_TO_SEND) == EFI_SERIAL_REQUEST_TO_SEND) {
Mcr |= B_UART_MCR_RTS;
}
//
// Write the Modem Control Register.
//
SerialPortWriteRegister (SerialRegisterBase, R_UART_MCR, Mcr);
return RETURN_SUCCESS;
}
/**
Retrieve the status of the control bits on a serial device.
@param Control A pointer to return the current control signals from the serial device.
@retval RETURN_SUCCESS The control bits were read from the serial device.
@retval RETURN_UNSUPPORTED The serial device does not support this operation.
@retval RETURN_DEVICE_ERROR The serial device is not functioning correctly.
**/
RETURN_STATUS
EFIAPI
SerialPortGetControl (
OUT UINT32 *Control
)
{
UINTN SerialRegisterBase;
UINT8 Msr;
UINT8 Mcr;
UINT8 Lsr;
SerialRegisterBase = GetSerialRegisterBase ();
if (SerialRegisterBase ==0) {
return RETURN_UNSUPPORTED;
}
*Control = 0;
//
// Read the Modem Status Register.
//
Msr = SerialPortReadRegister (SerialRegisterBase, R_UART_MSR);
if ((Msr & B_UART_MSR_CTS) == B_UART_MSR_CTS) {
*Control |= EFI_SERIAL_CLEAR_TO_SEND;
}
if ((Msr & B_UART_MSR_DSR) == B_UART_MSR_DSR) {
*Control |= EFI_SERIAL_DATA_SET_READY;
}
if ((Msr & B_UART_MSR_RI) == B_UART_MSR_RI) {
*Control |= EFI_SERIAL_RING_INDICATE;
}
if ((Msr & B_UART_MSR_DCD) == B_UART_MSR_DCD) {
*Control |= EFI_SERIAL_CARRIER_DETECT;
}
//
// Read the Modem Control Register.
//
Mcr = SerialPortReadRegister (SerialRegisterBase, R_UART_MCR);
if ((Mcr & B_UART_MCR_DTRC) == B_UART_MCR_DTRC) {
*Control |= EFI_SERIAL_DATA_TERMINAL_READY;
}
if ((Mcr & B_UART_MCR_RTS) == B_UART_MCR_RTS) {
*Control |= EFI_SERIAL_REQUEST_TO_SEND;
}
if (PcdGetBool (PcdSerialUseHardwareFlowControl)) {
*Control |= EFI_SERIAL_HARDWARE_FLOW_CONTROL_ENABLE;
}
//
// Read the Line Status Register.
//
Lsr = SerialPortReadRegister (SerialRegisterBase, R_UART_LSR);
if ((Lsr & (B_UART_LSR_TEMT | B_UART_LSR_TXRDY)) == (B_UART_LSR_TEMT | B_UART_LSR_TXRDY)) {
*Control |= EFI_SERIAL_OUTPUT_BUFFER_EMPTY;
}
if ((Lsr & B_UART_LSR_RXRDY) == 0) {
*Control |= EFI_SERIAL_INPUT_BUFFER_EMPTY;
}
return RETURN_SUCCESS;
}
/**
Sets the baud rate, receive FIFO depth, transmit/receice time out, parity,
data bits, and stop bits on a serial device.
@param BaudRate The requested baud rate. A BaudRate value of 0 will use the
device's default interface speed.
On output, the value actually set.
@param ReveiveFifoDepth The requested depth of the FIFO on the receive side of the
serial interface. A ReceiveFifoDepth value of 0 will use
the device's default FIFO depth.
On output, the value actually set.
@param Timeout The requested time out for a single character in microseconds.
This timeout applies to both the transmit and receive side of the
interface. A Timeout value of 0 will use the device's default time
out value.
On output, the value actually set.
@param Parity The type of parity to use on this serial device. A Parity value of
DefaultParity will use the device's default parity value.
On output, the value actually set.
@param DataBits The number of data bits to use on the serial device. A DataBits
vaule of 0 will use the device's default data bit setting.
On output, the value actually set.
@param StopBits The number of stop bits to use on this serial device. A StopBits
value of DefaultStopBits will use the device's default number of
stop bits.
On output, the value actually set.
@retval RETURN_SUCCESS The new attributes were set on the serial device.
@retval RETURN_UNSUPPORTED The serial device does not support this operation.
@retval RETURN_INVALID_PARAMETER One or more of the attributes has an unsupported value.
@retval RETURN_DEVICE_ERROR The serial device is not functioning correctly.
**/
RETURN_STATUS
EFIAPI
SerialPortSetAttributes (
IN OUT UINT64 *BaudRate,
IN OUT UINT32 *ReceiveFifoDepth,
IN OUT UINT32 *Timeout,
IN OUT EFI_PARITY_TYPE *Parity,
IN OUT UINT8 *DataBits,
IN OUT EFI_STOP_BITS_TYPE *StopBits
)
{
UINTN SerialRegisterBase;
UINT32 SerialBaudRate;
UINTN Divisor;
UINT8 Lcr;
UINT8 LcrData;
UINT8 LcrParity;
UINT8 LcrStop;
SerialRegisterBase = GetSerialRegisterBase ();
if (SerialRegisterBase ==0) {
return RETURN_UNSUPPORTED;
}
//
// Check for default settings and fill in actual values.
//
if (*BaudRate == 0) {
*BaudRate = PcdGet32 (PcdSerialBaudRate);
}
SerialBaudRate = (UINT32) *BaudRate;
if (*DataBits == 0) {
LcrData = (UINT8) (PcdGet8 (PcdSerialLineControl) & 0x3);
*DataBits = LcrData + 5;
} else {
if ((*DataBits < 5) || (*DataBits > 8)) {
return RETURN_INVALID_PARAMETER;
}
//
// Map 5..8 to 0..3
//
LcrData = (UINT8) (*DataBits - (UINT8) 5);
}
if (*Parity == DefaultParity) {
LcrParity = (UINT8) ((PcdGet8 (PcdSerialLineControl) >> 3) & 0x7);
switch (LcrParity) {
case 0:
*Parity = NoParity;
break;
case 3:
*Parity = EvenParity;
break;
case 1:
*Parity = OddParity;
break;
case 7:
*Parity = SpaceParity;
break;
case 5:
*Parity = MarkParity;
break;
default:
break;
}
} else {
if ((*Parity < NoParity) || (*Parity > SpaceParity)) {
return RETURN_INVALID_PARAMETER;
}
switch (*Parity) {
case NoParity:
LcrParity = 0;
break;
case EvenParity:
LcrParity = 3;
break;
case OddParity:
LcrParity = 1;
break;
case SpaceParity:
LcrParity = 7;
break;
case MarkParity:
LcrParity = 5;
break;
default:
break;
}
}
if (*StopBits == DefaultStopBits) {
LcrStop = (UINT8) ((PcdGet8 (PcdSerialLineControl) >> 2) & 0x1);
switch (LcrStop) {
case 0:
*StopBits = OneStopBit;
break;
case 1:
if (*DataBits == 5) {
*StopBits = OneFiveStopBits;
} else {
*StopBits = TwoStopBits;
}
break;
default:
break;
}
} else {
if ((*StopBits < OneStopBit) || (*StopBits > TwoStopBits)) {
return RETURN_INVALID_PARAMETER;
}
switch (*StopBits) {
case OneStopBit:
LcrStop = 0;
break;
case OneFiveStopBits:
case TwoStopBits:
LcrStop = 1;
break;
default:
break;
}
}
//
// Calculate divisor for baud generator
// Ref_Clk_Rate / Baud_Rate / 16
//
Divisor = PcdGet32 (PcdSerialClockRate) / (SerialBaudRate * 16);
if ((PcdGet32 (PcdSerialClockRate) % (SerialBaudRate * 16)) >= SerialBaudRate * 8) {
Divisor++;
}
//
// Configure baud rate
//
SerialPortWriteRegister (SerialRegisterBase, R_UART_LCR, B_UART_LCR_DLAB);
SerialPortWriteRegister (SerialRegisterBase, R_UART_BAUD_HIGH, (UINT8) (Divisor >> 8));
SerialPortWriteRegister (SerialRegisterBase, R_UART_BAUD_LOW, (UINT8) (Divisor & 0xff));
//
// Clear DLAB and configure Data Bits, Parity, and Stop Bits.
// Strip reserved bits from line control value
//
Lcr = (UINT8) ((LcrParity << 3) | (LcrStop << 2) | LcrData);
SerialPortWriteRegister (SerialRegisterBase, R_UART_LCR, (UINT8) (Lcr & 0x3F));
return RETURN_SUCCESS;
}