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
|
/* Copyright 2022 The Chromium OS Authors. All rights reserved.
* Use of this source code is governed by a BSD-style license that can be
* found in the LICENSE file.
*
* GPIO LED control.
*/
#include "ec_commands.h"
#include "led.h"
#include "util.h"
#include <devicetree.h>
#include <drivers/gpio.h>
#include <logging/log.h>
#if DT_HAS_COMPAT_STATUS_OKAY(COMPAT_GPIO_LED)
LOG_MODULE_REGISTER(gpio_led, LOG_LEVEL_ERR);
#define LED_PIN_COUNT (LED_COLOR_COUNT - 1)
/*
* Struct defining LED GPIO pin and value to set.
*/
struct gpio_pin_t {
enum gpio_signal signal;
int val;
};
/*
* Pin node contains LED color and array of GPIO pins
* to alter in order to enable the given color.
*/
struct led_pins_node_t {
/* Link between color and pins node */
int led_color;
/* Brightness Range color, only used by ectool funcs for testing */
enum ec_led_colors br_color;
/* Array of GPIO pins to set to enable particular color */
struct gpio_pin_t gpio_pins[LED_PIN_COUNT];
};
#define SET_PIN(node_id, prop, i) \
{ \
.signal = GPIO_SIGNAL(DT_PHANDLE_BY_IDX(node_id, prop, i)), \
.val = DT_PHA_BY_IDX(node_id, prop, i, value) \
},
#define SET_GPIO_PIN(node_id) \
{ \
DT_FOREACH_PROP_ELEM(node_id, led_pins, SET_PIN) \
}
#define SET_PIN_NODE(node_id) \
{ \
.led_color = GET_PROP(node_id, led_color), \
.br_color = GET_BR_COLOR(node_id, br_color), \
.gpio_pins = SET_GPIO_PIN(node_id) \
},
struct led_pins_node_t pins_node[] = {
DT_FOREACH_CHILD(GPIO_LED_PINS_NODE, SET_PIN_NODE)
};
/*
* Iterate through LED pins nodes to find the color matching node.
* Set all the GPIO pins defined in the node to the defined value,
* to enable the color.
*/
void led_set_color(enum led_color color)
{
for (int i = 0; i < LED_COLOR_COUNT; i++) {
if (pins_node[i].led_color == color) {
for (int j = 0; j < LED_PIN_COUNT; j++) {
gpio_pin_set_dt(gpio_get_dt_spec(
pins_node[i].gpio_pins[j].signal),
pins_node[i].gpio_pins[j].val);
}
}
}
}
void led_get_brightness_range(enum ec_led_id led_id, uint8_t *brightness_range)
{
for (int i = 0; i < ARRAY_SIZE(pins_node); i++) {
int br_color = pins_node[i].br_color;
if (br_color != -1)
brightness_range[br_color] = 1;
}
}
int led_set_brightness(enum ec_led_id led_id, const uint8_t *brightness)
{
bool color_set = false;
for (int i = 0; i < ARRAY_SIZE(pins_node); i++) {
int br_color = pins_node[i].br_color;
if ((br_color != -1) && (brightness[br_color] != 0)) {
color_set = true;
led_set_color(pins_node[i].led_color);
}
}
/* If no color was set, turn off the LED */
if (!color_set)
led_set_color(LED_OFF);
return EC_SUCCESS;
}
#endif /* DT_HAS_COMPAT_STATUS_OKAY(COMPAT_GPIO_LED) */
|