1 // SPDX-License-Identifier: GPL-2.0-or-later
3  * leds-ns2.c - Driver for the Network Space v2 (and parents) dual-GPIO LED
9  * Based on leds-gpio.c by Raphael Assenat <raph@8d.com>
39  * The Network Space v2 dual-GPIO LED is wired to a CPLD. Three different LED
41  * controlled through two GPIOs (command and slow): each combination of values
42  * for the command/slow GPIOs corresponds to a LED mode.
47 	struct gpio_desc	*cmd;  member
51 	rwlock_t		rw_lock; /* Lock GPIOs. */
62 	cmd_level = gpiod_get_value_cansleep(led->cmd);  in ns2_led_get_mode()
63 	slow_level = gpiod_get_value_cansleep(led->slow);  in ns2_led_get_mode()
65 	for (i = 0; i < led->num_modes; i++) {  in ns2_led_get_mode()
66 		if (cmd_level == led->modval[i].cmd_level &&  in ns2_led_get_mode()
67 		    slow_level == led->modval[i].slow_level) {  in ns2_led_get_mode()
68 			*mode = led->modval[i].mode;  in ns2_led_get_mode()
73 	return -EINVAL;  in ns2_led_get_mode()
81 	for (i = 0; i < led->num_modes; i++)  in ns2_led_set_mode()
82 		if (mode == led->modval[i].mode)  in ns2_led_set_mode()
85 	if (i == led->num_modes)  in ns2_led_set_mode()
88 	write_lock_irqsave(&led->rw_lock, flags);  in ns2_led_set_mode()
90 	if (!led->can_sleep) {  in ns2_led_set_mode()
91 		gpiod_set_value(led->cmd, led->modval[i].cmd_level);  in ns2_led_set_mode()
92 		gpiod_set_value(led->slow, led->modval[i].slow_level);  in ns2_led_set_mode()
96 	gpiod_set_value_cansleep(led->cmd, led->modval[i].cmd_level);  in ns2_led_set_mode()
97 	gpiod_set_value_cansleep(led->slow, led->modval[i].slow_level);  in ns2_led_set_mode()
100 	write_unlock_irqrestore(&led->rw_lock, flags);  in ns2_led_set_mode()
111 	else if (led->sata)  in ns2_led_set()
141 	if (led->sata == enable)  in ns2_led_sata_store()
144 	led->sata = enable;  in ns2_led_sata_store()
164 	return sprintf(buf, "%d\n", led->sata);  in ns2_led_sata_show()
183 	led->cmd = devm_fwnode_gpiod_get_index(dev, node, "cmd", 0, GPIOD_ASIS,  in ns2_led_register()
185 	if (IS_ERR(led->cmd))  in ns2_led_register()
186 		return PTR_ERR(led->cmd);  in ns2_led_register()
188 	led->slow = devm_fwnode_gpiod_get_index(dev, node, "slow", 0,  in ns2_led_register()
191 	if (IS_ERR(led->slow))  in ns2_led_register()
192 		return PTR_ERR(led->slow);  in ns2_led_register()
194 	ret = fwnode_property_count_u32(node, "modes-map");  in ns2_led_register()
196 		dev_err(dev, "Missing or malformed modes-map for %pfw\n", node);  in ns2_led_register()
197 		return -EINVAL;  in ns2_led_register()
203 		return -ENOMEM;  in ns2_led_register()
205 	fwnode_property_read_u32_array(node, "modes-map", (void *)modval,  in ns2_led_register()
208 	rwlock_init(&led->rw_lock);  in ns2_led_register()
210 	led->cdev.blink_set = NULL;  in ns2_led_register()
211 	led->cdev.flags |= LED_CORE_SUSPENDRESUME;  in ns2_led_register()
212 	led->cdev.groups = ns2_led_groups;  in ns2_led_register()
213 	led->can_sleep = gpiod_cansleep(led->cmd) || gpiod_cansleep(led->slow);  in ns2_led_register()
214 	if (led->can_sleep)  in ns2_led_register()
215 		led->cdev.brightness_set_blocking = ns2_led_set_blocking;  in ns2_led_register()
217 		led->cdev.brightness_set = ns2_led_set;  in ns2_led_register()
218 	led->num_modes = nmodes;  in ns2_led_register()
219 	led->modval = modval;  in ns2_led_register()
226 	led->sata = (mode == NS_V2_LED_SATA) ? 1 : 0;  in ns2_led_register()
227 	led->cdev.brightness = (mode == NS_V2_LED_OFF) ? LED_OFF : LED_FULL;  in ns2_led_register()
231 	ret = devm_led_classdev_register_ext(dev, &led->cdev, &init_data);  in ns2_led_register()
240 	struct device *dev = &pdev->dev;  in ns2_led_probe()
248 		return -ENODEV;  in ns2_led_probe()
252 		return -ENOMEM;  in ns2_led_probe()
266 	{ .compatible = "lacie,ns2-leds", },
274 		.name		= "leds-ns2",
284 MODULE_ALIAS("platform:leds-ns2");