1*4882a593Smuzhiyun /* 2*4882a593Smuzhiyun * (C) Copyright 2006 3*4882a593Smuzhiyun * Atmel Nordic AB <www.atmel.com> 4*4882a593Smuzhiyun * Ulf Samuelsson <ulf@atmel.com> 5*4882a593Smuzhiyun * 6*4882a593Smuzhiyun * (C) Copyright 2010 7*4882a593Smuzhiyun * Andreas Bießmann <andreas@biessmann.org> 8*4882a593Smuzhiyun * 9*4882a593Smuzhiyun * SPDX-License-Identifier: GPL-2.0+ 10*4882a593Smuzhiyun */ 11*4882a593Smuzhiyun 12*4882a593Smuzhiyun #include <common.h> 13*4882a593Smuzhiyun #include <asm/io.h> 14*4882a593Smuzhiyun #include <asm/arch/hardware.h> 15*4882a593Smuzhiyun #include <asm/arch/clk.h> 16*4882a593Smuzhiyun #include <asm/arch/at91_pio.h> 17*4882a593Smuzhiyun #include <status_led.h> 18*4882a593Smuzhiyun 19*4882a593Smuzhiyun /* bit mask in PIO port B */ 20*4882a593Smuzhiyun #define GREEN_LED (1<<0) 21*4882a593Smuzhiyun #define YELLOW_LED (1<<1) 22*4882a593Smuzhiyun #define RED_LED (1<<2) 23*4882a593Smuzhiyun green_led_on(void)24*4882a593Smuzhiyunvoid green_led_on(void) 25*4882a593Smuzhiyun { 26*4882a593Smuzhiyun at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO; 27*4882a593Smuzhiyun writel(GREEN_LED, &pio->piob.codr); 28*4882a593Smuzhiyun } 29*4882a593Smuzhiyun yellow_led_on(void)30*4882a593Smuzhiyunvoid yellow_led_on(void) 31*4882a593Smuzhiyun { 32*4882a593Smuzhiyun at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO; 33*4882a593Smuzhiyun writel(YELLOW_LED, &pio->piob.codr); 34*4882a593Smuzhiyun } 35*4882a593Smuzhiyun red_led_on(void)36*4882a593Smuzhiyunvoid red_led_on(void) 37*4882a593Smuzhiyun { 38*4882a593Smuzhiyun at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO; 39*4882a593Smuzhiyun writel(RED_LED, &pio->piob.codr); 40*4882a593Smuzhiyun } 41*4882a593Smuzhiyun green_led_off(void)42*4882a593Smuzhiyunvoid green_led_off(void) 43*4882a593Smuzhiyun { 44*4882a593Smuzhiyun at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO; 45*4882a593Smuzhiyun writel(GREEN_LED, &pio->piob.sodr); 46*4882a593Smuzhiyun } 47*4882a593Smuzhiyun yellow_led_off(void)48*4882a593Smuzhiyunvoid yellow_led_off(void) 49*4882a593Smuzhiyun { 50*4882a593Smuzhiyun at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO; 51*4882a593Smuzhiyun writel(YELLOW_LED, &pio->piob.sodr); 52*4882a593Smuzhiyun } 53*4882a593Smuzhiyun red_led_off(void)54*4882a593Smuzhiyunvoid red_led_off(void) 55*4882a593Smuzhiyun { 56*4882a593Smuzhiyun at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO; 57*4882a593Smuzhiyun writel(RED_LED, &pio->piob.sodr); 58*4882a593Smuzhiyun } 59*4882a593Smuzhiyun coloured_LED_init(void)60*4882a593Smuzhiyunvoid coloured_LED_init (void) 61*4882a593Smuzhiyun { 62*4882a593Smuzhiyun at91_pio_t *pio = (at91_pio_t *)ATMEL_BASE_PIO; 63*4882a593Smuzhiyun 64*4882a593Smuzhiyun at91_periph_clk_enable(ATMEL_ID_PIOB); 65*4882a593Smuzhiyun 66*4882a593Smuzhiyun /* Disable peripherals on LEDs */ 67*4882a593Smuzhiyun writel(GREEN_LED | YELLOW_LED | RED_LED, &pio->piob.per); 68*4882a593Smuzhiyun /* Enable pins as outputs */ 69*4882a593Smuzhiyun writel(GREEN_LED | YELLOW_LED | RED_LED, &pio->piob.oer); 70*4882a593Smuzhiyun /* Turn all LEDs OFF */ 71*4882a593Smuzhiyun writel(GREEN_LED | YELLOW_LED | RED_LED, &pio->piob.sodr); 72*4882a593Smuzhiyun } 73