1 /*
2  * linux/arch/arm/mach-omap1/leds-h2p2-debug.c
3  *
4  * Copyright 2003 by Texas Instruments Incorporated
5  *
6  * There are 16 LEDs on the debug board (all green); four may be used
7  * for logical 'green', 'amber', 'red', and 'blue' (after "claiming").
8  *
9  * The "surfer" expansion board and H2 sample board also have two-color
10  * green+red LEDs (in parallel), used here for timer and idle indicators.
11  */
12 #include <linux/gpio.h>
13 #include <linux/init.h>
14 #include <linux/kernel_stat.h>
15 #include <linux/sched.h>
16 #include <linux/io.h>
17 
18 #include <mach/hardware.h>
19 #include <asm/leds.h>
20 #include <asm/system.h>
21 #include <asm/mach-types.h>
22 
23 #include <plat/fpga.h>
24 
25 #include "leds.h"
26 
27 
28 #define GPIO_LED_RED		3
29 #define GPIO_LED_GREEN		OMAP_MPUIO(4)
30 
31 
32 #define LED_STATE_ENABLED	0x01
33 #define LED_STATE_CLAIMED	0x02
34 #define LED_TIMER_ON		0x04
35 
36 #define GPIO_IDLE		GPIO_LED_GREEN
37 #define GPIO_TIMER		GPIO_LED_RED
38 
39 
h2p2_dbg_leds_event(led_event_t evt)40 void h2p2_dbg_leds_event(led_event_t evt)
41 {
42 	unsigned long flags;
43 
44 	static struct h2p2_dbg_fpga __iomem *fpga;
45 	static u16 led_state, hw_led_state;
46 
47 	local_irq_save(flags);
48 
49 	if (!(led_state & LED_STATE_ENABLED) && evt != led_start)
50 		goto done;
51 
52 	switch (evt) {
53 	case led_start:
54 		if (!fpga)
55 			fpga = ioremap(H2P2_DBG_FPGA_START,
56 						H2P2_DBG_FPGA_SIZE);
57 		if (fpga) {
58 			led_state |= LED_STATE_ENABLED;
59 			__raw_writew(~0, &fpga->leds);
60 		}
61 		break;
62 
63 	case led_stop:
64 	case led_halted:
65 		/* all leds off during suspend or shutdown */
66 
67 		if (! machine_is_omap_perseus2()) {
68 			gpio_set_value(GPIO_TIMER, 0);
69 			gpio_set_value(GPIO_IDLE, 0);
70 		}
71 
72 		__raw_writew(~0, &fpga->leds);
73 		led_state &= ~LED_STATE_ENABLED;
74 		if (evt == led_halted) {
75 			iounmap(fpga);
76 			fpga = NULL;
77 		}
78 
79 		goto done;
80 
81 	case led_claim:
82 		led_state |= LED_STATE_CLAIMED;
83 		hw_led_state = 0;
84 		break;
85 
86 	case led_release:
87 		led_state &= ~LED_STATE_CLAIMED;
88 		break;
89 
90 #ifdef CONFIG_LEDS_TIMER
91 	case led_timer:
92 		led_state ^= LED_TIMER_ON;
93 
94 		if (machine_is_omap_perseus2())
95 			hw_led_state ^= H2P2_DBG_FPGA_P2_LED_TIMER;
96 		else {
97 			gpio_set_value(GPIO_TIMER, led_state & LED_TIMER_ON);
98 			goto done;
99 		}
100 
101 		break;
102 #endif
103 
104 #ifdef CONFIG_LEDS_CPU
105 	case led_idle_start:
106 		if (machine_is_omap_perseus2())
107 			hw_led_state |= H2P2_DBG_FPGA_P2_LED_IDLE;
108 		else {
109 			gpio_set_value(GPIO_IDLE, 1);
110 			goto done;
111 		}
112 
113 		break;
114 
115 	case led_idle_end:
116 		if (machine_is_omap_perseus2())
117 			hw_led_state &= ~H2P2_DBG_FPGA_P2_LED_IDLE;
118 		else {
119 			gpio_set_value(GPIO_IDLE, 0);
120 			goto done;
121 		}
122 
123 		break;
124 #endif
125 
126 	case led_green_on:
127 		hw_led_state |= H2P2_DBG_FPGA_LED_GREEN;
128 		break;
129 	case led_green_off:
130 		hw_led_state &= ~H2P2_DBG_FPGA_LED_GREEN;
131 		break;
132 
133 	case led_amber_on:
134 		hw_led_state |= H2P2_DBG_FPGA_LED_AMBER;
135 		break;
136 	case led_amber_off:
137 		hw_led_state &= ~H2P2_DBG_FPGA_LED_AMBER;
138 		break;
139 
140 	case led_red_on:
141 		hw_led_state |= H2P2_DBG_FPGA_LED_RED;
142 		break;
143 	case led_red_off:
144 		hw_led_state &= ~H2P2_DBG_FPGA_LED_RED;
145 		break;
146 
147 	case led_blue_on:
148 		hw_led_state |= H2P2_DBG_FPGA_LED_BLUE;
149 		break;
150 	case led_blue_off:
151 		hw_led_state &= ~H2P2_DBG_FPGA_LED_BLUE;
152 		break;
153 
154 	default:
155 		break;
156 	}
157 
158 
159 	/*
160 	 *  Actually burn the LEDs
161 	 */
162 	if (led_state & LED_STATE_ENABLED)
163 		__raw_writew(~hw_led_state, &fpga->leds);
164 
165 done:
166 	local_irq_restore(flags);
167 }
168