1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
|
// 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);
}
}
|
