1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * Copyright (C) 2010, 2009 Matthias Kaehlcke <matthias@kaehlcke.net>
3*4882a593Smuzhiyun *
4*4882a593Smuzhiyun * SPDX-License-Identifier: GPL-2.0+
5*4882a593Smuzhiyun */
6*4882a593Smuzhiyun
7*4882a593Smuzhiyun #include <asm/io.h>
8*4882a593Smuzhiyun #include <asm/arch/ep93xx.h>
9*4882a593Smuzhiyun #include <config.h>
10*4882a593Smuzhiyun #include <status_led.h>
11*4882a593Smuzhiyun
12*4882a593Smuzhiyun static uint8_t saved_state[2] = {CONFIG_LED_STATUS_OFF, CONFIG_LED_STATUS_OFF};
13*4882a593Smuzhiyun static uint32_t gpio_pin[2] = {1 << CONFIG_LED_STATUS_GREEN,
14*4882a593Smuzhiyun 1 << CONFIG_LED_STATUS_RED};
15*4882a593Smuzhiyun
switch_LED_on(uint8_t led)16*4882a593Smuzhiyun static inline void switch_LED_on(uint8_t led)
17*4882a593Smuzhiyun {
18*4882a593Smuzhiyun register struct gpio_regs *gpio = (struct gpio_regs *)GPIO_BASE;
19*4882a593Smuzhiyun
20*4882a593Smuzhiyun writel(readl(&gpio->pedr) | gpio_pin[led], &gpio->pedr);
21*4882a593Smuzhiyun saved_state[led] = CONFIG_LED_STATUS_ON;
22*4882a593Smuzhiyun }
23*4882a593Smuzhiyun
switch_LED_off(uint8_t led)24*4882a593Smuzhiyun static inline void switch_LED_off(uint8_t led)
25*4882a593Smuzhiyun {
26*4882a593Smuzhiyun register struct gpio_regs *gpio = (struct gpio_regs *)GPIO_BASE;
27*4882a593Smuzhiyun
28*4882a593Smuzhiyun writel(readl(&gpio->pedr) & ~gpio_pin[led], &gpio->pedr);
29*4882a593Smuzhiyun saved_state[led] = CONFIG_LED_STATUS_OFF;
30*4882a593Smuzhiyun }
31*4882a593Smuzhiyun
red_led_on(void)32*4882a593Smuzhiyun void red_led_on(void)
33*4882a593Smuzhiyun {
34*4882a593Smuzhiyun switch_LED_on(CONFIG_LED_STATUS_RED);
35*4882a593Smuzhiyun }
36*4882a593Smuzhiyun
red_led_off(void)37*4882a593Smuzhiyun void red_led_off(void)
38*4882a593Smuzhiyun {
39*4882a593Smuzhiyun switch_LED_off(CONFIG_LED_STATUS_RED);
40*4882a593Smuzhiyun }
41*4882a593Smuzhiyun
green_led_on(void)42*4882a593Smuzhiyun void green_led_on(void)
43*4882a593Smuzhiyun {
44*4882a593Smuzhiyun switch_LED_on(CONFIG_LED_STATUS_GREEN);
45*4882a593Smuzhiyun }
46*4882a593Smuzhiyun
green_led_off(void)47*4882a593Smuzhiyun void green_led_off(void)
48*4882a593Smuzhiyun {
49*4882a593Smuzhiyun switch_LED_off(CONFIG_LED_STATUS_GREEN);
50*4882a593Smuzhiyun }
51*4882a593Smuzhiyun
__led_init(led_id_t mask,int state)52*4882a593Smuzhiyun void __led_init(led_id_t mask, int state)
53*4882a593Smuzhiyun {
54*4882a593Smuzhiyun __led_set(mask, state);
55*4882a593Smuzhiyun }
56*4882a593Smuzhiyun
__led_toggle(led_id_t mask)57*4882a593Smuzhiyun void __led_toggle(led_id_t mask)
58*4882a593Smuzhiyun {
59*4882a593Smuzhiyun if (CONFIG_LED_STATUS_RED == mask) {
60*4882a593Smuzhiyun if (CONFIG_LED_STATUS_ON == saved_state[CONFIG_LED_STATUS_RED])
61*4882a593Smuzhiyun red_led_off();
62*4882a593Smuzhiyun else
63*4882a593Smuzhiyun red_led_on();
64*4882a593Smuzhiyun } else if (CONFIG_LED_STATUS_GREEN == mask) {
65*4882a593Smuzhiyun if (CONFIG_LED_STATUS_ON ==
66*4882a593Smuzhiyun saved_state[CONFIG_LED_STATUS_GREEN])
67*4882a593Smuzhiyun green_led_off();
68*4882a593Smuzhiyun else
69*4882a593Smuzhiyun green_led_on();
70*4882a593Smuzhiyun }
71*4882a593Smuzhiyun }
72*4882a593Smuzhiyun
__led_set(led_id_t mask,int state)73*4882a593Smuzhiyun void __led_set(led_id_t mask, int state)
74*4882a593Smuzhiyun {
75*4882a593Smuzhiyun if (CONFIG_LED_STATUS_RED == mask) {
76*4882a593Smuzhiyun if (CONFIG_LED_STATUS_ON == state)
77*4882a593Smuzhiyun red_led_on();
78*4882a593Smuzhiyun else
79*4882a593Smuzhiyun red_led_off();
80*4882a593Smuzhiyun } else if (CONFIG_LED_STATUS_GREEN == mask) {
81*4882a593Smuzhiyun if (CONFIG_LED_STATUS_ON == state)
82*4882a593Smuzhiyun green_led_on();
83*4882a593Smuzhiyun else
84*4882a593Smuzhiyun green_led_off();
85*4882a593Smuzhiyun }
86*4882a593Smuzhiyun }
87