diff --git a/QuarkPlatformPkg/Library/PlatformHelperLib/PlatformHelperDxe.c b/QuarkPlatformPkg/Library/PlatformHelperLib/PlatformHelperDxe.c index 9cfbc0716c..18dbd8b89e 100644 --- a/QuarkPlatformPkg/Library/PlatformHelperLib/PlatformHelperDxe.c +++ b/QuarkPlatformPkg/Library/PlatformHelperLib/PlatformHelperDxe.c @@ -1,7 +1,7 @@ /** @file Implementation of helper routines for DXE environment. -Copyright (c) 2013 Intel Corporation. +Copyright (c) 2013 - 2016 Intel Corporation. This program and the accompanying materials are licensed and made available under the terms and conditions of the BSD License @@ -19,7 +19,6 @@ WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. #include #include #include -#include #include #include #include @@ -48,135 +47,6 @@ EFI_SPI_PROTOCOL *mPlatHelpSpiProtocolRef = NULL; // Routines shared with other souce modules in this component. // -BOOLEAN -Pcal9555GetPortRegBit ( - IN CONST UINT32 Pcal9555SlaveAddr, - IN CONST UINT32 GpioNum, - IN CONST UINT8 RegBase - ) -{ - EFI_STATUS Status; - UINTN ReadLength; - UINTN WriteLength; - UINT8 Data[2]; - EFI_I2C_DEVICE_ADDRESS I2cDeviceAddr; - EFI_I2C_ADDR_MODE I2cAddrMode; - UINT8 *RegValuePtr; - UINT8 GpioNumMask; - UINT8 SubAddr; - - I2cDeviceAddr.I2CDeviceAddress = (UINTN) Pcal9555SlaveAddr; - I2cAddrMode = EfiI2CSevenBitAddrMode; - - if (GpioNum < 8) { - SubAddr = RegBase; - GpioNumMask = (UINT8) (1 << GpioNum); - } else { - SubAddr = RegBase + 1; - GpioNumMask = (UINT8) (1 << (GpioNum - 8)); - } - - // - // Output port value always at 2nd byte in Data variable. - // - RegValuePtr = &Data[1]; - - // - // On read entry sub address at 2nd byte, on read exit output - // port value in 2nd byte. - // - Data[1] = SubAddr; - WriteLength = 1; - ReadLength = 1; - Status = I2cReadMultipleByte ( - I2cDeviceAddr, - I2cAddrMode, - &WriteLength, - &ReadLength, - &Data[1] - ); - ASSERT_EFI_ERROR (Status); - - // - // Adjust output port bit given callers request. - // - return ((*RegValuePtr & GpioNumMask) != 0); -} - -VOID -Pcal9555SetPortRegBit ( - IN CONST UINT32 Pcal9555SlaveAddr, - IN CONST UINT32 GpioNum, - IN CONST UINT8 RegBase, - IN CONST BOOLEAN LogicOne - ) -{ - EFI_STATUS Status; - UINTN ReadLength; - UINTN WriteLength; - UINT8 Data[2]; - EFI_I2C_DEVICE_ADDRESS I2cDeviceAddr; - EFI_I2C_ADDR_MODE I2cAddrMode; - UINT8 *RegValuePtr; - UINT8 GpioNumMask; - UINT8 SubAddr; - - I2cDeviceAddr.I2CDeviceAddress = (UINTN) Pcal9555SlaveAddr; - I2cAddrMode = EfiI2CSevenBitAddrMode; - - if (GpioNum < 8) { - SubAddr = RegBase; - GpioNumMask = (UINT8) (1 << GpioNum); - } else { - SubAddr = RegBase + 1; - GpioNumMask = (UINT8) (1 << (GpioNum - 8)); - } - - // - // Output port value always at 2nd byte in Data variable. - // - RegValuePtr = &Data[1]; - - // - // On read entry sub address at 2nd byte, on read exit output - // port value in 2nd byte. - // - Data[1] = SubAddr; - WriteLength = 1; - ReadLength = 1; - Status = I2cReadMultipleByte ( - I2cDeviceAddr, - I2cAddrMode, - &WriteLength, - &ReadLength, - &Data[1] - ); - ASSERT_EFI_ERROR (Status); - - // - // Adjust output port bit given callers request. - // - if (LogicOne) { - *RegValuePtr = *RegValuePtr | GpioNumMask; - } else { - *RegValuePtr = *RegValuePtr & ~(GpioNumMask); - } - - // - // Update register. Sub address at 1st byte, value at 2nd byte. - // - WriteLength = 2; - Data[0] = SubAddr; - Status = I2cWriteMultipleByte ( - I2cDeviceAddr, - I2cAddrMode, - &WriteLength, - Data - ); - ASSERT_EFI_ERROR (Status); -} - - EFI_SPI_PROTOCOL * LocateSpiProtocol ( IN EFI_SMM_SYSTEM_TABLE2 *Smst @@ -612,121 +482,3 @@ PlatformIsBootWithRecoveryStage1 ( return FALSE; } -/** - Set the direction of Pcal9555 IO Expander GPIO pin. - - @param Pcal9555SlaveAddr I2c Slave address of Pcal9555 Io Expander. - @param GpioNum Gpio direction to configure - values 0-7 for Port0 - and 8-15 for Port1. - @param CfgAsInput If TRUE set pin direction as input else set as output. - -**/ -VOID -EFIAPI -PlatformPcal9555GpioSetDir ( - IN CONST UINT32 Pcal9555SlaveAddr, - IN CONST UINT32 GpioNum, - IN CONST BOOLEAN CfgAsInput - ) -{ - Pcal9555SetPortRegBit ( - Pcal9555SlaveAddr, - GpioNum, - PCAL9555_REG_CFG_PORT0, - CfgAsInput - ); -} - -/** - Set the level of Pcal9555 IO Expander GPIO high or low. - - @param Pcal9555SlaveAddr I2c Slave address of Pcal9555 Io Expander. - @param GpioNum Gpio to change values 0-7 for Port0 and 8-15 - for Port1. - @param HighLevel If TRUE set pin high else set pin low. - -**/ -VOID -EFIAPI -PlatformPcal9555GpioSetLevel ( - IN CONST UINT32 Pcal9555SlaveAddr, - IN CONST UINT32 GpioNum, - IN CONST BOOLEAN HighLevel - ) -{ - Pcal9555SetPortRegBit ( - Pcal9555SlaveAddr, - GpioNum, - PCAL9555_REG_OUT_PORT0, - HighLevel - ); -} - -/** - - Enable pull-up/pull-down resistors of Pcal9555 GPIOs. - - @param Pcal9555SlaveAddr I2c Slave address of Pcal9555 Io Expander. - @param GpioNum Gpio to change values 0-7 for Port0 and 8-15 - for Port1. - -**/ -VOID -EFIAPI -PlatformPcal9555GpioEnablePull ( - IN CONST UINT32 Pcal9555SlaveAddr, - IN CONST UINT32 GpioNum - ) -{ - Pcal9555SetPortRegBit ( - Pcal9555SlaveAddr, - GpioNum, - PCAL9555_REG_PULL_EN_PORT0, - TRUE - ); -} - -/** - - Disable pull-up/pull-down resistors of Pcal9555 GPIOs. - - @param Pcal9555SlaveAddr I2c Slave address of Pcal9555 Io Expander. - @param GpioNum Gpio to change values 0-7 for Port0 and 8-15 - for Port1. - -**/ -VOID -EFIAPI -PlatformPcal9555GpioDisablePull ( - IN CONST UINT32 Pcal9555SlaveAddr, - IN CONST UINT32 GpioNum - ) -{ - Pcal9555SetPortRegBit ( - Pcal9555SlaveAddr, - GpioNum, - PCAL9555_REG_PULL_EN_PORT0, - FALSE - ); -} - -/** - - Get state of Pcal9555 GPIOs. - - @param Pcal9555SlaveAddr I2c Slave address of Pcal9555 Io Expander. - @param GpioNum Gpio to change values 0-7 for Port0 and 8-15 - for Port1. - - @retval TRUE GPIO pin is high - @retval FALSE GPIO pin is low -**/ -BOOLEAN -EFIAPI -PlatformPcal9555GpioGetState ( - IN CONST UINT32 Pcal9555SlaveAddr, - IN CONST UINT32 GpioNum - ) -{ - return Pcal9555GetPortRegBit (Pcal9555SlaveAddr, GpioNum, PCAL9555_REG_IN_PORT0); -} diff --git a/QuarkPlatformPkg/Library/PlatformHelperLib/PlatformHelperLib.c b/QuarkPlatformPkg/Library/PlatformHelperLib/PlatformHelperLib.c index 6aefdb3794..f9ceda4aaf 100644 --- a/QuarkPlatformPkg/Library/PlatformHelperLib/PlatformHelperLib.c +++ b/QuarkPlatformPkg/Library/PlatformHelperLib/PlatformHelperLib.c @@ -1,7 +1,7 @@ /** @file Helper routines with common PEI / DXE implementation. -Copyright (c) 2013-2015 Intel Corporation. +Copyright (c) 2013-2016 Intel Corporation. This program and the accompanying materials are licensed and made available under the terms and conditions of the BSD License @@ -14,6 +14,7 @@ WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. **/ #include "CommonHeader.h" +#include CHAR16 *mPlatTypeNameTable[] = { EFI_PLATFORM_TYPE_NAME_TABLE_DEFINITION }; UINTN mPlatTypeNameTableLen = ((sizeof(mPlatTypeNameTable)) / sizeof (CHAR16 *)); @@ -261,3 +262,253 @@ PlatformLegacyGpioGetLevel ( GpioNumMask = (1 << GpioNum); return ((RegValue & GpioNumMask) != 0); } + + +BOOLEAN +Pcal9555GetPortRegBit ( + IN CONST UINT32 Pcal9555SlaveAddr, + IN CONST UINT32 GpioNum, + IN CONST UINT8 RegBase + ) +{ + EFI_STATUS Status; + UINTN ReadLength; + UINTN WriteLength; + UINT8 Data[2]; + EFI_I2C_DEVICE_ADDRESS I2cDeviceAddr; + EFI_I2C_ADDR_MODE I2cAddrMode; + UINT8 *RegValuePtr; + UINT8 GpioNumMask; + UINT8 SubAddr; + + I2cDeviceAddr.I2CDeviceAddress = (UINTN)Pcal9555SlaveAddr; + I2cAddrMode = EfiI2CSevenBitAddrMode; + + if (GpioNum < 8) { + SubAddr = RegBase; + GpioNumMask = (UINT8)(1 << GpioNum); + } else { + SubAddr = RegBase + 1; + GpioNumMask = (UINT8)(1 << (GpioNum - 8)); + } + + // + // Output port value always at 2nd byte in Data variable. + // + RegValuePtr = &Data[1]; + + // + // On read entry sub address at 2nd byte, on read exit output + // port value in 2nd byte. + // + Data[1] = SubAddr; + WriteLength = 1; + ReadLength = 1; + Status = I2cReadMultipleByte ( + I2cDeviceAddr, + I2cAddrMode, + &WriteLength, + &ReadLength, + &Data[1] + ); + ASSERT_EFI_ERROR (Status); + + // + // Adjust output port bit given callers request. + // + return ((*RegValuePtr & GpioNumMask) != 0); +} + +VOID +Pcal9555SetPortRegBit ( + IN CONST UINT32 Pcal9555SlaveAddr, + IN CONST UINT32 GpioNum, + IN CONST UINT8 RegBase, + IN CONST BOOLEAN LogicOne + ) +{ + EFI_STATUS Status; + UINTN ReadLength; + UINTN WriteLength; + UINT8 Data[2]; + EFI_I2C_DEVICE_ADDRESS I2cDeviceAddr; + EFI_I2C_ADDR_MODE I2cAddrMode; + UINT8 *RegValuePtr; + UINT8 GpioNumMask; + UINT8 SubAddr; + + I2cDeviceAddr.I2CDeviceAddress = (UINTN)Pcal9555SlaveAddr; + I2cAddrMode = EfiI2CSevenBitAddrMode; + + if (GpioNum < 8) { + SubAddr = RegBase; + GpioNumMask = (UINT8)(1 << GpioNum); + } else { + SubAddr = RegBase + 1; + GpioNumMask = (UINT8)(1 << (GpioNum - 8)); + } + + // + // Output port value always at 2nd byte in Data variable. + // + RegValuePtr = &Data[1]; + + // + // On read entry sub address at 2nd byte, on read exit output + // port value in 2nd byte. + // + Data[1] = SubAddr; + WriteLength = 1; + ReadLength = 1; + Status = I2cReadMultipleByte ( + I2cDeviceAddr, + I2cAddrMode, + &WriteLength, + &ReadLength, + &Data[1] + ); + ASSERT_EFI_ERROR (Status); + + // + // Adjust output port bit given callers request. + // + if (LogicOne) { + *RegValuePtr = *RegValuePtr | GpioNumMask; + } else { + *RegValuePtr = *RegValuePtr & ~(GpioNumMask); + } + + // + // Update register. Sub address at 1st byte, value at 2nd byte. + // + WriteLength = 2; + Data[0] = SubAddr; + Status = I2cWriteMultipleByte ( + I2cDeviceAddr, + I2cAddrMode, + &WriteLength, + Data + ); + ASSERT_EFI_ERROR (Status); +} + +/** +Set the direction of Pcal9555 IO Expander GPIO pin. + +@param Pcal9555SlaveAddr I2c Slave address of Pcal9555 Io Expander. +@param GpioNum Gpio direction to configure - values 0-7 for Port0 +and 8-15 for Port1. +@param CfgAsInput If TRUE set pin direction as input else set as output. + +**/ +VOID +EFIAPI +PlatformPcal9555GpioSetDir ( + IN CONST UINT32 Pcal9555SlaveAddr, + IN CONST UINT32 GpioNum, + IN CONST BOOLEAN CfgAsInput + ) +{ + Pcal9555SetPortRegBit ( + Pcal9555SlaveAddr, + GpioNum, + PCAL9555_REG_CFG_PORT0, + CfgAsInput + ); +} + +/** +Set the level of Pcal9555 IO Expander GPIO high or low. + +@param Pcal9555SlaveAddr I2c Slave address of Pcal9555 Io Expander. +@param GpioNum Gpio to change values 0-7 for Port0 and 8-15 +for Port1. +@param HighLevel If TRUE set pin high else set pin low. + +**/ +VOID +EFIAPI +PlatformPcal9555GpioSetLevel ( + IN CONST UINT32 Pcal9555SlaveAddr, + IN CONST UINT32 GpioNum, + IN CONST BOOLEAN HighLevel + ) +{ + Pcal9555SetPortRegBit ( + Pcal9555SlaveAddr, + GpioNum, + PCAL9555_REG_OUT_PORT0, + HighLevel + ); +} + +/** + +Enable pull-up/pull-down resistors of Pcal9555 GPIOs. + +@param Pcal9555SlaveAddr I2c Slave address of Pcal9555 Io Expander. +@param GpioNum Gpio to change values 0-7 for Port0 and 8-15 +for Port1. + +**/ +VOID +EFIAPI +PlatformPcal9555GpioEnablePull ( + IN CONST UINT32 Pcal9555SlaveAddr, + IN CONST UINT32 GpioNum + ) +{ + Pcal9555SetPortRegBit ( + Pcal9555SlaveAddr, + GpioNum, + PCAL9555_REG_PULL_EN_PORT0, + TRUE + ); +} + +/** + +Disable pull-up/pull-down resistors of Pcal9555 GPIOs. + +@param Pcal9555SlaveAddr I2c Slave address of Pcal9555 Io Expander. +@param GpioNum Gpio to change values 0-7 for Port0 and 8-15 +for Port1. + +**/ +VOID +EFIAPI +PlatformPcal9555GpioDisablePull ( + IN CONST UINT32 Pcal9555SlaveAddr, + IN CONST UINT32 GpioNum + ) +{ + Pcal9555SetPortRegBit ( + Pcal9555SlaveAddr, + GpioNum, + PCAL9555_REG_PULL_EN_PORT0, + FALSE + ); +} + +/** + +Get state of Pcal9555 GPIOs. + +@param Pcal9555SlaveAddr I2c Slave address of Pcal9555 Io Expander. +@param GpioNum Gpio to change values 0-7 for Port0 and 8-15 +for Port1. + +@retval TRUE GPIO pin is high +@retval FALSE GPIO pin is low +**/ +BOOLEAN +EFIAPI +PlatformPcal9555GpioGetState ( + IN CONST UINT32 Pcal9555SlaveAddr, + IN CONST UINT32 GpioNum + ) +{ + return Pcal9555GetPortRegBit (Pcal9555SlaveAddr, GpioNum, PCAL9555_REG_IN_PORT0); +} + +