Gitiles
Code Review Sign In
gerrit-public.fairphone.software / kernel / msm-4.9 / ca2ac5cc9548e954b295de16158a5a7e3b97873b / . / arch / arm / mach-sa1100 / leds-cerf.c
blob: 040540fb7d8aa1157a930a32d577303915357ded [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]1/*
2 * linux/arch/arm/mach-sa1100/leds-cerf.c
3 *
4 * Author: ???
5 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]6#include <linux/init.h>
7
Russell Kinga09e64f2008-08-05 16:14:15 +0100[diff] [blame]8#include <mach/hardware.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]9#include <asm/leds.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]10
11#include "leds.h"
12
13
14#define LED_STATE_ENABLED 1
15#define LED_STATE_CLAIMED 2
16
17static unsigned int led_state;
18static unsigned int hw_led_state;
19
20#define LED_D0 GPIO_GPIO(0)
21#define LED_D1 GPIO_GPIO(1)
22#define LED_D2 GPIO_GPIO(2)
23#define LED_D3 GPIO_GPIO(3)
24#define LED_MASK (LED_D0|LED_D1|LED_D2|LED_D3)
25
26void cerf_leds_event(led_event_t evt)
27{
28 unsigned long flags;
29
30 local_irq_save(flags);
31
32 switch (evt) {
33 case led_start:
34 hw_led_state = LED_MASK;
35 led_state = LED_STATE_ENABLED;
36 break;
37
38 case led_stop:
39 led_state &= ~LED_STATE_ENABLED;
40 break;
41
42 case led_claim:
43 led_state |= LED_STATE_CLAIMED;
44 hw_led_state = LED_MASK;
45 break;
46 case led_release:
47 led_state &= ~LED_STATE_CLAIMED;
48 hw_led_state = LED_MASK;
49 break;
50
51#ifdef CONFIG_LEDS_TIMER
52 case led_timer:
53 if (!(led_state & LED_STATE_CLAIMED))
54 hw_led_state ^= LED_D0;
55 break;
56#endif
57
58#ifdef CONFIG_LEDS_CPU
59 case led_idle_start:
60 if (!(led_state & LED_STATE_CLAIMED))
61 hw_led_state &= ~LED_D1;
62 break;
63
64 case led_idle_end:
65 if (!(led_state & LED_STATE_CLAIMED))
66 hw_led_state |= LED_D1;
67 break;
68#endif
69 case led_green_on:
70 if (!(led_state & LED_STATE_CLAIMED))
71 hw_led_state &= ~LED_D2;
72 break;
73
74 case led_green_off:
75 if (!(led_state & LED_STATE_CLAIMED))
76 hw_led_state |= LED_D2;
77 break;
78
79 case led_amber_on:
80 if (!(led_state & LED_STATE_CLAIMED))
81 hw_led_state &= ~LED_D3;
82 break;
83
84 case led_amber_off:
85 if (!(led_state & LED_STATE_CLAIMED))
86 hw_led_state |= LED_D3;
87 break;
88
89 case led_red_on:
90 if (!(led_state & LED_STATE_CLAIMED))
91 hw_led_state &= ~LED_D1;
92 break;
93
94 case led_red_off:
95 if (!(led_state & LED_STATE_CLAIMED))
96 hw_led_state |= LED_D1;
97 break;
98
99 default:
100 break;
101 }
102
103 if (led_state & LED_STATE_ENABLED) {
104 GPSR = hw_led_state;
105 GPCR = hw_led_state ^ LED_MASK;
106 }
107
108 local_irq_restore(flags);
109}