1 files changed, 75 insertions, 0 deletions
diff --git a/roms/skiboot/platforms/rhesus/gpio.c b/roms/skiboot/platforms/rhesus/gpio.c
new file mode 100644
index 000000000..2ac36303e
--- /dev/null
+++ b/roms/skiboot/platforms/rhesus/gpio.c
@@ -0,0 +1,75 @@
+// SPDX-License-Identifier: Apache-2.0
+/* Copyright 2013-2014 Google Corp. */
+
+#include <stdint.h>
+#include "ec/config.h"
+#include "ec/gpio.h"
+
+int ec_gpio_setup(EcGpioPort port, uint8_t pin,
+                  int is_output, int pullup_enable)
+{
+    uint8_t ddr_reg;
+    if (pin > 7) {
+        return -1;
+    }
+
+    /* Set data direction */
+    ec_outb(EC_GPIO_INDEX,
+            port * EC_GPIO_PORT_SKIP + EC_GPIO_DDR_OFFSET);
+    ddr_reg = ec_inb(EC_GPIO_DATA);
+    if (is_output) {
+        ddr_reg |= (1 << pin);
+    } else {
+        ddr_reg &= ~(1 << pin);
+    }
+    ec_outb(EC_GPIO_DATA, ddr_reg);
+
+    /* Set pullup enable for output GPOs */
+    if (is_output)
+    {
+        uint8_t pup_reg;
+        ec_outb(EC_GPIO_INDEX,
+                port * EC_GPIO_PORT_SKIP + EC_GPIO_PUP_OFFSET);
+        pup_reg = ec_inb(EC_GPIO_DATA);
+        if (pullup_enable) {
+            pup_reg |= (1 << pin);
+        } else {
+            pup_reg &= ~(1 << pin);
+        }
+        ec_outb(EC_GPIO_DATA, pup_reg);
+    }
+
+    return 0;
+}
+
+int ec_gpio_read(EcGpioPort port, uint8_t pin)
+{
+    uint8_t pin_reg;
+    if (pin > 7) {
+        return -1;
+    }
+
+    ec_outb(EC_GPIO_INDEX,
+            port * EC_GPIO_PORT_SKIP + EC_GPIO_PIN_OFFSET);
+    pin_reg = ec_inb(EC_GPIO_DATA);
+    return !!(pin_reg & (1 << pin));
+}
+
+int ec_gpio_set(EcGpioPort port, uint8_t pin, int val)
+{
+    uint8_t data_reg;
+    if (pin > 7) {
+        return -1;
+    }
+
+    ec_outb(EC_GPIO_INDEX,
+            port * EC_GPIO_PORT_SKIP + EC_GPIO_DATA_OFFSET);
+    data_reg = ec_inb(EC_GPIO_DATA);
+    if (val) {
+        data_reg |= (1 << pin);
+    } else {
+        data_reg &= ~(1 << pin);
+    }
+    ec_outb(EC_GPIO_DATA, data_reg);
+    return 0;
+}