2 * linux/arch/arm/mach-footbridge/netwinder-leds.c
4 * Copyright (C) 1998-1999 Russell King
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
10 * NetWinder LED control routines.
12 * The Netwinder uses the leds as follows:
13 * - Green - toggles state every 50 timer interrupts
14 * - Red - On if the system is not idle
17 * 02-05-1999 RMK Various cleanups
19 #include <linux/module.h>
20 #include <linux/kernel.h>
21 #include <linux/init.h>
22 #include <linux/spinlock.h>
24 #include <mach/hardware.h>
26 #include <asm/mach-types.h>
28 #define LED_STATE_ENABLED 1
29 #define LED_STATE_CLAIMED 2
30 static char led_state
;
31 static char hw_led_state
;
33 static DEFINE_RAW_SPINLOCK(leds_lock
);
35 static void netwinder_leds_event(led_event_t evt
)
39 raw_spin_lock_irqsave(&leds_lock
, flags
);
43 led_state
|= LED_STATE_ENABLED
;
44 hw_led_state
= GPIO_GREEN_LED
;
48 led_state
&= ~LED_STATE_ENABLED
;
52 led_state
|= LED_STATE_CLAIMED
;
57 led_state
&= ~LED_STATE_CLAIMED
;
61 #ifdef CONFIG_LEDS_TIMER
63 if (!(led_state
& LED_STATE_CLAIMED
))
64 hw_led_state
^= GPIO_GREEN_LED
;
68 #ifdef CONFIG_LEDS_CPU
70 if (!(led_state
& LED_STATE_CLAIMED
))
71 hw_led_state
&= ~GPIO_RED_LED
;
75 if (!(led_state
& LED_STATE_CLAIMED
))
76 hw_led_state
|= GPIO_RED_LED
;
81 if (!(led_state
& LED_STATE_CLAIMED
))
82 hw_led_state
|= GPIO_RED_LED
;
86 if (led_state
& LED_STATE_CLAIMED
)
87 hw_led_state
|= GPIO_GREEN_LED
;
91 if (led_state
& LED_STATE_CLAIMED
)
92 hw_led_state
&= ~GPIO_GREEN_LED
;
96 if (led_state
& LED_STATE_CLAIMED
)
97 hw_led_state
|= GPIO_GREEN_LED
| GPIO_RED_LED
;
101 if (led_state
& LED_STATE_CLAIMED
)
102 hw_led_state
&= ~(GPIO_GREEN_LED
| GPIO_RED_LED
);
106 if (led_state
& LED_STATE_CLAIMED
)
107 hw_led_state
|= GPIO_RED_LED
;
111 if (led_state
& LED_STATE_CLAIMED
)
112 hw_led_state
&= ~GPIO_RED_LED
;
119 raw_spin_unlock_irqrestore(&leds_lock
, flags
);
121 if (led_state
& LED_STATE_ENABLED
) {
122 raw_spin_lock_irqsave(&nw_gpio_lock
, flags
);
123 nw_gpio_modify_op(GPIO_RED_LED
| GPIO_GREEN_LED
, hw_led_state
);
124 raw_spin_unlock_irqrestore(&nw_gpio_lock
, flags
);
128 static int __init
leds_init(void)
130 if (machine_is_netwinder())
131 leds_event
= netwinder_leds_event
;
133 leds_event(led_start
);
138 __initcall(leds_init
);