/arch/arm/mach-ks8695/leds.c

 1/*
 2 * LED driver for KS8695-based boards.
 3 *
 4 * Copyright (C) Andrew Victor
 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
11#include <linux/kernel.h>
12#include <linux/module.h>
13#include <linux/init.h>
14
15#include <asm/leds.h>
16#include <mach/devices.h>
17#include <mach/gpio.h>
18
19
20static inline void ks8695_led_on(unsigned int led)
21{
22	gpio_set_value(led, 0);
23}
24
25static inline void ks8695_led_off(unsigned int led)
26{
27	gpio_set_value(led, 1);
28}
29
30static inline void ks8695_led_toggle(unsigned int led)
31{
32	unsigned long is_off = gpio_get_value(led);
33	if (is_off)
34		ks8695_led_on(led);
35	else
36		ks8695_led_off(led);
37}
38
39
40/*
41 * Handle LED events.
42 */
43static void ks8695_leds_event(led_event_t evt)
44{
45	unsigned long flags;
46
47	local_irq_save(flags);
48
49	switch(evt) {
50	case led_start:		/* System startup */
51		ks8695_led_on(ks8695_leds_cpu);
52		break;
53
54	case led_stop:		/* System stop / suspend */
55		ks8695_led_off(ks8695_leds_cpu);
56		break;
57
58#ifdef CONFIG_LEDS_TIMER
59	case led_timer:		/* Every 50 timer ticks */
60		ks8695_led_toggle(ks8695_leds_timer);
61		break;
62#endif
63
64#ifdef CONFIG_LEDS_CPU
65	case led_idle_start:	/* Entering idle state */
66		ks8695_led_off(ks8695_leds_cpu);
67		break;
68
69	case led_idle_end:	/* Exit idle state */
70		ks8695_led_on(ks8695_leds_cpu);
71		break;
72#endif
73
74	default:
75		break;
76	}
77
78	local_irq_restore(flags);
79}
80
81
82static int __init leds_init(void)
83{
84	if ((ks8695_leds_timer == -1) || (ks8695_leds_cpu == -1))
85		return -ENODEV;
86
87	leds_event = ks8695_leds_event;
88
89	leds_event(led_start);
90	return 0;
91}
92
93__initcall(leds_init);