Gpio.c 2.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129
  1. /** @file
  2. Copyright (c) 2008 - 2009, Apple Inc. All rights reserved.<BR>
  3. SPDX-License-Identifier: BSD-2-Clause-Patent
  4. **/
  5. #include <Uefi.h>
  6. #include <Library/IoLib.h>
  7. #include <Library/OmapLib.h>
  8. #include <Library/UefiBootServicesTableLib.h>
  9. #include <Protocol/EmbeddedGpio.h>
  10. #include <Omap3530/Omap3530.h>
  11. EFI_STATUS
  12. Get (
  13. IN EMBEDDED_GPIO *This,
  14. IN EMBEDDED_GPIO_PIN Gpio,
  15. OUT UINTN *Value
  16. )
  17. {
  18. UINTN Port;
  19. UINTN Pin;
  20. UINT32 DataInRegister;
  21. if (Value == NULL)
  22. {
  23. return EFI_UNSUPPORTED;
  24. }
  25. Port = GPIO_PORT(Gpio);
  26. Pin = GPIO_PIN(Gpio);
  27. DataInRegister = GpioBase(Port) + GPIO_DATAIN;
  28. if (MmioRead32 (DataInRegister) & GPIO_DATAIN_MASK(Pin)) {
  29. *Value = 1;
  30. } else {
  31. *Value = 0;
  32. }
  33. return EFI_SUCCESS;
  34. }
  35. EFI_STATUS
  36. Set (
  37. IN EMBEDDED_GPIO *This,
  38. IN EMBEDDED_GPIO_PIN Gpio,
  39. IN EMBEDDED_GPIO_MODE Mode
  40. )
  41. {
  42. UINTN Port;
  43. UINTN Pin;
  44. UINT32 OutputEnableRegister;
  45. UINT32 SetDataOutRegister;
  46. UINT32 ClearDataOutRegister;
  47. Port = GPIO_PORT(Gpio);
  48. Pin = GPIO_PIN(Gpio);
  49. OutputEnableRegister = GpioBase(Port) + GPIO_OE;
  50. SetDataOutRegister = GpioBase(Port) + GPIO_SETDATAOUT;
  51. ClearDataOutRegister = GpioBase(Port) + GPIO_CLEARDATAOUT;
  52. switch (Mode)
  53. {
  54. case GPIO_MODE_INPUT:
  55. MmioAndThenOr32(OutputEnableRegister, ~GPIO_OE_MASK(Pin), GPIO_OE_INPUT(Pin));
  56. break;
  57. case GPIO_MODE_OUTPUT_0:
  58. MmioWrite32 (ClearDataOutRegister, GPIO_CLEARDATAOUT_BIT(Pin));
  59. MmioAndThenOr32(OutputEnableRegister, ~GPIO_OE_MASK(Pin), GPIO_OE_OUTPUT(Pin));
  60. break;
  61. case GPIO_MODE_OUTPUT_1:
  62. MmioWrite32 (SetDataOutRegister, GPIO_SETDATAOUT_BIT(Pin));
  63. MmioAndThenOr32(OutputEnableRegister, ~GPIO_OE_MASK(Pin), GPIO_OE_OUTPUT(Pin));
  64. break;
  65. default:
  66. return EFI_UNSUPPORTED;
  67. }
  68. return EFI_SUCCESS;
  69. }
  70. EFI_STATUS
  71. GetMode (
  72. IN EMBEDDED_GPIO *This,
  73. IN EMBEDDED_GPIO_PIN Gpio,
  74. OUT EMBEDDED_GPIO_MODE *Mode
  75. )
  76. {
  77. return EFI_UNSUPPORTED;
  78. }
  79. EFI_STATUS
  80. SetPull (
  81. IN EMBEDDED_GPIO *This,
  82. IN EMBEDDED_GPIO_PIN Gpio,
  83. IN EMBEDDED_GPIO_PULL Direction
  84. )
  85. {
  86. return EFI_UNSUPPORTED;
  87. }
  88. EMBEDDED_GPIO Gpio = {
  89. Get,
  90. Set,
  91. GetMode,
  92. SetPull
  93. };
  94. EFI_STATUS
  95. GpioInitialize (
  96. IN EFI_HANDLE ImageHandle,
  97. IN EFI_SYSTEM_TABLE *SystemTable
  98. )
  99. {
  100. EFI_STATUS Status;
  101. Status = gBS->InstallMultipleProtocolInterfaces(&ImageHandle, &gEmbeddedGpioProtocolGuid, &Gpio, NULL);
  102. return Status;
  103. }