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
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
|
// SPDX-License-Identifier: BSD-2-Clause OR GPL-2.0-or-later
/*
* Dell Wyse 3020 a.k.a. "Ariel" Embedded Controller LED Driver
*
* Copyright (C) 2020 Lubomir Rintel
*/
#include <linux/module.h>
#include <linux/leds.h>
#include <linux/regmap.h>
#include <linux/of_platform.h>
enum ec_index {
EC_BLUE_LED = 0x01,
EC_AMBER_LED = 0x02,
EC_GREEN_LED = 0x03,
};
enum {
EC_LED_OFF = 0x00,
EC_LED_STILL = 0x01,
EC_LED_FADE = 0x02,
EC_LED_BLINK = 0x03,
};
struct ariel_led {
struct regmap *ec_ram;
enum ec_index ec_index;
struct led_classdev led_cdev;
};
#define led_cdev_to_ariel_led(c) container_of(c, struct ariel_led, led_cdev)
static enum led_brightness ariel_led_get(struct led_classdev *led_cdev)
{
struct ariel_led *led = led_cdev_to_ariel_led(led_cdev);
unsigned int led_status = 0;
if (regmap_read(led->ec_ram, led->ec_index, &led_status))
return LED_OFF;
if (led_status == EC_LED_STILL)
return LED_FULL;
else
return LED_OFF;
}
static void ariel_led_set(struct led_classdev *led_cdev,
enum led_brightness brightness)
{
struct ariel_led *led = led_cdev_to_ariel_led(led_cdev);
if (brightness == LED_OFF)
regmap_write(led->ec_ram, led->ec_index, EC_LED_OFF);
else
regmap_write(led->ec_ram, led->ec_index, EC_LED_STILL);
}
static int ariel_blink_set(struct led_classdev *led_cdev,
unsigned long *delay_on, unsigned long *delay_off)
{
struct ariel_led *led = led_cdev_to_ariel_led(led_cdev);
if (*delay_on == 0 && *delay_off == 0)
return -EINVAL;
if (*delay_on == 0) {
regmap_write(led->ec_ram, led->ec_index, EC_LED_OFF);
} else if (*delay_off == 0) {
regmap_write(led->ec_ram, led->ec_index, EC_LED_STILL);
} else {
*delay_on = 500;
*delay_off = 500;
regmap_write(led->ec_ram, led->ec_index, EC_LED_BLINK);
}
return 0;
}
#define NLEDS 3
static int ariel_led_probe(struct platform_device *pdev)
{
struct device *dev = &pdev->dev;
struct ariel_led *leds;
struct regmap *ec_ram;
int ret;
int i;
ec_ram = dev_get_regmap(dev->parent, "ec_ram");
if (!ec_ram)
return -ENODEV;
leds = devm_kcalloc(dev, NLEDS, sizeof(*leds), GFP_KERNEL);
if (!leds)
return -ENOMEM;
leds[0].ec_index = EC_BLUE_LED;
leds[0].led_cdev.name = "blue:power";
leds[0].led_cdev.default_trigger = "default-on";
leds[1].ec_index = EC_AMBER_LED;
leds[1].led_cdev.name = "amber:status";
leds[2].ec_index = EC_GREEN_LED;
leds[2].led_cdev.name = "green:status";
leds[2].led_cdev.default_trigger = "default-on";
for (i = 0; i < NLEDS; i++) {
leds[i].ec_ram = ec_ram;
leds[i].led_cdev.brightness_get = ariel_led_get;
leds[i].led_cdev.brightness_set = ariel_led_set;
leds[i].led_cdev.blink_set = ariel_blink_set;
ret = devm_led_classdev_register(dev, &leds[i].led_cdev);
if (ret)
return ret;
}
return 0;
}
static struct platform_driver ariel_led_driver = {
.probe = ariel_led_probe,
.driver = {
.name = "dell-wyse-ariel-led",
},
};
module_platform_driver(ariel_led_driver);
MODULE_AUTHOR("Lubomir Rintel <lkundrak@v3.sk>");
MODULE_DESCRIPTION("Dell Wyse 3020 Status LEDs Driver");
MODULE_LICENSE("Dual BSD/GPL");
|
