| // 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 "common.h" |
| |
| static int int3472_pled_set(struct led_classdev *led_cdev, |
| enum led_brightness brightness) |
| { |
| struct int3472_discrete_device *int3472 = |
| container_of(led_cdev, struct int3472_discrete_device, pled.classdev); |
| |
| gpiod_set_value_cansleep(int3472->pled.gpio, brightness); |
| return 0; |
| } |
| |
| int skl_int3472_register_pled(struct int3472_discrete_device *int3472, struct gpio_desc *gpio) |
| { |
| char *p; |
| int ret; |
| |
| if (int3472->pled.classdev.dev) |
| return -EBUSY; |
| |
| int3472->pled.gpio = gpio; |
| |
| /* Generate the name, replacing the ':' in the ACPI devname with '_' */ |
| snprintf(int3472->pled.name, sizeof(int3472->pled.name), |
| "%s::privacy_led", acpi_dev_name(int3472->sensor)); |
| p = strchr(int3472->pled.name, ':'); |
| if (p) |
| *p = '_'; |
| |
| int3472->pled.classdev.name = int3472->pled.name; |
| int3472->pled.classdev.max_brightness = 1; |
| int3472->pled.classdev.brightness_set_blocking = int3472_pled_set; |
| |
| ret = led_classdev_register(int3472->dev, &int3472->pled.classdev); |
| if (ret) |
| return ret; |
| |
| int3472->pled.lookup.provider = int3472->pled.name; |
| int3472->pled.lookup.dev_id = int3472->sensor_name; |
| int3472->pled.lookup.con_id = "privacy-led"; |
| led_add_lookup(&int3472->pled.lookup); |
| |
| return 0; |
| } |
| |
| void skl_int3472_unregister_pled(struct int3472_discrete_device *int3472) |
| { |
| if (IS_ERR_OR_NULL(int3472->pled.classdev.dev)) |
| return; |
| |
| led_remove_lookup(&int3472->pled.lookup); |
| led_classdev_unregister(&int3472->pled.classdev); |
| } |