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 <henning.schild@siemens.com>
   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         case SIMATIC_IPC_DEVICE_BX_21A:
  61                 break;
  62         default:
  63                 return -ENODEV;
  64         }
  65
  66         gpiod_add_lookup_table(table);
  67         simatic_leds_pdev = platform_device_register_resndata(NULL,
  68                 "leds-gpio", PLATFORM_DEVID_NONE, NULL, 0,
  69                 &simatic_ipc_gpio_leds_pdata,
  70                 sizeof(simatic_ipc_gpio_leds_pdata));
  71         if (IS_ERR(simatic_leds_pdev)) {
  72                 err = PTR_ERR(simatic_leds_pdev);
  73                 goto out;
  74         }
  75
  76         if (!table_extra)
  77                 return 0;
  78
  79         table_extra->dev_id = dev_name(dev);
  80         gpiod_add_lookup_table(table_extra);
  81
  82         /* PM_BIOS_BOOT_N */
  83         gpiod = gpiod_get_index(dev, NULL, 6, GPIOD_OUT_LOW);
  84         if (IS_ERR(gpiod)) {
  85                 err = PTR_ERR(gpiod);
  86                 goto out;
  87         }
  88         gpiod_put(gpiod);
  89
  90         /* PM_WDT_OUT */
  91         gpiod = gpiod_get_index(dev, NULL, 7, GPIOD_OUT_LOW);
  92         if (IS_ERR(gpiod)) {
  93                 err = PTR_ERR(gpiod);
  94                 goto out;
  95         }
  96         gpiod_put(gpiod);
  97
  98         return 0;
  99 out:
 100         simatic_ipc_leds_gpio_remove(pdev, table, table_extra);
 101
 102         return err;
 103 }
 104 EXPORT_SYMBOL_GPL(simatic_ipc_leds_gpio_probe);
 105
 106 MODULE_LICENSE("GPL v2");
 107 MODULE_SOFTDEP("pre: platform:leds-gpio");
 108 MODULE_AUTHOR("Henning Schild <henning.schild@siemens.com>");