led.c 2.91 KB
Newer Older
Tom Rix's avatar
Tom Rix committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24
/*
 * Copyright (c) 2009 Wind River Systems, Inc.
 * Tom Rix <Tom.Rix@windriver.com>
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of
 * the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
 * MA 02111-1307 USA
 */
#include <common.h>
#include <status_led.h>
#include <asm/arch/cpu.h>
#include <asm/io.h>
#include <asm/arch/sys_proto.h>
25
#include <asm/gpio.h>
Tom Rix's avatar
Tom Rix committed
26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41

static unsigned int saved_state[2] = {STATUS_LED_OFF, STATUS_LED_OFF};

/*
 * GPIO LEDs
 * 173 red
 * 154 blue
 * 61  blue2
 */
#define ZOOM2_LED_RED	173
#define ZOOM2_LED_BLUE	154
#define ZOOM2_LED_BLUE2	61

void red_LED_off (void)
{
	/* red */
42 43 44
	if (!gpio_request(ZOOM2_LED_RED, "")) {
		gpio_direction_output(ZOOM2_LED_RED, 0);
		gpio_set_value(ZOOM2_LED_RED, 0);
Tom Rix's avatar
Tom Rix committed
45 46 47 48 49 50 51
	}
	saved_state[STATUS_LED_RED] = STATUS_LED_OFF;
}

void blue_LED_off (void)
{
	/* blue */
52 53 54
	if (!gpio_request(ZOOM2_LED_BLUE, "")) {
		gpio_direction_output(ZOOM2_LED_BLUE, 0);
		gpio_set_value(ZOOM2_LED_BLUE, 0);
Tom Rix's avatar
Tom Rix committed
55 56 57
	}

	/* blue 2 */
58 59 60
	if (!gpio_request(ZOOM2_LED_BLUE2, "")) {
		gpio_direction_output(ZOOM2_LED_BLUE2, 0);
		gpio_set_value(ZOOM2_LED_BLUE2, 0);
Tom Rix's avatar
Tom Rix committed
61 62 63 64 65 66 67 68 69
	}
	saved_state[STATUS_LED_BLUE] = STATUS_LED_OFF;
}

void red_LED_on (void)
{
	blue_LED_off ();

	/* red */
70 71 72
	if (!gpio_request(ZOOM2_LED_RED, "")) {
		gpio_direction_output(ZOOM2_LED_RED, 0);
		gpio_set_value(ZOOM2_LED_RED, 1);
Tom Rix's avatar
Tom Rix committed
73 74 75 76 77 78 79 80 81
	}
	saved_state[STATUS_LED_RED] = STATUS_LED_ON;
}

void blue_LED_on (void)
{
	red_LED_off ();

	/* blue */
82 83 84
	if (!gpio_request(ZOOM2_LED_BLUE, "")) {
		gpio_direction_output(ZOOM2_LED_BLUE, 0);
		gpio_set_value(ZOOM2_LED_BLUE, 1);
Tom Rix's avatar
Tom Rix committed
85 86 87
	}

	/* blue 2 */
88 89 90
	if (!gpio_request(ZOOM2_LED_BLUE2, "")) {
		gpio_direction_output(ZOOM2_LED_BLUE2, 0);
		gpio_set_value(ZOOM2_LED_BLUE2, 1);
Tom Rix's avatar
Tom Rix committed
91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129
	}

	saved_state[STATUS_LED_BLUE] = STATUS_LED_ON;
}

void __led_init (led_id_t mask, int state)
{
	__led_set (mask, state);
}

void __led_toggle (led_id_t mask)
{
	if (STATUS_LED_BLUE == mask) {
		if (STATUS_LED_ON == saved_state[STATUS_LED_BLUE])
			blue_LED_off ();
		else
			blue_LED_on ();
	} else if (STATUS_LED_RED == mask) {
		if (STATUS_LED_ON == saved_state[STATUS_LED_RED])
			red_LED_off ();
		else
			red_LED_on ();
	}
}

void __led_set (led_id_t mask, int state)
{
	if (STATUS_LED_BLUE == mask) {
		if (STATUS_LED_ON == state)
			blue_LED_on ();
		else
			blue_LED_off ();
	} else if (STATUS_LED_RED == mask) {
		if (STATUS_LED_ON == state)
			red_LED_on ();
		else
			red_LED_off ();
	}
}