Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * linux/arch/arm/mach-footbridge/netwinder-leds.c | |
3 | * | |
4 | * Copyright (C) 1998-1999 Russell King | |
5 | * | |
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. | |
9 | * | |
10 | * NetWinder LED control routines. | |
11 | * | |
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 | |
15 | * | |
16 | * Changelog: | |
17 | * 02-05-1999 RMK Various cleanups | |
18 | */ | |
1da177e4 LT |
19 | #include <linux/module.h> |
20 | #include <linux/kernel.h> | |
21 | #include <linux/init.h> | |
22 | #include <linux/spinlock.h> | |
23 | ||
a09e64fb | 24 | #include <mach/hardware.h> |
1da177e4 LT |
25 | #include <asm/leds.h> |
26 | #include <asm/mach-types.h> | |
1da177e4 LT |
27 | |
28 | #define LED_STATE_ENABLED 1 | |
29 | #define LED_STATE_CLAIMED 2 | |
30 | static char led_state; | |
31 | static char hw_led_state; | |
32 | ||
bd31b859 | 33 | static DEFINE_RAW_SPINLOCK(leds_lock); |
1da177e4 LT |
34 | |
35 | static void netwinder_leds_event(led_event_t evt) | |
36 | { | |
37 | unsigned long flags; | |
38 | ||
bd31b859 | 39 | raw_spin_lock_irqsave(&leds_lock, flags); |
1da177e4 LT |
40 | |
41 | switch (evt) { | |
42 | case led_start: | |
43 | led_state |= LED_STATE_ENABLED; | |
44 | hw_led_state = GPIO_GREEN_LED; | |
45 | break; | |
46 | ||
47 | case led_stop: | |
48 | led_state &= ~LED_STATE_ENABLED; | |
49 | break; | |
50 | ||
51 | case led_claim: | |
52 | led_state |= LED_STATE_CLAIMED; | |
53 | hw_led_state = 0; | |
54 | break; | |
55 | ||
56 | case led_release: | |
57 | led_state &= ~LED_STATE_CLAIMED; | |
58 | hw_led_state = 0; | |
59 | break; | |
60 | ||
61 | #ifdef CONFIG_LEDS_TIMER | |
62 | case led_timer: | |
63 | if (!(led_state & LED_STATE_CLAIMED)) | |
64 | hw_led_state ^= GPIO_GREEN_LED; | |
65 | break; | |
66 | #endif | |
67 | ||
68 | #ifdef CONFIG_LEDS_CPU | |
69 | case led_idle_start: | |
70 | if (!(led_state & LED_STATE_CLAIMED)) | |
71 | hw_led_state &= ~GPIO_RED_LED; | |
72 | break; | |
73 | ||
74 | case led_idle_end: | |
75 | if (!(led_state & LED_STATE_CLAIMED)) | |
76 | hw_led_state |= GPIO_RED_LED; | |
77 | break; | |
78 | #endif | |
79 | ||
80 | case led_halted: | |
81 | if (!(led_state & LED_STATE_CLAIMED)) | |
82 | hw_led_state |= GPIO_RED_LED; | |
83 | break; | |
84 | ||
85 | case led_green_on: | |
86 | if (led_state & LED_STATE_CLAIMED) | |
87 | hw_led_state |= GPIO_GREEN_LED; | |
88 | break; | |
89 | ||
90 | case led_green_off: | |
91 | if (led_state & LED_STATE_CLAIMED) | |
92 | hw_led_state &= ~GPIO_GREEN_LED; | |
93 | break; | |
94 | ||
95 | case led_amber_on: | |
96 | if (led_state & LED_STATE_CLAIMED) | |
97 | hw_led_state |= GPIO_GREEN_LED | GPIO_RED_LED; | |
98 | break; | |
99 | ||
100 | case led_amber_off: | |
101 | if (led_state & LED_STATE_CLAIMED) | |
102 | hw_led_state &= ~(GPIO_GREEN_LED | GPIO_RED_LED); | |
103 | break; | |
104 | ||
105 | case led_red_on: | |
106 | if (led_state & LED_STATE_CLAIMED) | |
107 | hw_led_state |= GPIO_RED_LED; | |
108 | break; | |
109 | ||
110 | case led_red_off: | |
111 | if (led_state & LED_STATE_CLAIMED) | |
112 | hw_led_state &= ~GPIO_RED_LED; | |
113 | break; | |
114 | ||
115 | default: | |
116 | break; | |
117 | } | |
118 | ||
bd31b859 | 119 | raw_spin_unlock_irqrestore(&leds_lock, flags); |
1da177e4 LT |
120 | |
121 | if (led_state & LED_STATE_ENABLED) { | |
bd31b859 | 122 | raw_spin_lock_irqsave(&nw_gpio_lock, flags); |
70d13e08 | 123 | nw_gpio_modify_op(GPIO_RED_LED | GPIO_GREEN_LED, hw_led_state); |
bd31b859 | 124 | raw_spin_unlock_irqrestore(&nw_gpio_lock, flags); |
1da177e4 LT |
125 | } |
126 | } | |
127 | ||
128 | static int __init leds_init(void) | |
129 | { | |
130 | if (machine_is_netwinder()) | |
131 | leds_event = netwinder_leds_event; | |
132 | ||
133 | leds_event(led_start); | |
134 | ||
135 | return 0; | |
136 | } | |
137 | ||
138 | __initcall(leds_init); |