Add a new device driver "gpio-apu" which will now handle the GPIOs on
APU2 and APU3 devices from PC Engines.

- APU2/APU3 -> front button reset support
- APU3 -> SIM switch support

Signed-off-by: Florian Eckert <f...@dev.tdt.de>
---
 drivers/gpio/Kconfig    |  10 ++
 drivers/gpio/Makefile   |   1 +
 drivers/gpio/gpio-apu.c | 344 ++++++++++++++++++++++++++++++++++++++++++++++++
 3 files changed, 355 insertions(+)
 create mode 100644 drivers/gpio/gpio-apu.c

diff --git a/drivers/gpio/Kconfig b/drivers/gpio/Kconfig
index 71c0ab46f216..9eb8977ba2e5 100644
--- a/drivers/gpio/Kconfig
+++ b/drivers/gpio/Kconfig
@@ -117,6 +117,16 @@ config GPIO_AMDPT
          driver for GPIO functionality on Promontory IOHub
          Require ACPI ASL code to enumerate as a platform device.
 
+config GPIO_APU
+       tristate "PC Engines APU2/APU3 GPIO support"
+       depends on X86
+       select GPIO_GENERIC
+       help
+         Say Y here to support GPIO functionality on APU2/APU3 boards
+         from PC Engines.
+         - APU2/APU3 -> front button reset support
+         - APU3 -> SIM switch support
+
 config GPIO_ASPEED
        tristate "Aspeed GPIO support"
        depends on (ARCH_ASPEED || COMPILE_TEST) && OF_GPIO
diff --git a/drivers/gpio/Makefile b/drivers/gpio/Makefile
index 1324c8f966a7..feea4effcf29 100644
--- a/drivers/gpio/Makefile
+++ b/drivers/gpio/Makefile
@@ -29,6 +29,7 @@ obj-$(CONFIG_GPIO_ALTERA)     += gpio-altera.o
 obj-$(CONFIG_GPIO_ALTERA_A10SR)        += gpio-altera-a10sr.o
 obj-$(CONFIG_GPIO_AMD8111)     += gpio-amd8111.o
 obj-$(CONFIG_GPIO_AMDPT)       += gpio-amdpt.o
+obj-$(CONFIG_GPIO_APU)         += gpio-apu.o
 obj-$(CONFIG_GPIO_ARIZONA)     += gpio-arizona.o
 obj-$(CONFIG_GPIO_ATH79)       += gpio-ath79.o
 obj-$(CONFIG_GPIO_ASPEED)      += gpio-aspeed.o
diff --git a/drivers/gpio/gpio-apu.c b/drivers/gpio/gpio-apu.c
new file mode 100644
index 000000000000..18171c13917a
--- /dev/null
+++ b/drivers/gpio/gpio-apu.c
@@ -0,0 +1,344 @@
+/* PC Engines APU2/APU3 GPIO device driver
+ *
+ * Copyright (C) 2018 Florian Eckert <f...@dev.tdt.de>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version
+ *
+ * This program is distributed in the hope that it will be useful
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, see <http://www.gnu.org/licenses/>
+ */
+
+#include <linux/dmi.h>
+#include <linux/err.h>
+#include <linux/gpio.h>
+#include <linux/gpio_keys.h>
+#include <linux/input.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/platform_device.h>
+
+#define DEVNAME                "gpio-apu"
+
+#define APU_FCH_ACPI_MMIO_BASE 0xFED80000
+#define APU_FCH_GPIO_BASE      (APU_FCH_ACPI_MMIO_BASE + 0x1500)
+#define APU_GPIO_BIT_WRITE     22
+#define APU_GPIO_BIT_READ      16
+#define APU_GPIO_BIT_DIR       23
+#define APU_IOSIZE             sizeof(u32)
+
+#define APU2_NUM_GPIO          1
+#define APU3_NUM_GPIO          2
+
+struct apu_gpio_pdata {
+       struct platform_device *pdev;
+       struct gpio_chip *chip;
+       unsigned long *offset;
+       void __iomem **addr;
+       int iosize; /* for devm_ioremap() */
+       spinlock_t lock;
+};
+
+static struct apu_gpio_pdata *apu_gpio;
+static struct platform_device *keydev;
+
+/* APU2 */
+static unsigned long apu2_gpio_offset[APU2_NUM_GPIO] = {
+       APU_FCH_GPIO_BASE + 89 * APU_IOSIZE, //KEY
+};
+static void __iomem *apu2_gpio_addr[APU2_NUM_GPIO] = {NULL};
+
+/* APU3 */
+static unsigned long apu3_gpio_offset[APU3_NUM_GPIO] = {
+       APU_FCH_GPIO_BASE + 89 * APU_IOSIZE, //KEY
+       APU_FCH_GPIO_BASE + 90 * APU_IOSIZE, //SIM
+};
+static void __iomem *apu3_gpio_addr[APU3_NUM_GPIO] = {NULL, NULL};
+
+static int gpio_apu_get_dir (struct gpio_chip *chip, unsigned offset)
+{
+       u32 val;
+
+       spin_lock(&apu_gpio->lock);
+
+       val = ~ioread32(apu_gpio->addr[offset]);
+       val = (val >> APU_GPIO_BIT_DIR) & 1;
+
+       spin_unlock(&apu_gpio->lock);
+
+       return val;
+}
+
+static int gpio_apu_dir_in (struct gpio_chip *chip, unsigned offset)
+{
+       u32 val;
+
+       spin_lock(&apu_gpio->lock);
+
+       val = ioread32(apu_gpio->addr[offset]);
+       val &= ~BIT(APU_GPIO_BIT_DIR);
+       iowrite32(val, apu_gpio->addr[offset]);
+
+       spin_unlock(&apu_gpio->lock);
+
+       return 0;
+}
+
+static int gpio_apu_dir_out (struct gpio_chip *chip, unsigned offset,
+               int value)
+{
+       u32 val;
+
+       spin_lock(&apu_gpio->lock);
+
+       val = ioread32(apu_gpio->addr[offset]);
+       val |= BIT(APU_GPIO_BIT_DIR);
+       iowrite32(val, apu_gpio->addr[offset]);
+
+       spin_unlock(&apu_gpio->lock);
+
+       return 0;
+}
+
+static int gpio_apu_get_data (struct gpio_chip *chip, unsigned offset)
+{
+       u32 val;
+
+       spin_lock(&apu_gpio->lock);
+
+       val = ioread32(apu_gpio->addr[offset]);
+       val = (val >> APU_GPIO_BIT_READ) & 1;
+
+       spin_unlock(&apu_gpio->lock);
+
+       return val;
+}
+
+static void gpio_apu_set_data (struct gpio_chip *chip, unsigned offset, int 
value)
+{
+       u32 val;
+
+       spin_lock(&apu_gpio->lock);
+
+       val = ioread32(apu_gpio->addr[offset]);
+       if (value)
+               val |= BIT(APU_GPIO_BIT_WRITE);
+       else
+               val &= ~BIT(APU_GPIO_BIT_WRITE);
+       iowrite32(val, apu_gpio->addr[offset]);
+
+       spin_unlock(&apu_gpio->lock);
+}
+
+static const struct dmi_system_id apu_gpio_dmi_table[] __initconst = {
+       /* PC Engines APU2 with "Legacy" bios < 4.0.8 */
+       {
+               .ident = "apu2",
+               .matches = {
+                       DMI_MATCH(DMI_SYS_VENDOR, "PC Engines"),
+                       DMI_MATCH(DMI_BOARD_NAME, "APU2")
+               }
+       },
+       /* PC Engines APU2 with "Legacy" bios >= 4.0.8 */
+       {
+               .ident = "apu2",
+               .matches = {
+                       DMI_MATCH(DMI_SYS_VENDOR, "PC Engines"),
+                       DMI_MATCH(DMI_BOARD_NAME, "apu2")
+               }
+       },
+       /* PC Engines APU2 with "Mainline" bios */
+       {
+               .ident = "apu2",
+               .matches = {
+                       DMI_MATCH(DMI_SYS_VENDOR, "PC Engines"),
+                       DMI_MATCH(DMI_BOARD_NAME, "PC Engines apu2")
+               }
+       },
+       /* PC Engines APU3 with "Legancy" bios >= 4.0.7 */
+       {
+               .ident = "apu2",
+               .matches = {
+                       DMI_MATCH(DMI_SYS_VENDOR, "PC Engines"),
+                       DMI_MATCH(DMI_BOARD_NAME, "APU3")
+               }
+       },
+       {}
+};
+MODULE_DEVICE_TABLE(dmi, apu_gpio_dmi_table);
+
+static struct gpio_chip gpio_apu_chip = {
+       .label = "gpio-apu",
+       .owner = THIS_MODULE,
+       .base = -1,
+       .get_direction = gpio_apu_get_dir,
+       .direction_input = gpio_apu_dir_in,
+       .direction_output = gpio_apu_dir_out,
+       .get = gpio_apu_get_data,
+       .set = gpio_apu_set_data,
+};
+
+static struct gpio_keys_button apu_gpio_keys[] = {
+       {
+               .desc           = "Reset button",
+               .type           = EV_KEY,
+               .code           = KEY_RESTART,
+               .debounce_interval = 60,
+               .gpio           = 510,
+               .active_low     = 1,
+       },
+};
+
+static void register_gpio_keys_polled(int id, unsigned poll_interval,
+                                     unsigned nbuttons,
+                                     struct gpio_keys_button *buttons)
+{
+       struct gpio_keys_platform_data pdata = { };
+       int err;
+
+       keydev = platform_device_alloc("gpio-keys-polled", id);
+       if (!keydev) {
+               printk(KERN_ERR "Failed to allocate gpio-keys platform 
device\n");
+               return;
+       }
+
+       pdata.poll_interval = poll_interval;
+       pdata.nbuttons = nbuttons;
+       pdata.buttons = buttons;
+
+       err = platform_device_add_data(keydev, &pdata, sizeof(pdata));
+       if (err) {
+               dev_err(&keydev->dev, "failed to add platform data to key 
driver (%d)", err);
+               goto err_put_pdev;
+       }
+
+       err = platform_device_add(keydev);
+       if (err) {
+               dev_err(&keydev->dev, "failed to register key platform device 
(%d)", err);
+               goto err_put_pdev;
+       }
+
+       return;
+
+err_put_pdev:
+       platform_device_put(keydev);
+       keydev = NULL;
+}
+
+static int __init apu_gpio_probe(struct platform_device *pdev)
+{
+       int i;
+       int ret;
+
+       apu_gpio = devm_kzalloc(&pdev->dev, sizeof(*apu_gpio), GFP_KERNEL);
+
+       if (!apu_gpio)
+               return -ENOMEM;
+
+       apu_gpio->pdev = pdev;
+       apu_gpio->chip = &gpio_apu_chip;
+       spin_lock_init(&apu_gpio->lock);
+
+       if (dmi_match(DMI_PRODUCT_NAME, "APU3")) {
+               apu_gpio->offset = apu3_gpio_offset;
+               apu_gpio->addr = apu3_gpio_addr;
+               apu_gpio->iosize = APU_IOSIZE;
+               apu_gpio->chip->ngpio = ARRAY_SIZE(apu3_gpio_offset);
+               for( i = 0; i < ARRAY_SIZE(apu3_gpio_offset); i++) {
+                       apu3_gpio_addr[i] = devm_ioremap(&pdev->dev,
+                                       apu_gpio->offset[i], apu_gpio->iosize);
+                       if (!apu3_gpio_addr[i]) {
+                               return -ENOMEM;
+                       }
+               }
+       } else if (dmi_match(DMI_BOARD_NAME, "APU2") ||
+                  dmi_match(DMI_BOARD_NAME, "apu2") ||
+                  dmi_match(DMI_BOARD_NAME, "PC Engines apu2")) {
+               apu_gpio->offset = apu2_gpio_offset;
+               apu_gpio->addr = apu2_gpio_addr;
+               apu_gpio->iosize = APU_IOSIZE;
+               apu_gpio->chip->ngpio = ARRAY_SIZE(apu2_gpio_offset);
+               for( i = 0; i < ARRAY_SIZE(apu2_gpio_offset); i++) {
+                       apu2_gpio_addr[i] = devm_ioremap(&pdev->dev,
+                                       apu_gpio->offset[i], apu_gpio->iosize);
+                       if (!apu2_gpio_addr[i]) {
+                               return -ENOMEM;
+                       }
+               }
+       }
+
+       ret = gpiochip_add(&gpio_apu_chip);
+       if (ret) {
+               pr_err("Adding gpiochip failed\n");
+       }
+
+       register_gpio_keys_polled(-1, 20, ARRAY_SIZE(apu_gpio_keys), 
apu_gpio_keys);
+
+       return ret;
+}
+
+static struct platform_driver apu_gpio_driver = {
+       .driver = {
+               .name = KBUILD_MODNAME,
+       },
+};
+
+static int __init apu_gpio_init(void)
+{
+       struct platform_device *pdev;
+       int err;
+
+       if (!dmi_match(DMI_SYS_VENDOR, "PC Engines")) {
+               pr_err("No PC Engines board detected\n");
+               return -ENODEV;
+       }
+       if (!(dmi_match(DMI_PRODUCT_NAME, "APU") ||
+             dmi_match(DMI_PRODUCT_NAME, "APU2") ||
+             dmi_match(DMI_PRODUCT_NAME, "APU3") ||
+             dmi_match(DMI_PRODUCT_NAME, "apu2") ||
+             dmi_match(DMI_PRODUCT_NAME, "PC Engines apu2"))) {
+               pr_err("Unknown PC Engines board: %s\n",
+                               dmi_get_system_info(DMI_PRODUCT_NAME));
+               return -ENODEV;
+       }
+
+       pdev = platform_device_register_simple(KBUILD_MODNAME, -1, NULL, 0);
+       if (IS_ERR(pdev)) {
+               pr_err("Device allocation failed\n");
+               return PTR_ERR(pdev);
+       }
+
+       err = platform_driver_probe(&apu_gpio_driver, apu_gpio_probe);
+       if (err) {
+               pr_err("Probe platform driver failed\n");
+               platform_device_unregister(pdev);
+       }
+
+       pr_info ("%s: APU2/3 GPIO driver module loaded\n", DEVNAME);
+
+       return err;
+}
+
+static void __exit apu_gpio_exit(void)
+{
+       platform_device_unregister(keydev);
+       gpiochip_remove(apu_gpio->chip);
+       platform_device_unregister(apu_gpio->pdev);
+       platform_driver_unregister(&apu_gpio_driver);
+       pr_info ("%s: APU2/3 GPIO driver module unloaded\n", DEVNAME);
+}
+
+module_init(apu_gpio_init);
+module_exit(apu_gpio_exit);
+
+MODULE_AUTHOR("Florian Eckert <f...@dev.tdt.de>");
+MODULE_DESCRIPTION("PC Engines APU2/APU3 family GPIO driver");
+MODULE_LICENSE("GPL v2");
+MODULE_ALIAS("platform:gpio_apu");
-- 
2.11.0

Reply via email to