at91rm9200ek: add leds support

Signed-off-by: Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com>
Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>

1 files changed, 38 insertions, 0 deletions

diff --git a/arch/arm/boards/at91rm9200ek/init.c b/arch/arm/boards/at91rm9200ek/init.c
index 308c066aac..3a5da53ce4 100644
--- a/arch/arm/boards/at91rm9200ek/init.c
+++ b/arch/arm/boards/at91rm9200ek/init.c
@@ -51,6 +51,43 @@ static struct at91_usbh_data ek_usbh_data = {
 	.ports		= 2,
 };
 
+#ifdef CONFIG_LED_GPIO
+struct gpio_led ek_leds[] = {
+	{
+		.gpio		= AT91_PIN_PB0,
+		.active_low	= 1,
+		.led = {
+			.name = "green",
+		},
+	}, {
+		.gpio		= AT91_PIN_PB1,
+		.active_low	= 1,
+		.led = {
+			.name = "yellow",
+		},
+	}, {
+		.gpio		= AT91_PIN_PB2,
+		.active_low	= 1,
+		.led = {
+			.name = "red",
+		},
+	},
+};
+
+static void ek_device_add_leds(void)
+{
+	int i;
+
+	for (i = 0; i < ARRAY_SIZE(ek_leds); i++) {
+		at91_set_gpio_output(ek_leds[i].gpio, ek_leds[i].active_low);
+		led_gpio_register(&ek_leds[i]);
+	}
+	led_set_trigger(LED_TRIGGER_HEARTBEAT, &ek_leds[1].led);
+}
+#else
+static void ek_device_add_leds(void) {}
+#endif
+
 static int at91rm9200ek_devices_init(void)
 {
 	/*
@@ -64,6 +101,7 @@ static int at91rm9200ek_devices_init(void)
 	add_cfi_flash_device(0, AT91_CHIPSELECT_0, 0, 0);
 	/* USB Host */
 	at91_add_device_usbh_ohci(&ek_usbh_data);
+	ek_device_add_leds();
 
 #if defined(CONFIG_DRIVER_CFI) || defined(CONFIG_DRIVER_CFI_OLD)
 	devfs_add_partition("nor0", 0x00000, 0x40000, PARTITION_FIXED, "self");