xref: /linux/drivers/leds/simple/simatic-ipc-leds-gpio-core.c (revision 4b660dbd9ee2059850fd30e0df420ca7a38a1856)
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 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 <henning.schild@siemens.com>");
107