1 // SPDX-License-Identifier: GPL-2.0+
4 * Atmel Nordic AB <www.atmel.com>
5 * Ulf Samuelsson <ulf@atmel.com>
8 * Andreas Bießmann <andreas@biessmann.org>
13 #include <asm/arch/hardware.h>
14 #include <asm/arch/clk.h>
15 #include <asm/arch/at91_pio.h>
16 #include <status_led.h>
18 /* bit mask in PIO port B */
19 #define GREEN_LED (1<<0)
20 #define YELLOW_LED (1<<1)
21 #define RED_LED (1<<2)
23 void green_led_on(void)
25 at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO;
26 writel(GREEN_LED, &pio->piob.codr);
29 void yellow_led_on(void)
31 at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO;
32 writel(YELLOW_LED, &pio->piob.codr);
37 at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO;
38 writel(RED_LED, &pio->piob.codr);
41 void green_led_off(void)
43 at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO;
44 writel(GREEN_LED, &pio->piob.sodr);
47 void yellow_led_off(void)
49 at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO;
50 writel(YELLOW_LED, &pio->piob.sodr);
53 void red_led_off(void)
55 at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO;
56 writel(RED_LED, &pio->piob.sodr);
59 void coloured_LED_init (void)
61 at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO;
63 at91_periph_clk_enable(ATMEL_ID_PIOB);
65 /* Disable peripherals on LEDs */
66 writel(GREEN_LED | YELLOW_LED | RED_LED, &pio->piob.per);
67 /* Enable pins as outputs */
68 writel(GREEN_LED | YELLOW_LED | RED_LED, &pio->piob.oer);
69 /* Turn all LEDs OFF */
70 writel(GREEN_LED | YELLOW_LED | RED_LED, &pio->piob.sodr);