170d8c944SJason Kridner /*
270d8c944SJason Kridner * Copyright (c) 2010 Texas Instruments, Inc.
370d8c944SJason Kridner * Jason Kridner <jkridner@beagleboard.org>
470d8c944SJason Kridner *
51a459660SWolfgang Denk * SPDX-License-Identifier: GPL-2.0+
670d8c944SJason Kridner */
770d8c944SJason Kridner #include <common.h>
870d8c944SJason Kridner #include <status_led.h>
970d8c944SJason Kridner #include <asm/arch/cpu.h>
1070d8c944SJason Kridner #include <asm/io.h>
1170d8c944SJason Kridner #include <asm/arch/sys_proto.h>
1284c3b631SSanjeev Premi #include <asm/gpio.h>
1370d8c944SJason Kridner
1470d8c944SJason Kridner /* GPIO pins for the LEDs */
15f87824efSJason Kridner #define BEAGLE_LED_USR0 150
16f87824efSJason Kridner #define BEAGLE_LED_USR1 149
1770d8c944SJason Kridner
18*2d8d190cSUri Mashiach #ifdef CONFIG_LED_STATUS_GREEN
green_led_off(void)192d3be7c4SJason Kridner void green_led_off(void)
2070d8c944SJason Kridner {
21*2d8d190cSUri Mashiach __led_set(CONFIG_LED_STATUS_GREEN, 0);
2270d8c944SJason Kridner }
2370d8c944SJason Kridner
green_led_on(void)242d3be7c4SJason Kridner void green_led_on(void)
2570d8c944SJason Kridner {
26*2d8d190cSUri Mashiach __led_set(CONFIG_LED_STATUS_GREEN, 1);
2770d8c944SJason Kridner }
2870d8c944SJason Kridner #endif
2970d8c944SJason Kridner
get_led_gpio(led_id_t mask)30b3f4ca11SSimon Glass static int get_led_gpio(led_id_t mask)
31b3f4ca11SSimon Glass {
32*2d8d190cSUri Mashiach #ifdef CONFIG_LED_STATUS0
33*2d8d190cSUri Mashiach if (CONFIG_LED_STATUS_BIT & mask)
34b3f4ca11SSimon Glass return BEAGLE_LED_USR0;
35b3f4ca11SSimon Glass #endif
36*2d8d190cSUri Mashiach #ifdef CONFIG_LED_STATUS1
37*2d8d190cSUri Mashiach if (CONFIG_LED_STATUS_BIT1 & mask)
38b3f4ca11SSimon Glass return BEAGLE_LED_USR1;
39b3f4ca11SSimon Glass #endif
40b3f4ca11SSimon Glass
41b3f4ca11SSimon Glass return 0;
42b3f4ca11SSimon Glass }
43b3f4ca11SSimon Glass
__led_init(led_id_t mask,int state)4470d8c944SJason Kridner void __led_init (led_id_t mask, int state)
4570d8c944SJason Kridner {
46b3f4ca11SSimon Glass int toggle_gpio;
47b3f4ca11SSimon Glass
48b3f4ca11SSimon Glass toggle_gpio = get_led_gpio(mask);
49b3f4ca11SSimon Glass
50b3f4ca11SSimon Glass if (toggle_gpio && !gpio_request(toggle_gpio, "led"))
5170d8c944SJason Kridner __led_set(mask, state);
5270d8c944SJason Kridner }
5370d8c944SJason Kridner
__led_toggle(led_id_t mask)5470d8c944SJason Kridner void __led_toggle (led_id_t mask)
5570d8c944SJason Kridner {
56b3f4ca11SSimon Glass int state, toggle_gpio;
57b3f4ca11SSimon Glass
58b3f4ca11SSimon Glass toggle_gpio = get_led_gpio(mask);
59b8bc8973SJoel A Fernandes if (toggle_gpio) {
6084c3b631SSanjeev Premi state = gpio_get_value(toggle_gpio);
61b3f4ca11SSimon Glass gpio_direction_output(toggle_gpio, !state);
62b8bc8973SJoel A Fernandes }
6370d8c944SJason Kridner }
6470d8c944SJason Kridner
__led_set(led_id_t mask,int state)6570d8c944SJason Kridner void __led_set (led_id_t mask, int state)
6670d8c944SJason Kridner {
67b3f4ca11SSimon Glass int toggle_gpio;
68b3f4ca11SSimon Glass
69b3f4ca11SSimon Glass toggle_gpio = get_led_gpio(mask);
70b3f4ca11SSimon Glass if (toggle_gpio)
71b3f4ca11SSimon Glass gpio_direction_output(toggle_gpio, state);
7270d8c944SJason Kridner }
73