| // SPDX-License-Identifier: GPL-2.0 | |
| /* Author: Hans de Goede <hdegoede@redhat.com> */ | |
| #include <linux/acpi.h> | |
| #include <linux/gpio/consumer.h> | |
| #include <linux/leds.h> | |
| #include <linux/platform_data/x86/int3472.h> | |
| static int int3472_led_set(struct led_classdev *led_cdev, enum led_brightness brightness) | |
| { | |
| struct int3472_led *led = container_of(led_cdev, struct int3472_led, classdev); | |
| gpiod_set_value_cansleep(led->gpio, brightness); | |
| return 0; | |
| } | |
| int skl_int3472_register_led(struct int3472_discrete_device *int3472, struct gpio_desc *gpio, | |
| const char *con_id) | |
| { | |
| struct int3472_led *led; | |
| char *p; | |
| int ret; | |
| if (int3472->n_leds >= INT3472_MAX_LEDS) | |
| return -ENOSPC; | |
| led = &int3472->leds[int3472->n_leds]; | |
| led->gpio = gpio; | |
| /* Generate the name, replacing the ':' in the ACPI devname with '_' */ | |
| snprintf(led->name, sizeof(led->name), | |
| "%s::%s_led", acpi_dev_name(int3472->sensor), con_id); | |
| p = strchr(led->name, ':'); | |
| if (p) | |
| *p = '_'; | |
| led->classdev.name = led->name; | |
| led->classdev.max_brightness = 1; | |
| led->classdev.brightness_set_blocking = int3472_led_set; | |
| ret = led_classdev_register(int3472->dev, &led->classdev); | |
| if (ret) | |
| return ret; | |
| led->lookup.provider = led->name; | |
| led->lookup.dev_id = int3472->sensor_name; | |
| led->lookup.con_id = con_id; | |
| led_add_lookup(&led->lookup); | |
| int3472->n_leds++; | |
| return 0; | |
| } | |
| void skl_int3472_unregister_leds(struct int3472_discrete_device *int3472) | |
| { | |
| for (unsigned int i = 0; i < int3472->n_leds; i++) { | |
| struct int3472_led *led = &int3472->leds[i]; | |
| led_remove_lookup(&led->lookup); | |
| led_classdev_unregister(&led->classdev); | |
| gpiod_put(led->gpio); | |
| } | |
| } |