1 // SPDX-License-Identifier: GPL-2.0+
3 * Copyright (c) 2013 Corscience GmbH & Co.KG
4 * Andreas Bießmann <andreas.biessmann@corscience.de>
7 #include <status_led.h>
9 #include <asm/arch/cpu.h>
11 #include <asm/arch/sys_proto.h>
14 #define TRICORDER_STATUS_LED_YELLOW 42
15 #define TRICORDER_STATUS_LED_GREEN 43
17 void __led_init(led_id_t mask
, int state
)
19 __led_set(mask
, state
);
22 void __led_toggle(led_id_t mask
)
25 #ifdef CONFIG_LED_STATUS0
26 if (!toggle_gpio
&& CONFIG_LED_STATUS_BIT
& mask
)
27 toggle_gpio
= TRICORDER_STATUS_LED_GREEN
;
29 #ifdef CONFIG_LED_STATUS1
30 if (!toggle_gpio
&& CONFIG_LED_STATUS_BIT1
& mask
)
31 toggle_gpio
= TRICORDER_STATUS_LED_YELLOW
;
33 #ifdef CONFIG_LED_STATUS2
34 if (!toggle_gpio
&& CONFIG_LED_STATUS_BIT2
& mask
) {
36 twl4030_i2c_read_u8(TWL4030_CHIP_LED
, TWL4030_LED_LEDEN
,
38 val
^= (TWL4030_LED_LEDEN_LEDAON
| TWL4030_LED_LEDEN_LEDAPWM
);
39 twl4030_i2c_write_u8(TWL4030_CHIP_LED
, TWL4030_LED_LEDEN
,
45 gpio_request(toggle_gpio
, "");
46 state
= gpio_get_value(toggle_gpio
);
47 gpio_set_value(toggle_gpio
, !state
);
51 void __led_set(led_id_t mask
, int state
)
53 #ifdef CONFIG_LED_STATUS0
54 if (CONFIG_LED_STATUS_BIT
& mask
) {
55 gpio_request(TRICORDER_STATUS_LED_GREEN
, "");
56 gpio_direction_output(TRICORDER_STATUS_LED_GREEN
, 0);
57 gpio_set_value(TRICORDER_STATUS_LED_GREEN
, state
);
60 #ifdef CONFIG_LED_STATUS1
61 if (CONFIG_LED_STATUS_BIT1
& mask
) {
62 gpio_request(TRICORDER_STATUS_LED_YELLOW
, "");
63 gpio_direction_output(TRICORDER_STATUS_LED_YELLOW
, 0);
64 gpio_set_value(TRICORDER_STATUS_LED_YELLOW
, state
);
67 #ifdef CONFIG_LED_STATUS2
68 if (CONFIG_LED_STATUS_BIT2
& mask
) {
69 if (CONFIG_LED_STATUS_OFF
== state
)
70 twl4030_i2c_write_u8(TWL4030_CHIP_LED
,
71 TWL4030_LED_LEDEN
, 0);
73 twl4030_i2c_write_u8(TWL4030_CHIP_LED
,
75 (TWL4030_LED_LEDEN_LEDAON
|
76 TWL4030_LED_LEDEN_LEDAPWM
));