board/taskit/stamp9g20/led.c

   1 /*
   2  * Copyright (c) 2009 Wind River Systems, Inc.
   3  * Tom Rix <Tom.Rix@windriver.com>
   4  * (C) Copyright 2009
   5  * Eric Benard <eric@eukrea.com>
   6  *
   7  * (C) Copyright 2012
   8  * Markus Hubig <mhubig@imko.de>
   9  * IMKO GmbH <www.imko.de>
  10  *
  11  * See file CREDITS for list of people who contributed to this
  12  * project.
  13  *
  14  * This program is free software; you can redistribute it and/or
  15  * modify it under the terms of the GNU General Public License as
  16  * published by the Free Software Foundation; either version 2 of
  17  * the License, or (at your option) any later version.
  18  *
  19  * This program is distributed in the hope that it will be useful,
  20  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  21  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  22  * GNU General Public License for more details.
  23  *
  24  * You should have received a copy of the GNU General Public License
  25  * along with this program; if not, write to the Free Software
  26  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  27  * MA 02111-1307 USA
  28  */
  29
  30 #include <common.h>
  31 #include <asm/io.h>
  32 #include <asm/arch/gpio.h>
  33 #include <asm/arch/at91_pmc.h>
  34 #include <status_led.h>
  35
  36 static unsigned int saved_state[3] = {STATUS_LED_OFF,
  37         STATUS_LED_OFF, STATUS_LED_OFF};
  38
  39 void coloured_LED_init(void)
  40 {
  41         struct at91_pmc *pmc = (struct at91_pmc *)ATMEL_BASE_PMC;
  42
  43         /* Enable the clock */
  44         writel(ATMEL_ID_PIOC, &pmc->pcer);
  45
  46         at91_set_gpio_output(CONFIG_RED_LED, 1);
  47         at91_set_gpio_output(CONFIG_GREEN_LED, 1);
  48         at91_set_gpio_output(CONFIG_YELLOW_LED, 1);
  49
  50         at91_set_gpio_value(CONFIG_RED_LED, 0);
  51         at91_set_gpio_value(CONFIG_GREEN_LED, 1);
  52         at91_set_gpio_value(CONFIG_YELLOW_LED, 0);
  53 }
  54
  55 void red_led_on(void)
  56 {
  57         at91_set_gpio_value(CONFIG_RED_LED, 1);
  58         saved_state[STATUS_LED_RED] = STATUS_LED_ON;
  59 }
  60
  61 void red_led_off(void)
  62 {
  63         at91_set_gpio_value(CONFIG_RED_LED, 0);
  64         saved_state[STATUS_LED_RED] = STATUS_LED_OFF;
  65 }
  66
  67 void green_led_on(void)
  68 {
  69         at91_set_gpio_value(CONFIG_GREEN_LED, 1);
  70         saved_state[STATUS_LED_GREEN] = STATUS_LED_ON;
  71 }
  72
  73 void green_led_off(void)
  74 {
  75         at91_set_gpio_value(CONFIG_GREEN_LED, 0);
  76         saved_state[STATUS_LED_GREEN] = STATUS_LED_OFF;
  77 }
  78
  79 void yellow_led_on(void)
  80 {
  81         at91_set_gpio_value(CONFIG_YELLOW_LED, 1);
  82         saved_state[STATUS_LED_YELLOW] = STATUS_LED_ON;
  83 }
  84
  85 void yellow_led_off(void)
  86 {
  87         at91_set_gpio_value(CONFIG_YELLOW_LED, 0);
  88         saved_state[STATUS_LED_YELLOW] = STATUS_LED_OFF;
  89 }
  90
  91 void __led_init(led_id_t mask, int state)
  92 {
  93         __led_set(mask, state);
  94 }
  95
  96 void __led_toggle(led_id_t mask)
  97 {
  98         if (STATUS_LED_RED == mask) {
  99                 if (STATUS_LED_ON == saved_state[STATUS_LED_RED])
 100                         red_led_off();
 101                 else
 102                         red_led_on();
 103
 104         } else if (STATUS_LED_GREEN == mask) {
 105                 if (STATUS_LED_ON == saved_state[STATUS_LED_GREEN])
 106                         green_led_off();
 107                 else
 108                         green_led_on();
 109
 110         } else if (STATUS_LED_YELLOW == mask) {
 111                 if (STATUS_LED_ON == saved_state[STATUS_LED_YELLOW])
 112                         yellow_led_off();
 113                 else
 114                         yellow_led_on();
 115         }
 116 }
 117
 118 void __led_set(led_id_t mask, int state)
 119 {
 120         if (STATUS_LED_RED == mask) {
 121                 if (STATUS_LED_ON == state)
 122                         red_led_on();
 123                 else
 124                         red_led_off();
 125
 126         } else if (STATUS_LED_GREEN == mask) {
 127                 if (STATUS_LED_ON == state)
 128                         green_led_on();
 129                 else
 130                         green_led_off();
 131
 132         } else if (STATUS_LED_YELLOW == mask) {
 133                 if (STATUS_LED_ON == state)
 134                         yellow_led_on();
 135                 else
 136                         yellow_led_off();
 137         }
 138 }