1 files changed, 56 insertions, 0 deletions
diff --git a/board/bf526-ezbrd/status-led.c b/board/bf526-ezbrd/status-led.c
new file mode 100644
index 0000000..6327022
--- /dev/null
+++ b/board/bf526-ezbrd/status-led.c
@@ -0,0 +1,56 @@
+/*
+ * U-boot - status leds
+ *
+ * Copyright (c) 2005-2009 Analog Devices Inc.
+ *
+ * Licensed under the GPL-2 or later.
+ */
+
+#include <common.h>
+#include <config.h>
+#include <command.h>
+#include <status_led.h>
+
+static void set_led_f(int pf, int state)
+{
+	switch (state) {
+		case STATUS_LED_OFF:      bfin_write_PORTFIO_CLEAR(pf);  break;
+		case STATUS_LED_BLINKING: bfin_write_PORTFIO_TOGGLE(pf); break;
+		case STATUS_LED_ON:       bfin_write_PORTFIO_SET(pf);    break;
+	}
+}
+static void set_led_g(int pf, int state)
+{
+	switch (state) {
+		case STATUS_LED_OFF:      bfin_write_PORTGIO_CLEAR(pf);  break;
+		case STATUS_LED_BLINKING: bfin_write_PORTGIO_TOGGLE(pf); break;
+		case STATUS_LED_ON:       bfin_write_PORTGIO_SET(pf);    break;
+	}
+}
+
+static void set_leds(led_id_t mask, int state)
+{
+	if (mask & 0x1) set_led_f(PF8, state);
+	if (mask & 0x2) set_led_g(PG11, state);
+	if (mask & 0x4) set_led_g(PG12, state);
+}
+
+void __led_init(led_id_t mask, int state)
+{
+	bfin_write_PORTF_FER(bfin_read_PORTF_FER() & ~(PF8));
+	bfin_write_PORTG_FER(bfin_read_PORTG_FER() & ~(PG11 | PG12));
+	bfin_write_PORTFIO_INEN(bfin_read_PORTFIO_INEN() & ~(PF8));
+	bfin_write_PORTGIO_INEN(bfin_read_PORTGIO_INEN() & ~(PG11 | PG12));
+	bfin_write_PORTFIO_DIR(bfin_read_PORTFIO_DIR() | (PF8));
+	bfin_write_PORTGIO_DIR(bfin_read_PORTGIO_DIR() | (PG11 | PG12));
+}
+
+void __led_set(led_id_t mask, int state)
+{
+	set_leds(mask, state);
+}
+
+void __led_toggle(led_id_t mask)
+{
+	set_leds(mask, STATUS_LED_BLINKING);
+}