Viewing file: netwinder-leds.c (2.87 KB) -rw-r--r-- Select action/file-type: (+) | (+) | (+) | Code (+) | Session (+) | (+) | SDB (+) | (+) | (+) | (+) | (+) | (+) |
/* * linux/arch/arm/mach-footbridge/netwinder-leds.c * * Copyright (C) 1998-1999 Russell King * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * NetWinder LED control routines. * * The Netwinder uses the leds as follows: * - Green - toggles state every 50 timer interrupts * - Red - On if the system is not idle * * Changelog: * 02-05-1999 RMK Various cleanups */ #include <linux/config.h> #include <linux/module.h> #include <linux/kernel.h> #include <linux/init.h> #include <linux/spinlock.h>
#include <asm/hardware.h> #include <asm/leds.h> #include <asm/mach-types.h> #include <asm/system.h>
#define LED_STATE_ENABLED 1 #define LED_STATE_CLAIMED 2 static char led_state; static char hw_led_state;
static spinlock_t leds_lock = SPIN_LOCK_UNLOCKED; extern spinlock_t gpio_lock;
static void netwinder_leds_event(led_event_t evt) { unsigned long flags;
spin_lock_irqsave(&leds_lock, flags);
switch (evt) { case led_start: led_state |= LED_STATE_ENABLED; hw_led_state = GPIO_GREEN_LED; 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: if (!(led_state & LED_STATE_CLAIMED)) hw_led_state ^= GPIO_GREEN_LED; break; #endif
#ifdef CONFIG_LEDS_CPU case led_idle_start: if (!(led_state & LED_STATE_CLAIMED)) hw_led_state &= ~GPIO_RED_LED; break;
case led_idle_end: if (!(led_state & LED_STATE_CLAIMED)) hw_led_state |= GPIO_RED_LED; break; #endif
case led_halted: if (!(led_state & LED_STATE_CLAIMED)) hw_led_state |= GPIO_RED_LED; break;
case led_green_on: if (led_state & LED_STATE_CLAIMED) hw_led_state |= GPIO_GREEN_LED; break;
case led_green_off: if (led_state & LED_STATE_CLAIMED) hw_led_state &= ~GPIO_GREEN_LED; break;
case led_amber_on: if (led_state & LED_STATE_CLAIMED) hw_led_state |= GPIO_GREEN_LED | GPIO_RED_LED; break;
case led_amber_off: if (led_state & LED_STATE_CLAIMED) hw_led_state &= ~(GPIO_GREEN_LED | GPIO_RED_LED); break;
case led_red_on: if (led_state & LED_STATE_CLAIMED) hw_led_state |= GPIO_RED_LED; break;
case led_red_off: if (led_state & LED_STATE_CLAIMED) hw_led_state &= ~GPIO_RED_LED; break;
default: break; }
spin_unlock_irqrestore(&leds_lock, flags);
if (led_state & LED_STATE_ENABLED) { spin_lock_irqsave(&gpio_lock, flags); gpio_modify_op(GPIO_RED_LED | GPIO_GREEN_LED, hw_led_state); spin_unlock_irqrestore(&gpio_lock, flags); } }
static int __init leds_init(void) { if (machine_is_netwinder()) leds_event = netwinder_leds_event;
leds_event(led_start);
return 0; }
__initcall(leds_init);
|