leds-logodl.c

来自「优龙2410linux2.6.8内核源代码」· C语言 代码 · 共 136 行

/*
 * (C) 2002 Abraham van der Merwe <[e-mail]>
 * (C) 2003 August Hoerandl <[e-mail]>, Logotronic GmbH
 *
 * See file CREDITS for list of people who contributed to this
 * project.
 *
 * 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 <linux/config.h>
#include <linux/init.h>

#include <asm/hardware.h>
#include <asm/leds.h>
#include <asm/system.h>

#include "leds.h"

#define CFG_LED_A_BIT           (1<<18)
#define CFG_LED_A_SR            GPSR0
#define CFG_LED_A_CR            GPCR0

#define CFG_LED_B_BIT           (1<<16)
#define CFG_LED_B_SR            GPSR1
#define CFG_LED_B_CR            GPCR1

static int status_led6 = 0;
static int status_led7 = 0;

static void led6_on(void)    { CFG_LED_A_CR = CFG_LED_A_BIT; status_led6 = 1; } 
static void led6_off(void)   { CFG_LED_A_SR = CFG_LED_A_BIT; status_led6 = 0; }
static void led6_invert(void) 
{
	if (status_led6) 
		led6_off(); 
	else             
		led6_on();    
}

#define led7_on()   { CFG_LED_B_CR = CFG_LED_B_BIT; status_led7 = 1; } 
#define led7_off()  { CFG_LED_B_SR = CFG_LED_B_BIT; status_led7 = 1; } 


static int claimed;

void logodl_leds_event (led_event_t evt)
{
   unsigned long flags;

   local_irq_save (flags);

   switch (evt)
	 {
#ifdef CONFIG_LEDS_CPU
		/* turn off CPU load LED */
	  case led_idle_start:
		if (!claimed) led7_off ();
		break;

		/* turn on CPU load LED */
	  case led_idle_end:
		if (!claimed) led7_on ();
		break;
#endif

#ifdef CONFIG_LEDS_TIMER
		/* toggle heartbeat LED */
	  case led_timer:
		if (!claimed) led6_invert ();
		break;
#endif

		/* start: turn on LEDs and set claimed to 0 */
	  case led_start:
		led6_on ();
		led7_on ();
		claimed = 0;
		break;

		/* stop: turn off LEDs */
	  case led_stop:
		led6_off ();
		led7_off ();
		break;

		/* override CPU load & timer LEDs */
	  case led_claim:
		claimed = 1;
		break;

		/* restore CPU load & timer LEDs */
	  case led_release:
		claimed = 0;
		break;

		/* direct LED access (must be previously claimed) */

		/* led7 */
	  case led_green_on:
		if (claimed) led7_on ();
		break;

	  case led_green_off:
		if (claimed) led7_off ();
		break;

		/* led6 -- at the moment this is actually also green */
	  case led_red_on:
		if (claimed) led6_on ();
		break;

	  case led_red_off:
		if (claimed) led6_off ();
		break;

	  default:
		break;
	}

   local_irq_restore (flags);
}