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
20static struct platform_device *simatic_leds_pdev;
21
22static 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
31static 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
36void 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}
44EXPORT_SYMBOL_GPL(simatic_ipc_leds_gpio_remove);
45
46int 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;
97out:
98	simatic_ipc_leds_gpio_remove(pdev, table, table_extra);
99
100	return err;
101}
102EXPORT_SYMBOL_GPL(simatic_ipc_leds_gpio_probe);
103
104MODULE_LICENSE("GPL v2");
105MODULE_SOFTDEP("pre: platform:leds-gpio");
106MODULE_AUTHOR("Henning Schild <henning.schild@siemens.com>");
107