Merge master.kernel.org:/pub/scm/linux/kernel/git/mchehab/v4l-dvb
[linux-2.6] / arch / arm / mach-pxa / leds-trizeps4.c
1 /*
2  * linux/arch/arm/mach-pxa/leds-trizeps4.c
3  *
4  *  Author:     Jürgen Schindele
5  *  Created:    20 02, 2006
6  *  Copyright:  Jürgen Schindele
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License version 2 as
10  * published by the Free Software Foundation.
11  */
12
13 #include <linux/init.h>
14
15 #include <asm/hardware.h>
16 #include <asm/system.h>
17 #include <asm/types.h>
18 #include <asm/leds.h>
19
20 #include <asm/arch/pxa-regs.h>
21 #include <asm/arch/trizeps4.h>
22
23 #include "leds.h"
24
25 #define LED_STATE_ENABLED       1
26 #define LED_STATE_CLAIMED       2
27
28 #define SYS_BUSY                0x01
29 #define HEARTBEAT               0x02
30 #define BLINK                   0x04
31
32 static unsigned int led_state;
33 static unsigned int hw_led_state;
34
35 void trizeps4_leds_event(led_event_t evt)
36 {
37         unsigned long flags;
38
39         local_irq_save(flags);
40
41         switch (evt) {
42         case led_start:
43                 hw_led_state = 0;
44                 pxa_gpio_mode( GPIO_SYS_BUSY_LED  | GPIO_OUT);          /* LED1 */
45                 pxa_gpio_mode( GPIO_HEARTBEAT_LED | GPIO_OUT);          /* LED2 */
46                 led_state = LED_STATE_ENABLED;
47                 break;
48
49         case led_stop:
50                 led_state &= ~LED_STATE_ENABLED;
51                 break;
52
53         case led_claim:
54                 led_state |= LED_STATE_CLAIMED;
55                 hw_led_state = 0;
56                 break;
57
58         case led_release:
59                 led_state &= ~LED_STATE_CLAIMED;
60                 hw_led_state = 0;
61                 break;
62
63 #ifdef CONFIG_LEDS_TIMER
64         case led_timer:
65                 hw_led_state ^= HEARTBEAT;
66                 break;
67 #endif
68
69 #ifdef CONFIG_LEDS_CPU
70         case led_idle_start:
71                 hw_led_state &= ~SYS_BUSY;
72                 break;
73
74         case led_idle_end:
75                 hw_led_state |= SYS_BUSY;
76                 break;
77 #endif
78
79         case led_halted:
80                 break;
81
82         case led_green_on:
83                 hw_led_state |= BLINK;
84                 break;
85
86         case led_green_off:
87                 hw_led_state &= ~BLINK;
88                 break;
89
90         case led_amber_on:
91                 break;
92
93         case led_amber_off:
94                 break;
95
96         case led_red_on:
97                 break;
98
99         case led_red_off:
100                 break;
101
102         default:
103                 break;
104         }
105
106         if  (led_state & LED_STATE_ENABLED) {
107                 switch (hw_led_state) {
108                         case 0:
109                                 GPSR(GPIO_SYS_BUSY_LED)  |= GPIO_bit(GPIO_SYS_BUSY_LED);
110                                 GPSR(GPIO_HEARTBEAT_LED) |= GPIO_bit(GPIO_HEARTBEAT_LED);
111                                 break;
112                         case 1:
113                                 GPCR(GPIO_SYS_BUSY_LED)  |= GPIO_bit(GPIO_SYS_BUSY_LED);
114                                 GPSR(GPIO_HEARTBEAT_LED) |= GPIO_bit(GPIO_HEARTBEAT_LED);
115                                 break;
116                         case 2:
117                                 GPSR(GPIO_SYS_BUSY_LED)  |= GPIO_bit(GPIO_SYS_BUSY_LED);
118                                 GPCR(GPIO_HEARTBEAT_LED) |= GPIO_bit(GPIO_HEARTBEAT_LED);
119                                 break;
120                         case 3:
121                                 GPCR(GPIO_SYS_BUSY_LED)  |= GPIO_bit(GPIO_SYS_BUSY_LED);
122                                 GPCR(GPIO_HEARTBEAT_LED) |= GPIO_bit(GPIO_HEARTBEAT_LED);
123                                 break;
124                 }
125         }
126         else {
127                 /* turn all off */
128                 GPSR(GPIO_SYS_BUSY_LED)  |= GPIO_bit(GPIO_SYS_BUSY_LED);
129                 GPSR(GPIO_HEARTBEAT_LED) |= GPIO_bit(GPIO_HEARTBEAT_LED);
130         }
131
132         local_irq_restore(flags);
133 }