tricorder: add led support
[karo-tx-uboot.git] / board / corscience / tricorder / led.c
1 /*
2  * Copyright (c) 2013 Corscience GmbH & Co.KG
3  * Andreas BieƟmann <andreas.biessmann@corscience.de>
4  *
5  * SPDX-License-Identifier:     GPL-2.0+
6  */
7 #include <common.h>
8 #include <status_led.h>
9 #include <twl4030.h>
10 #include <asm/arch/cpu.h>
11 #include <asm/io.h>
12 #include <asm/arch/sys_proto.h>
13 #include <asm/gpio.h>
14
15 #define TRICORDER_STATUS_LED_YELLOW 42
16 #define TRICORDER_STATUS_LED_GREEN  43
17
18 void __led_init(led_id_t mask, int state)
19 {
20         __led_set(mask, state);
21 }
22
23 void __led_toggle(led_id_t mask)
24 {
25         int toggle_gpio = 0;
26 #ifdef STATUS_LED_BIT
27         if (!toggle_gpio && STATUS_LED_BIT & mask)
28                 toggle_gpio = TRICORDER_STATUS_LED_GREEN;
29 #endif
30 #ifdef STATUS_LED_BIT1
31         if (!toggle_gpio && STATUS_LED_BIT1 & mask)
32                 toggle_gpio = TRICORDER_STATUS_LED_YELLOW;
33 #endif
34 #ifdef STATUS_LED_BIT2
35         if (!toggle_gpio && STATUS_LED_BIT2 & mask) {
36                 uint8_t val;
37                 twl4030_i2c_read_u8(TWL4030_CHIP_LED, TWL4030_LED_LEDEN,
38                                     &val);
39                 val ^= (TWL4030_LED_LEDEN_LEDAON | TWL4030_LED_LEDEN_LEDAPWM);
40                 twl4030_i2c_write_u8(TWL4030_CHIP_LED, TWL4030_LED_LEDEN,
41                                      val);
42         }
43 #endif
44         if (toggle_gpio) {
45                 int state;
46                 gpio_request(toggle_gpio, "");
47                 state = gpio_get_value(toggle_gpio);
48                 gpio_set_value(toggle_gpio, !state);
49         }
50 }
51
52 void __led_set(led_id_t mask, int state)
53 {
54 #ifdef STATUS_LED_BIT
55         if (STATUS_LED_BIT & mask) {
56                 gpio_request(TRICORDER_STATUS_LED_GREEN, "");
57                 gpio_direction_output(TRICORDER_STATUS_LED_GREEN, 0);
58                 gpio_set_value(TRICORDER_STATUS_LED_GREEN, state);
59         }
60 #endif
61 #ifdef STATUS_LED_BIT1
62         if (STATUS_LED_BIT1 & mask) {
63                 gpio_request(TRICORDER_STATUS_LED_YELLOW, "");
64                 gpio_direction_output(TRICORDER_STATUS_LED_YELLOW, 0);
65                 gpio_set_value(TRICORDER_STATUS_LED_YELLOW, state);
66         }
67 #endif
68 #ifdef STATUS_LED_BIT2
69         if (STATUS_LED_BIT2 & mask) {
70                 if (STATUS_LED_OFF == state)
71                         twl4030_i2c_write_u8(TWL4030_CHIP_LED,
72                                              TWL4030_LED_LEDEN, 0);
73                 else
74                         twl4030_i2c_write_u8(TWL4030_CHIP_LED,
75                                              TWL4030_LED_LEDEN,
76                                              (TWL4030_LED_LEDEN_LEDAON |
77                                               TWL4030_LED_LEDEN_LEDAPWM));
78         }
79 #endif
80 }