leds-lubbock.c

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

/*
 * linux/arch/arm/mach-pxa/leds-lubbock.c
 *
 * Copyright (C) 2000 John Dorsey <[e-mail]>
 *
 * Copyright (c) 2001 Jeff Sutherland <[e-mail]>
 *
 * Original (leds-footbridge.c) by Russell King
 *
 * Major surgery on April 2004 by Nicolas Pitre for less global
 * namespace collision.  Mostly adapted the Mainstone version.
 */

#include <linux/config.h>
#include <linux/init.h>

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

#include "leds.h"

/*
 * 8 discrete leds available for general use:
 *
 * Note: bits [15-8] are used to enable/blank the 8 7 segment hex displays
 * so be sure to not monkey with them here.
 */

#define LED_TIMER		(1 << 4)
#define LED_BUSY		(1 << 5)
#ifdef CONFIG_ARCH_FS_PXA255_V30
  #define LED_GREEN		(1 << 18)
  #define LED_AMBER		(1 << 17)
  #define LED_RED		(1 << 19)
  #define LED_BLUE		(1 << 20)
  #define LED_MASK		(LED_GREEN|LED_AMBER|LED_RED|LED_BLUE)
#else
  #define LED_GREEN		(1 << 11)
  #define LED_AMBER		(1 << 12)
  #define LED_RED		(1 << 26)
  #define LED_BLUE		(1 << 10)
  #define LED_MASK		(LED_TIMER|LED_BUSY|LED_GREEN|LED_AMBER|LED_RED|LED_BLUE)
#endif

#define LED_STATE_ENABLED	1
#define LED_STATE_CLAIMED	2

static unsigned int led_state;
static unsigned int hw_led_state;

void lubbock_leds_event(led_event_t evt)
{
	unsigned long flags;

	local_irq_save(flags);

	switch (evt) {
	case led_start:
		hw_led_state = 0;
		led_state = LED_STATE_ENABLED;
		break;

	case led_stop:
		led_state &= ~LED_STATE_ENABLED;
		break;

	case led_claim:
		led_state |= LED_STATE_CLAIMED;
		hw_led_state = 0;
		break;

	case led_release:
		led_state &= ~LED_STATE_CLAIMED;
		hw_led_state = 0;
		break;

#ifdef CONFIG_LEDS_TIMER
	case led_timer:
		hw_led_state ^= LED_TIMER;
		break;
#endif

#ifdef CONFIG_LEDS_CPU
	case led_idle_start:
		hw_led_state &= ~LED_BUSY;
		break;

	case led_idle_end:
		hw_led_state |= LED_BUSY;
		break;
#endif

	case led_halted:
		break;

	case led_green_on:
		hw_led_state |= LED_GREEN;
		break;

	case led_green_off:
		hw_led_state &= ~LED_GREEN;
		break;

	case led_amber_on:
		hw_led_state |= LED_AMBER;
		break;

	case led_amber_off:
		hw_led_state &= ~LED_AMBER;
		break;

	case led_red_on:
		hw_led_state |= LED_RED;
		break;

	case led_red_off:
		hw_led_state &= ~LED_RED;
		break;

	case led_blue_on:
		hw_led_state |= LED_BLUE;
		break;

	case led_blue_off:
		hw_led_state &= ~LED_BLUE;
		break;

	default:
		break;
	}

	if  (led_state & LED_STATE_ENABLED) {
		//LUB_DISC_BLNK_LED = (LUB_DISC_BLNK_LED | 0xff) & ~hw_led_state;
#ifdef	CONFIG_ARCH_FS_PXA255
  #ifdef	CONFIG_ARCH_FS_PXA255_V30
		GPSR2 = (hw_led_state&LED_MASK)^LED_MASK;
		GPCR2 = hw_led_state&LED_MASK;
		GPSR0 = (hw_led_state&(LED_TIMER|LED_BUSY))^(LED_TIMER|LED_BUSY);
		GPCR0 = hw_led_state&(LED_TIMER|LED_BUSY);
  #else
		GPSR0 = (hw_led_state&LED_MASK)^LED_MASK;
		GPCR0 = hw_led_state&LED_MASK;
  #endif
#else
		if(hw_led_state&D26)
			GPSR0 = 1<<24;
		else
			GPCR0 = 1<<24;
		if(hw_led_state&D27)
			GPSR0 = 1<<27;
		else
			GPCR0 = 1<<27;
#endif
	}
	else {
		//LUB_DISC_BLNK_LED |= 0xff;
#ifdef	CONFIG_ARCH_FS_PXA255
  #ifdef	CONFIG_ARCH_FS_PXA255_V30
		GPSR2 = LED_MASK;
		GPSR0 = LED_TIMER|LED_BUSY;
  #else
		GPSR0 = LED_MASK;
  #endif
#else
		GPSR0 = (1<<24)|(1<<27);
#endif
	}

	local_irq_restore(flags);
}