BeagleBoardPkg/Gpio/Gpio.c

   1 /** @file
   2
   3   Copyright (c) 2008-2009, Apple Inc. All rights reserved.
   4
   5   All rights reserved. This program and the accompanying materials
   6   are licensed and made available under the terms and conditions of the BSD License
   7   which accompanies this distribution.  The full text of the license may be found at
   8   http://opensource.org/licenses/bsd-license.php
   9
  10   THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
  11   WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
  12
  13 **/
  14
  15 #include <Uefi.h>
  16
  17 #include <Library/IoLib.h>
  18 #include <Library/OmapLib.h>
  19 #include <Library/UefiBootServicesTableLib.h>
  20
  21 #include <Protocol/EmbeddedGpio.h>
  22
  23 #include <Omap3530/Omap3530.h>
  24
  25 EFI_STATUS
  26 Get (
  27   IN  EMBEDDED_GPIO     *This,
  28   IN  EMBEDDED_GPIO_PIN Gpio,
  29   OUT UINTN               *Value
  30   )
  31 {
  32   UINTN  Port;
  33   UINTN  Pin;
  34   UINT32 DataInRegister;
  35
  36   if (Value == NULL)
  37   {
  38     return EFI_UNSUPPORTED;
  39   }
  40
  41   Port    = GPIO_PORT(Gpio);
  42   Pin     = GPIO_PIN(Gpio);
  43
  44   DataInRegister = GpioBase(Port) + GPIO_DATAIN;
  45
  46   if (MmioRead32(DataInRegister) & GPIO_DATAIN_MASK(Pin)) {
  47     *Value = 1;
  48   } else {
  49     *Value = 0;
  50   }
  51
  52   return EFI_SUCCESS;
  53 }
  54
  55 EFI_STATUS
  56 Set (
  57   IN  EMBEDDED_GPIO       *This,
  58   IN  EMBEDDED_GPIO_PIN   Gpio,
  59   IN  EMBEDDED_GPIO_MODE  Mode
  60   )
  61 {
  62   UINTN  Port;
  63   UINTN  Pin;
  64   UINT32 OutputEnableRegister;
  65   UINT32 SetDataOutRegister;
  66   UINT32 ClearDataOutRegister;
  67
  68   Port    = GPIO_PORT(Gpio);
  69   Pin     = GPIO_PIN(Gpio);
  70
  71   OutputEnableRegister = GpioBase(Port) + GPIO_OE;
  72   SetDataOutRegister   = GpioBase(Port) + GPIO_SETDATAOUT;
  73   ClearDataOutRegister = GpioBase(Port) + GPIO_CLEARDATAOUT;
  74
  75   switch (Mode)
  76   {
  77     case GPIO_MODE_INPUT:
  78       MmioAndThenOr32(OutputEnableRegister, ~GPIO_OE_MASK(Pin), GPIO_OE_INPUT(Pin));
  79       break;
  80
  81     case GPIO_MODE_OUTPUT_0:
  82       MmioWrite32(ClearDataOutRegister, GPIO_CLEARDATAOUT_BIT(Pin));
  83       MmioAndThenOr32(OutputEnableRegister, ~GPIO_OE_MASK(Pin), GPIO_OE_OUTPUT(Pin));
  84       break;
  85
  86     case GPIO_MODE_OUTPUT_1:
  87       MmioWrite32(SetDataOutRegister, GPIO_SETDATAOUT_BIT(Pin));
  88       MmioAndThenOr32(OutputEnableRegister, ~GPIO_OE_MASK(Pin), GPIO_OE_OUTPUT(Pin));
  89       break;
  90
  91     default:
  92       return EFI_UNSUPPORTED;
  93   }
  94
  95   return EFI_SUCCESS;
  96 }
  97
  98 EFI_STATUS
  99 GetMode (
 100   IN  EMBEDDED_GPIO       *This,
 101   IN  EMBEDDED_GPIO_PIN   Gpio,
 102   OUT EMBEDDED_GPIO_MODE  *Mode
 103   )
 104 {
 105   return EFI_UNSUPPORTED;
 106 }
 107
 108 EFI_STATUS
 109 SetPull (
 110   IN  EMBEDDED_GPIO       *This,
 111   IN  EMBEDDED_GPIO_PIN   Gpio,
 112   IN  EMBEDDED_GPIO_PULL  Direction
 113   )
 114 {
 115   return EFI_UNSUPPORTED;
 116 }
 117
 118 EMBEDDED_GPIO Gpio = {
 119   Get,
 120   Set,
 121   GetMode,
 122   SetPull
 123 };
 124
 125 EFI_STATUS
 126 GpioInitialize (
 127   IN EFI_HANDLE         ImageHandle,
 128   IN EFI_SYSTEM_TABLE   *SystemTable
 129   )
 130 {
 131   EFI_STATUS  Status;
 132
 133   Status = gBS->InstallMultipleProtocolInterfaces(&ImageHandle, &gEmbeddedGpioProtocolGuid, &Gpio, NULL);
 134   return Status;
 135 }