diff options
author | Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com> | 2015-01-13 07:33:06 +0100 |
---|---|---|
committer | Sascha Hauer <s.hauer@pengutronix.de> | 2015-02-04 15:49:58 +0100 |
commit | ce6fff7c8b129c563be24bd8ca24b1393835b31d (patch) | |
tree | 6c90780f2186f39e3209e95e09a24be1e1de1a06 | |
parent | 50c06dde104fc92169aa6401a3b798cffb4bbd07 (diff) | |
download | barebox-ce6fff7c8b129c563be24bd8ca24b1393835b31d.tar.gz |
raspberry-pi: add leds support
Signed-off-by: Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com>
Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
-rw-r--r-- | arch/arm/boards/raspberry-pi/rpi.c | 55 |
1 files changed, 55 insertions, 0 deletions
diff --git a/arch/arm/boards/raspberry-pi/rpi.c b/arch/arm/boards/raspberry-pi/rpi.c index 6efbf48be4..108bd28d09 100644 --- a/arch/arm/boards/raspberry-pi/rpi.c +++ b/arch/arm/boards/raspberry-pi/rpi.c @@ -21,6 +21,8 @@ #include <linux/clkdev.h> #include <envfs.h> #include <malloc.h> +#include <gpio.h> +#include <led.h> #include <asm/armlinux.h> #include <generated/mach-types.h> @@ -87,6 +89,49 @@ static int rpi_register_clkdev(u32 clock_id, const char *name) } +static struct gpio_led leds[] = { + { + .gpio = -EINVAL, + .led = { + .name = "ACT", + }, + }, { + .gpio = -EINVAL, + .led = { + .name = "PWR", + }, + }, +}; + +static void rpi_add_led(void) +{ + int i; + struct gpio_led *l; + + for (i = 0; i < ARRAY_SIZE(leds); i++) { + l = &leds[i]; + + if (gpio_is_valid(l->gpio)) + led_gpio_register(l); + } + + l = &leds[0]; + if (gpio_is_valid(l->gpio)) + led_set_trigger(LED_TRIGGER_HEARTBEAT, &l->led); +} + +static void rpi_b_plus_init(void) +{ + leds[0].gpio = 47; + leds[1].gpio = 35; +} + +static void rpi_b_init(void) +{ + leds[0].gpio = 16; + leds[0].active_low = 1; +} + #define RPI_MODEL(_id, _name, _init) \ [_id] = { \ .name = _name,\ @@ -159,6 +204,15 @@ unknown_rev: barebox_set_model("RaspberryPi (BCM2835/ARM1176JZF-S)"); } +static void rpi_model_init(void) +{ + if (!models[rpi_board_rev].init) + return; + + models[rpi_board_rev].init(); + rpi_add_led(); +} + static int rpi_mem_init(void) { u32 size = 0; @@ -219,6 +273,7 @@ static int rpi_env_init(void) static int rpi_devices_init(void) { + rpi_model_init(); bcm2835_register_mci(); bcm2835_register_fb(); armlinux_set_architecture(MACH_TYPE_BCM2708); |