This patch adds the driver for the PCEngines APU2 LEDs.
Signed-off-by: Christian Herzog <daduke@xxxxxxxxxx>
---
drivers/leds/leds-apu2.c | 243
+++++++++++++++++++++++++++++++++++++++++++++++
1 files changed, 243 insertions(+)
Index: b/drivers/leds/leds-apu2.c
===================================================================
--- /dev/null
+++ b/drivers/leds/leds-apu2.c
@@ -0,0 +1,243 @@
+/*
+ * LEDs driver for PCEngines apu2
+ *
+ * Copyright (C) 2017 Christian Herzog <daduke@xxxxxxxxxx>, based on
+ * Petr Leibman's leds-alix
+ * Based on leds-wrap.c
+ * many thanks to Luigi Baldoni for his help
+ *
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ */
+
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/platform_device.h>
+#include <linux/leds.h>
+#include <linux/err.h>
+#include <linux/io.h>
+#include <linux/dmi.h>
+
+#define DRVNAME "apu2-led"
+#define FCH_ACPI_MMIO_BASE 0xFED80000
+#define FCH_GPIO_BASE (FCH_ACPI_MMIO_BASE + 0x1500)
+#define FCH_GPIO_SIZE 0x300
+#define GPIO_BIT_WRITE 22
+#define APU2_NUM_GPIO 4
+
+MODULE_AUTHOR("Christian Herzog <daduke@xxxxxxxxxx>");
+MODULE_DESCRIPTION("PCEngines apu2 LED driver");
+MODULE_LICENSE("GPL v2");
+
+static DEFINE_SPINLOCK(gpio_lock);
+
+static int __init apu2_led_dmi_callback(const struct dmi_system_id *id)
+{
+ pr_info("'%s' found\n", id->ident);
+ return 1;
+}
+
+static struct dmi_system_id apu2_led_dmi_table[] __initdata = {
+ {
+ .callback = apu2_led_dmi_callback,
+ .ident = "apu2",
+ .matches = {
+ DMI_MATCH(DMI_SYS_VENDOR, "PCEngines"),
+ DMI_MATCH(DMI_PRODUCT_NAME, "apu2")
+ }
+ },
+ { }
+};
+MODULE_DEVICE_TABLE(dmi, apu2_led_dmi_table);
+
+static u8 gpio_offset[APU2_NUM_GPIO] = {89, 68, 69, 70};
+
+static void __iomem *gpio_addr[APU2_NUM_GPIO];
+
+static struct platform_device *pdev;
+
+static void apu2_led_set_1(struct led_classdev *led_cdev,
+ enum led_brightness value)
+{
+ u32 val;
+
+ spin_lock_bh(&gpio_lock);
+
+ val = ioread32(gpio_addr[1]);
+
+ if (value)
+ val &= ~BIT(GPIO_BIT_WRITE);
+ else
+ val |= BIT(GPIO_BIT_WRITE);
+
+ iowrite32(val, gpio_addr[1]);
+
+ spin_unlock_bh(&gpio_lock);
+}
+
+static void apu2_led_set_2(struct led_classdev *led_cdev,
+ enum led_brightness value)
+{
+ u32 val;
+
+ spin_lock_bh(&gpio_lock);
+
+ val = ioread32(gpio_addr[2]);
+
+ if (value)
+ val &= ~BIT(GPIO_BIT_WRITE);
+ else
+ val |= BIT(GPIO_BIT_WRITE);
+
+ iowrite32(val, gpio_addr[2]);
+
+ spin_unlock_bh(&gpio_lock);
+}
+
+static void apu2_led_set_3(struct led_classdev *led_cdev,
+ enum led_brightness value)
+{
+ u32 val;
+
+ spin_lock_bh(&gpio_lock);
+
+ val = ioread32(gpio_addr[3]);
+
+ if (value)
+ val &= ~BIT(GPIO_BIT_WRITE);
+ else
+ val |= BIT(GPIO_BIT_WRITE);
+
+ iowrite32(val, gpio_addr[3]);
+
+ spin_unlock_bh(&gpio_lock);
+}
+
+static struct led_classdev apu2_led_1 = {
+ .name = "apu2:1",
+ .brightness_set = apu2_led_set_1,
+};
+
+static struct led_classdev apu2_led_2 = {
+ .name = "apu2:2",
+ .brightness_set = apu2_led_set_2,
+};
+
+static struct led_classdev apu2_led_3 = {
+ .name = "apu2:3",
+ .brightness_set = apu2_led_set_3,
+};
+
+#ifdef CONFIG_PM
+static int apu2_led_suspend(struct platform_device *dev, pm_message_t
state)
+{
+ led_classdev_suspend(&apu2_led_1);
+ led_classdev_suspend(&apu2_led_2);
+ led_classdev_suspend(&apu2_led_3);
+ return 0;
+}
+
+static int apu2_led_resume(struct platform_device *dev)
+{
+ led_classdev_resume(&apu2_led_1);
+ led_classdev_resume(&apu2_led_2);
+ led_classdev_resume(&apu2_led_3);
+ return 0;
+}
+#else
+#define apu2_led_suspend NULL
+#define apu2_led_resume NULL
+#endif
+
+static int apu2_led_probe(struct platform_device *pdev)
+{
+ int ret;
+
+ ret = led_classdev_register(&pdev->dev, &apu2_led_1);
+ if (ret)
+ goto error1;
+
+ ret = led_classdev_register(&pdev->dev, &apu2_led_2);
+ if (ret)
+ goto error2;
+
+ ret = led_classdev_register(&pdev->dev, &apu2_led_3);
+ if (ret)
+ goto error3;
+
+ return 0;
+
+error3:
+ led_classdev_unregister(&apu2_led_2);
+error2:
+ led_classdev_unregister(&apu2_led_1);
+error1:
+ return ret;
+}
+
+static int apu2_led_remove(struct platform_device *pdev)
+{
+ led_classdev_unregister(&apu2_led_3);
+ led_classdev_unregister(&apu2_led_2);
+ led_classdev_unregister(&apu2_led_1);
+ return 0;
+}
+
+static struct platform_driver apu2_led_driver = {
+ .probe = apu2_led_probe,
+ .remove = apu2_led_remove,
+ .suspend = apu2_led_suspend,
+ .resume = apu2_led_resume,
+ .driver = {
+ .name = DRVNAME,
+ .owner = THIS_MODULE,
+ },
+};
+
+static int __init apu2_led_init(void)
+{
+ void __iomem *addr;
+ int ret;
+ int i;
+
+ ret = platform_driver_register(&apu2_led_driver);
+ if (ret < 0)
+ goto error_driver;
+
+ pdev = platform_device_register_simple(DRVNAME, -1, NULL, 0);
+ if (IS_ERR(pdev)) {
+ ret = PTR_ERR(pdev);
+ goto error_register;
+ }
+
+ ret = -ENOMEM;
+ for (i = 0; i < APU2_NUM_GPIO; i++) {
+ addr = devm_ioremap(&pdev->dev,
+ FCH_GPIO_BASE +
+ (gpio_offset[i] * sizeof(u32)),
+ sizeof(u32));
+ if (!addr)
+ goto error_ioremap;
+ gpio_addr[i] = addr;
+ }
+ return 0;
+
+error_ioremap:
+ platform_device_unregister(pdev);
+error_register:
+ platform_driver_unregister(&apu2_led_driver);
+error_driver:
+ return ret;
+}
+
+static void __exit apu2_led_exit(void)
+{
+ platform_device_unregister(pdev);
+ platform_driver_unregister(&apu2_led_driver);
+}
+
+module_init(apu2_led_init);
+module_exit(apu2_led_exit);
