PL061Gpio.c

Go to the documentation of this file.

 
#include <PiDxe.h>
 
#include <Library/BaseLib.h>
#include <Library/BaseMemoryLib.h>
#include <Library/DebugLib.h>
#include <Library/IoLib.h>
#include <Library/MemoryAllocationLib.h>
#include <Library/PcdLib.h>
#include <Library/UefiBootServicesTableLib.h>
#include <Library/UefiLib.h>
#include <Library/UefiRuntimeServicesTableLib.h>
 
#include <Protocol/EmbeddedGpio.h>
 
#include "PL061Gpio.h"
 
PLATFORM_GPIO_CONTROLLER  *mPL061PlatformGpio;
 
EFI_STATUS
EFIAPI
PL061Locate (
  IN  EMBEDDED_GPIO_PIN  Gpio,
  OUT UINTN              *ControllerIndex,
  OUT UINTN              *ControllerOffset,
  OUT UINTN              *RegisterBase
  )
{
  UINTN  Index;
 
  for (Index = 0; Index < mPL061PlatformGpio->GpioControllerCount; Index++) {
    if (  (Gpio >= mPL061PlatformGpio->GpioController[Index].GpioIndex)
       &&  (Gpio < mPL061PlatformGpio->GpioController[Index].GpioIndex
            + mPL061PlatformGpio->GpioController[Index].InternalGpioCount))
    {
      *ControllerIndex  = Index;
      *ControllerOffset = Gpio % mPL061PlatformGpio->GpioController[Index].InternalGpioCount;
      *RegisterBase     = mPL061PlatformGpio->GpioController[Index].RegisterBase;
      return EFI_SUCCESS;
    }
  }
 
  DEBUG ((DEBUG_ERROR, "%a, failed to locate gpio %d\n", __func__, Gpio));
  return EFI_INVALID_PARAMETER;
}
 
//
// The PL061 is a strange beast. The 8-bit data register is aliased across a
// region 0x400 bytes in size, with bits [9:2] of the address operating as a
// mask for both read and write operations:
// For reads:
//   - All bits where their corresponding mask bit is 1 return the current
//     value of that bit in the GPIO_DATA register.
//   - All bits where their corresponding mask bit is 0 return 0.
// For writes:
//   - All bits where their corresponding mask bit is 1 set the bit in the
//     GPIO_DATA register to the written value.
//   - All bits where their corresponding mask bit is 0 are left untouched
//     in the GPIO_DATA register.
//
// To keep this driver intelligible, PL061EffectiveAddress, PL061GetPins and
// Pl061SetPins provide an internal abstraction from this interface.
 
STATIC
UINTN
EFIAPI
PL061EffectiveAddress (
  IN UINTN  Address,
  IN UINT8  Mask
  )
{
  return ((Address + PL061_GPIO_DATA_REG_OFFSET) + (UINTN)(Mask << 2));
}
 
STATIC
UINT8
EFIAPI
PL061GetPins (
  IN UINTN  Address,
  IN UINT8  Mask
  )
{
  return MmioRead8 (PL061EffectiveAddress (Address, Mask));
}
 
STATIC
VOID
EFIAPI
PL061SetPins (
  IN UINTN  Address,
  IN UINT8  Mask,
  IN UINT8  Value
  )
{
  MmioWrite8 (PL061EffectiveAddress (Address, Mask), Value);
}
 
EFI_STATUS
PL061Identify (
  VOID
  )
{
  UINTN  Index;
  UINTN  RegisterBase;
 
  if (  (mPL061PlatformGpio->GpioCount == 0)
     || (mPL061PlatformGpio->GpioControllerCount == 0))
  {
    return EFI_NOT_FOUND;
  }
 
  for (Index = 0; Index < mPL061PlatformGpio->GpioControllerCount; Index++) {
    if (mPL061PlatformGpio->GpioController[Index].InternalGpioCount != PL061_GPIO_PINS) {
      return EFI_INVALID_PARAMETER;
    }
 
    RegisterBase = mPL061PlatformGpio->GpioController[Index].RegisterBase;
 
    // Check if this is a PrimeCell Peripheral
    if (  (MmioRead8 (RegisterBase + PL061_GPIO_PCELL_ID0) != 0x0D)
       ||  (MmioRead8 (RegisterBase + PL061_GPIO_PCELL_ID1) != 0xF0)
       ||  (MmioRead8 (RegisterBase + PL061_GPIO_PCELL_ID2) != 0x05)
       ||  (MmioRead8 (RegisterBase + PL061_GPIO_PCELL_ID3) != 0xB1))
    {
      return EFI_NOT_FOUND;
    }
 
    // Check if this PrimeCell Peripheral is the PL061 GPIO
    if (  (MmioRead8 (RegisterBase + PL061_GPIO_PERIPH_ID0) != 0x61)
       ||  (MmioRead8 (RegisterBase + PL061_GPIO_PERIPH_ID1) != 0x10)
       ||  ((MmioRead8 (RegisterBase + PL061_GPIO_PERIPH_ID2) & 0xF) != 0x04)
       ||  (MmioRead8 (RegisterBase + PL061_GPIO_PERIPH_ID3) != 0x00))
    {
      return EFI_NOT_FOUND;
    }
  }
 
  return EFI_SUCCESS;
}
 
EFI_STATUS
EFIAPI
Get (
  IN  EMBEDDED_GPIO      *This,
  IN  EMBEDDED_GPIO_PIN  Gpio,
  OUT UINTN              *Value
  )
{
  EFI_STATUS  Status;
  UINTN       Index, Offset, RegisterBase;
 
  if (Value == NULL) {
    return EFI_INVALID_PARAMETER;
  }
 
  Status = PL061Locate (Gpio, &Index, &Offset, &RegisterBase);
  if (EFI_ERROR (Status)) {
    ASSERT_EFI_ERROR (Status);
    return Status;
  }
 
  if (PL061GetPins (RegisterBase, GPIO_PIN_MASK (Offset)) != 0) {
    *Value = 1;
  } else {
    *Value = 0;
  }
 
  return EFI_SUCCESS;
}
 
EFI_STATUS
EFIAPI
Set (
  IN  EMBEDDED_GPIO       *This,
  IN  EMBEDDED_GPIO_PIN   Gpio,
  IN  EMBEDDED_GPIO_MODE  Mode
  )
{
  EFI_STATUS  Status;
  UINTN       Index, Offset, RegisterBase;
 
  Status = PL061Locate (Gpio, &Index, &Offset, &RegisterBase);
  if (EFI_ERROR (Status)) {
    ASSERT_EFI_ERROR (Status);
    return Status;
  }
 
  switch (Mode) {
    case GPIO_MODE_INPUT:
      // Set the corresponding direction bit to LOW for input
      MmioAnd8 (
        RegisterBase + PL061_GPIO_DIR_REG,
        ~GPIO_PIN_MASK(Offset) & 0xFF
        );
      break;
 
    case GPIO_MODE_OUTPUT_0:
      // Set the corresponding direction bit to HIGH for output
      MmioOr8 (RegisterBase + PL061_GPIO_DIR_REG, GPIO_PIN_MASK (Offset));
      // Set the corresponding data bit to LOW for 0
      PL061SetPins (RegisterBase, GPIO_PIN_MASK (Offset), 0);
      break;
 
    case GPIO_MODE_OUTPUT_1:
      // Set the corresponding direction bit to HIGH for output
      MmioOr8 (RegisterBase + PL061_GPIO_DIR_REG, GPIO_PIN_MASK (Offset));
      // Set the corresponding data bit to HIGH for 1
      PL061SetPins (RegisterBase, GPIO_PIN_MASK (Offset), 0xff);
      break;
 
    default:
      // Other modes are not supported
      return EFI_UNSUPPORTED;
  }
 
  return EFI_SUCCESS;
}
 
EFI_STATUS
EFIAPI
GetMode (
  IN  EMBEDDED_GPIO       *This,
  IN  EMBEDDED_GPIO_PIN   Gpio,
  OUT EMBEDDED_GPIO_MODE  *Mode
  )
{
  EFI_STATUS  Status;
  UINTN       Index, Offset, RegisterBase;
 
  // Check for errors
  if (Mode == NULL) {
    return EFI_INVALID_PARAMETER;
  }
 
  Status = PL061Locate (Gpio, &Index, &Offset, &RegisterBase);
  if (EFI_ERROR (Status)) {
    ASSERT_EFI_ERROR (Status);
    return Status;
  }
 
  // Check if it is input or output
  if (MmioRead8 (RegisterBase + PL061_GPIO_DIR_REG) & GPIO_PIN_MASK (Offset)) {
    // Pin set to output
    if (PL061GetPins (RegisterBase, GPIO_PIN_MASK (Offset)) != 0) {
      *Mode = GPIO_MODE_OUTPUT_1;
    } else {
      *Mode = GPIO_MODE_OUTPUT_0;
    }
  } else {
    // Pin set to input
    *Mode = GPIO_MODE_INPUT;
  }
 
  return EFI_SUCCESS;
}
 
EFI_STATUS
EFIAPI
SetPull (
  IN  EMBEDDED_GPIO       *This,
  IN  EMBEDDED_GPIO_PIN   Gpio,
  IN  EMBEDDED_GPIO_PULL  Direction
  )
{
  return EFI_UNSUPPORTED;
}
 
EMBEDDED_GPIO  gGpio = {
  Get,
  Set,
  GetMode,
  SetPull
};
 
EFI_STATUS
EFIAPI
PL061InstallProtocol (
  IN EFI_HANDLE        ImageHandle,
  IN EFI_SYSTEM_TABLE  *SystemTable
  )
{
  EFI_STATUS       Status;
  EFI_HANDLE       Handle;
  GPIO_CONTROLLER  *GpioController;
 
  //
  // Make sure the Gpio protocol has not been installed in the system yet.
  //
  ASSERT_PROTOCOL_ALREADY_INSTALLED (NULL, &gEmbeddedGpioProtocolGuid);
 
  Status = gBS->LocateProtocol (&gPlatformGpioProtocolGuid, NULL, (VOID **)&mPL061PlatformGpio);
  if (EFI_ERROR (Status) && (Status == EFI_NOT_FOUND)) {
    // Create the mPL061PlatformGpio
    mPL061PlatformGpio = (PLATFORM_GPIO_CONTROLLER *)AllocateZeroPool (sizeof (PLATFORM_GPIO_CONTROLLER) + sizeof (GPIO_CONTROLLER));
    if (mPL061PlatformGpio == NULL) {
      DEBUG ((DEBUG_ERROR, "%a: failed to allocate PLATFORM_GPIO_CONTROLLER\n", __func__));
      return EFI_BAD_BUFFER_SIZE;
    }
 
    mPL061PlatformGpio->GpioCount           = PL061_GPIO_PINS;
    mPL061PlatformGpio->GpioControllerCount = 1;
    mPL061PlatformGpio->GpioController      = (GPIO_CONTROLLER *)((UINTN)mPL061PlatformGpio + sizeof (PLATFORM_GPIO_CONTROLLER));
 
    GpioController                    = mPL061PlatformGpio->GpioController;
    GpioController->RegisterBase      = (UINTN)PcdGet32 (PcdPL061GpioBase);
    GpioController->GpioIndex         = 0;
    GpioController->InternalGpioCount = PL061_GPIO_PINS;
  }
 
  Status = PL061Identify ();
  if (EFI_ERROR (Status)) {
    return EFI_DEVICE_ERROR;
  }
 
  // Install the Embedded GPIO Protocol onto a new handle
  Handle = NULL;
  Status = gBS->InstallMultipleProtocolInterfaces (
                  &Handle,
                  &gEmbeddedGpioProtocolGuid,
                  &gGpio,
                  NULL
                  );
  if (EFI_ERROR (Status)) {
    Status = EFI_OUT_OF_RESOURCES;
  }
 
  return Status;
}