3 * Atmel Nordic AB <www.atmel.com>
4 * Ulf Samuelsson <ulf@atmel.com>
7 * Andreas Bießmann <andreas.devel@gmail.com>
9 * See file CREDITS for list of people who contributed to this
12 * This program is free software; you can redistribute it and/or
13 * modify it under the terms of the GNU General Public License as
14 * published by the Free Software Foundation; either version 2 of
15 * the License, or (at your option) any later version.
17 * This program is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU General Public License for more details.
22 * You should have received a copy of the GNU General Public License
23 * along with this program; if not, write to the Free Software
24 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
30 #include <asm/arch/hardware.h>
31 #include <asm/arch/at91_pmc.h>
32 #include <asm/arch/at91_pio.h>
34 /* bit mask in PIO port B */
35 #define GREEN_LED (1<<0)
36 #define YELLOW_LED (1<<1)
37 #define RED_LED (1<<2)
39 void green_led_on(void)
41 at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO;
42 writel(GREEN_LED, &pio->piob.codr);
45 void yellow_led_on(void)
47 at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO;
48 writel(YELLOW_LED, &pio->piob.codr);
53 at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO;
54 writel(RED_LED, &pio->piob.codr);
57 void green_led_off(void)
59 at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO;
60 writel(GREEN_LED, &pio->piob.sodr);
63 void yellow_led_off(void)
65 at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO;
66 writel(YELLOW_LED, &pio->piob.sodr);
69 void red_led_off(void)
71 at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO;
72 writel(RED_LED, &pio->piob.sodr);
75 void coloured_LED_init (void)
77 at91_pmc_t *pmc = (at91_pmc_t *)ATMEL_BASE_PMC;
78 at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO;
80 /* Enable PIOB clock */
81 writel(1 << ATMEL_ID_PIOB, &pmc->pcer);
83 /* Disable peripherals on LEDs */
84 writel(GREEN_LED | YELLOW_LED | RED_LED, &pio->piob.per);
85 /* Enable pins as outputs */
86 writel(GREEN_LED | YELLOW_LED | RED_LED, &pio->piob.oer);
87 /* Turn all LEDs OFF */
88 writel(GREEN_LED | YELLOW_LED | RED_LED, &pio->piob.sodr);