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>
27 #include <asm/system.h>
29 #define LED_STATE_ENABLED 1
30 #define LED_STATE_CLAIMED 2
31 static char led_state
;
32 static char hw_led_state
;
34 static DEFINE_SPINLOCK(leds_lock
);
35 extern spinlock_t gpio_lock
;
37 static void netwinder_leds_event(led_event_t evt
)
41 spin_lock_irqsave(&leds_lock
, flags
);
45 led_state
|= LED_STATE_ENABLED
;
46 hw_led_state
= GPIO_GREEN_LED
;
50 led_state
&= ~LED_STATE_ENABLED
;
54 led_state
|= LED_STATE_CLAIMED
;
59 led_state
&= ~LED_STATE_CLAIMED
;
63 #ifdef CONFIG_LEDS_TIMER
65 if (!(led_state
& LED_STATE_CLAIMED
))
66 hw_led_state
^= GPIO_GREEN_LED
;
70 #ifdef CONFIG_LEDS_CPU
72 if (!(led_state
& LED_STATE_CLAIMED
))
73 hw_led_state
&= ~GPIO_RED_LED
;
77 if (!(led_state
& LED_STATE_CLAIMED
))
78 hw_led_state
|= GPIO_RED_LED
;
83 if (!(led_state
& LED_STATE_CLAIMED
))
84 hw_led_state
|= GPIO_RED_LED
;
88 if (led_state
& LED_STATE_CLAIMED
)
89 hw_led_state
|= GPIO_GREEN_LED
;
93 if (led_state
& LED_STATE_CLAIMED
)
94 hw_led_state
&= ~GPIO_GREEN_LED
;
98 if (led_state
& LED_STATE_CLAIMED
)
99 hw_led_state
|= GPIO_GREEN_LED
| GPIO_RED_LED
;
103 if (led_state
& LED_STATE_CLAIMED
)
104 hw_led_state
&= ~(GPIO_GREEN_LED
| GPIO_RED_LED
);
108 if (led_state
& LED_STATE_CLAIMED
)
109 hw_led_state
|= GPIO_RED_LED
;
113 if (led_state
& LED_STATE_CLAIMED
)
114 hw_led_state
&= ~GPIO_RED_LED
;
121 spin_unlock_irqrestore(&leds_lock
, flags
);
123 if (led_state
& LED_STATE_ENABLED
) {
124 spin_lock_irqsave(&gpio_lock
, flags
);
125 gpio_modify_op(GPIO_RED_LED
| GPIO_GREEN_LED
, hw_led_state
);
126 spin_unlock_irqrestore(&gpio_lock
, flags
);
130 static int __init
leds_init(void)
132 if (machine_is_netwinder())
133 leds_event
= netwinder_leds_event
;
135 leds_event(led_start
);
140 __initcall(leds_init
);