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 void 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 EXPORT_SYMBOL_GPL(simatic_ipc_leds_gpio_remove);
  45
  46 int simatic_ipc_leds_gpio_probe(struct platform_device *pdev,
  47                                 struct gpiod_lookup_table *table,
  48                                 struct gpiod_lookup_table *table_extra)
  49 {
  50         const struct simatic_ipc_platform *plat = pdev->dev.platform_data;
  51         struct device *dev = &pdev->dev;
  52         struct gpio_desc *gpiod;
  53         int err;
  54
  55         switch (plat->devmode) {
  56         case SIMATIC_IPC_DEVICE_127E:
  57         case SIMATIC_IPC_DEVICE_227G:
  58         case SIMATIC_IPC_DEVICE_BX_21A:
  59                 break;
  60         default:
  61                 return -ENODEV;
  62         }
  63
  64         gpiod_add_lookup_table(table);
  65         simatic_leds_pdev = platform_device_register_resndata(NULL,
  66                 "leds-gpio", PLATFORM_DEVID_NONE, NULL, 0,
  67                 &simatic_ipc_gpio_leds_pdata,
  68                 sizeof(simatic_ipc_gpio_leds_pdata));
  69         if (IS_ERR(simatic_leds_pdev)) {
  70                 err = PTR_ERR(simatic_leds_pdev);
  71                 goto out;
  72         }
  73
  74         if (!table_extra)
  75                 return 0;
  76
  77         table_extra->dev_id = dev_name(dev);
  78         gpiod_add_lookup_table(table_extra);
  79
  80         /* PM_BIOS_BOOT_N */
  81         gpiod = gpiod_get_index(dev, NULL, 6, GPIOD_OUT_LOW);
  82         if (IS_ERR(gpiod)) {
  83                 err = PTR_ERR(gpiod);
  84                 goto out;
  85         }
  86         gpiod_put(gpiod);
  87
  88         /* PM_WDT_OUT */
  89         gpiod = gpiod_get_index(dev, NULL, 7, GPIOD_OUT_LOW);
  90         if (IS_ERR(gpiod)) {
  91                 err = PTR_ERR(gpiod);
  92                 goto out;
  93         }
  94         gpiod_put(gpiod);
  95
  96         return 0;
  97 out:
  98         simatic_ipc_leds_gpio_remove(pdev, table, table_extra);
  99
 100         return err;
 101 }
 102 EXPORT_SYMBOL_GPL(simatic_ipc_leds_gpio_probe);
 103
 104 MODULE_LICENSE("GPL v2");
 105 MODULE_SOFTDEP("pre: platform:leds-gpio");
 106 MODULE_AUTHOR("Henning Schild <[email protected]>");