drivers/leds/simple/simatic-ipc-leds-gpio-core.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Siemens SIMATIC IPC driver for GPIO based LEDs
   4  *
   5  * Copyright (c) Siemens AG, 2023
   6  *
   7  * Author:
   8  *  Henning Schild <[email protected]>
   9  */
  10
  11 #include <linux/gpio/machine.h>
  12 #include <linux/gpio/consumer.h>
  13 #include <linux/leds.h>
  14 #include <linux/module.h>
  15 #include <linux/platform_device.h>
  16 #include <linux/platform_data/x86/simatic-ipc-base.h>
  17
  18 #include "simatic-ipc-leds-gpio.h"
  19
  20 static struct platform_device *simatic_leds_pdev;
  21
  22 static const struct gpio_led simatic_ipc_gpio_leds[] = {
  23         { .name = "red:" LED_FUNCTION_STATUS "-1" },
  24         { .name = "green:" LED_FUNCTION_STATUS "-1" },
  25         { .name = "red:" LED_FUNCTION_STATUS "-2" },
  26         { .name = "green:" LED_FUNCTION_STATUS "-2" },
  27         { .name = "red:" LED_FUNCTION_STATUS "-3" },
  28         { .name = "green:" LED_FUNCTION_STATUS "-3" },
  29 };
  30
  31 static const struct gpio_led_platform_data simatic_ipc_gpio_leds_pdata = {
  32         .num_leds       = ARRAY_SIZE(simatic_ipc_gpio_leds),
  33         .leds           = simatic_ipc_gpio_leds,
  34 };
  35
  36 int simatic_ipc_leds_gpio_remove(struct platform_device *pdev,
  37                                  struct gpiod_lookup_table *table,
  38                                  struct gpiod_lookup_table *table_extra)
  39 {
  40         gpiod_remove_lookup_table(table);
  41         gpiod_remove_lookup_table(table_extra);
  42         platform_device_unregister(simatic_leds_pdev);
  43
  44         return 0;
  45 }
  46 EXPORT_SYMBOL_GPL(simatic_ipc_leds_gpio_remove);
  47
  48 int simatic_ipc_leds_gpio_probe(struct platform_device *pdev,
  49                                 struct gpiod_lookup_table *table,
  50                                 struct gpiod_lookup_table *table_extra)
  51 {
  52         const struct simatic_ipc_platform *plat = pdev->dev.platform_data;
  53         struct device *dev = &pdev->dev;
  54         struct gpio_desc *gpiod;
  55         int err;
  56
  57         switch (plat->devmode) {
  58         case SIMATIC_IPC_DEVICE_127E:
  59         case SIMATIC_IPC_DEVICE_227G:
  60                 break;
  61         default:
  62                 return -ENODEV;
  63         }
  64
  65         gpiod_add_lookup_table(table);
  66         simatic_leds_pdev = platform_device_register_resndata(NULL,
  67                 "leds-gpio", PLATFORM_DEVID_NONE, NULL, 0,
  68                 &simatic_ipc_gpio_leds_pdata,
  69                 sizeof(simatic_ipc_gpio_leds_pdata));
  70         if (IS_ERR(simatic_leds_pdev)) {
  71                 err = PTR_ERR(simatic_leds_pdev);
  72                 goto out;
  73         }
  74
  75         table_extra->dev_id = dev_name(dev);
  76         gpiod_add_lookup_table(table_extra);
  77
  78         /* PM_BIOS_BOOT_N */
  79         gpiod = gpiod_get_index(dev, NULL, 6, GPIOD_OUT_LOW);
  80         if (IS_ERR(gpiod)) {
  81                 err = PTR_ERR(gpiod);
  82                 goto out;
  83         }
  84         gpiod_put(gpiod);
  85
  86         /* PM_WDT_OUT */
  87         gpiod = gpiod_get_index(dev, NULL, 7, GPIOD_OUT_LOW);
  88         if (IS_ERR(gpiod)) {
  89                 err = PTR_ERR(gpiod);
  90                 goto out;
  91         }
  92         gpiod_put(gpiod);
  93
  94         return 0;
  95 out:
  96         simatic_ipc_leds_gpio_remove(pdev, table, table_extra);
  97
  98         return err;
  99 }
 100 EXPORT_SYMBOL_GPL(simatic_ipc_leds_gpio_probe);
 101
 102 MODULE_LICENSE("GPL v2");
 103 MODULE_SOFTDEP("pre: platform:leds-gpio");
 104 MODULE_AUTHOR("Henning Schild <[email protected]>");