Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
tjh.dev
kernel
os
linux
[ARM] 3393/2: AT91RM9200 LED support
Patch from Andrew Victor
This patch adds support for the LED(s) on the AT91RM9200-based boards.
(This version of the patch can be applied before Patch 3392/1)
Signed-off-by: Andrew Victor <andrew@sanpeople.com>
Signed-off-by: Russell King <rmk+kernel@arm.linux.org.uk>
authored by
Andrew Victor
and committed by
Russell King
cc2832a1
b2e6f755
+5
-4
arch/arm/mach-at91rm9200/Makefile
+5
-4
arch/arm/mach-at91rm9200/Makefile
···
16
16
#obj-$(CONFIG_MACH_KB9200) += board-kb9202.o
17
17
18
18
# LEDs support
19
-
#led-$(CONFIG_ARCH_AT91RM9200DK) += leds.o
20
-
#led-$(CONFIG_MACH_AT91RM9200EK) += leds.o
21
-
#led-$(CONFIG_MACH_CSB337) += leds.o
22
-
#led-$(CONFIG_MACH_CSB637) += leds.o
19
+
led-$(CONFIG_ARCH_AT91RM9200DK) += leds.o
20
+
led-$(CONFIG_MACH_AT91RM9200EK) += leds.o
21
+
led-$(CONFIG_MACH_CSB337) += leds.o
22
+
led-$(CONFIG_MACH_CSB637) += leds.o
23
23
#led-$(CONFIG_MACH_KB9200) += leds.o
24
+
#led-$(CONFIG_MACH_KAFA) += leds.o
24
25
obj-$(CONFIG_LEDS) += $(led-y)
25
26
26
27
# VGA support
+3
arch/arm/mach-at91rm9200/board-csb337.c
+3
arch/arm/mach-at91rm9200/board-csb337.c
···
67
67
/* Initialize clocks: 3.6864 MHz crystal */
68
68
at91_clock_init(3686400);
69
69
70
+
/* Setup the LEDs */
71
+
at91_init_leds(AT91_PIN_PB2, AT91_PIN_PB2);
72
+
70
73
#ifdef CONFIG_SERIAL_AT91
71
74
at91_console_port = CSB337_SERIAL_CONSOLE;
72
75
memcpy(at91_serial_map, serial, sizeof(serial));
+3
arch/arm/mach-at91rm9200/board-csb637.c
+3
arch/arm/mach-at91rm9200/board-csb637.c
···
67
67
/* Initialize clocks: 3.6864 MHz crystal */
68
68
at91_clock_init(3686400);
69
69
70
+
/* Setup the LEDs */
71
+
at91_init_leds(AT91_PIN_PB2, AT91_PIN_PB2);
72
+
70
73
#ifdef CONFIG_SERIAL_AT91
71
74
at91_console_port = CSB637_SERIAL_CONSOLE;
72
75
memcpy(at91_serial_map, serial, sizeof(serial));
+3
arch/arm/mach-at91rm9200/board-dk.c
+3
arch/arm/mach-at91rm9200/board-dk.c
···
70
70
/* Initialize clocks: 18.432 MHz crystal */
71
71
at91_clock_init(18432000);
72
72
73
+
/* Setup the LEDs */
74
+
at91_init_leds(AT91_PIN_PB2, AT91_PIN_PB2);
75
+
73
76
#ifdef CONFIG_SERIAL_AT91
74
77
at91_console_port = DK_SERIAL_CONSOLE;
75
78
memcpy(at91_serial_map, serial, sizeof(serial));
+3
arch/arm/mach-at91rm9200/board-ek.c
+3
arch/arm/mach-at91rm9200/board-ek.c
···
70
70
/* Initialize clocks: 18.432 MHz crystal */
71
71
at91_clock_init(18432000);
72
72
73
+
/* Setup the LEDs */
74
+
at91_init_leds(AT91_PIN_PB1, AT91_PIN_PB2);
75
+
73
76
#ifdef CONFIG_SERIAL_AT91
74
77
at91_console_port = EK_SERIAL_CONSOLE;
75
78
memcpy(at91_serial_map, serial, sizeof(serial));
+19
arch/arm/mach-at91rm9200/devices.c
+19
arch/arm/mach-at91rm9200/devices.c
···
290
290
void __init at91_add_device_mmc(struct at91_mmc_data *data) {}
291
291
#endif
292
292
293
+
/* --------------------------------------------------------------------
294
+
* LEDs
295
+
* -------------------------------------------------------------------- */
296
+
297
+
#if defined(CONFIG_LEDS)
298
+
u8 at91_leds_cpu;
299
+
u8 at91_leds_timer;
300
+
301
+
void __init at91_init_leds(u8 cpu_led, u8 timer_led)
302
+
{
303
+
at91_leds_cpu = cpu_led;
304
+
at91_leds_timer = timer_led;
305
+
}
306
+
307
+
#else
308
+
void __init at91_init_leds(u8 cpu_led, u8 timer_led) {}
309
+
#endif
310
+
311
+
293
312
/* -------------------------------------------------------------------- */
+100
arch/arm/mach-at91rm9200/leds.c
+100
arch/arm/mach-at91rm9200/leds.c
···
1
+
/*
2
+
* LED driver for Atmel AT91-based boards.
3
+
*
4
+
* Copyright (C) SAN People (Pty) Ltd
5
+
*
6
+
* This program is free software; you can redistribute it and/or
7
+
* modify it under the terms of the GNU General Public License
8
+
* as published by the Free Software Foundation; either version
9
+
* 2 of the License, or (at your option) any later version.
10
+
*/
11
+
12
+
#include <linux/config.h>
13
+
#include <linux/kernel.h>
14
+
#include <linux/module.h>
15
+
#include <linux/init.h>
16
+
17
+
#include <asm/mach-types.h>
18
+
#include <asm/leds.h>
19
+
#include <asm/arch/board.h>
20
+
#include <asm/arch/gpio.h>
21
+
22
+
23
+
static inline void at91_led_on(unsigned int led)
24
+
{
25
+
at91_set_gpio_value(led, 0);
26
+
}
27
+
28
+
static inline void at91_led_off(unsigned int led)
29
+
{
30
+
at91_set_gpio_value(led, 1);
31
+
}
32
+
33
+
static inline void at91_led_toggle(unsigned int led)
34
+
{
35
+
unsigned long is_off = at91_get_gpio_value(led);
36
+
if (is_off)
37
+
at91_led_on(led);
38
+
else
39
+
at91_led_off(led);
40
+
}
41
+
42
+
43
+
/*
44
+
* Handle LED events.
45
+
*/
46
+
static void at91_leds_event(led_event_t evt)
47
+
{
48
+
unsigned long flags;
49
+
50
+
local_irq_save(flags);
51
+
52
+
switch(evt) {
53
+
case led_start: /* System startup */
54
+
at91_led_on(at91_leds_cpu);
55
+
break;
56
+
57
+
case led_stop: /* System stop / suspend */
58
+
at91_led_off(at91_leds_cpu);
59
+
break;
60
+
61
+
#ifdef CONFIG_LEDS_TIMER
62
+
case led_timer: /* Every 50 timer ticks */
63
+
at91_led_toggle(at91_leds_timer);
64
+
break;
65
+
#endif
66
+
67
+
#ifdef CONFIG_LEDS_CPU
68
+
case led_idle_start: /* Entering idle state */
69
+
at91_led_off(at91_leds_cpu);
70
+
break;
71
+
72
+
case led_idle_end: /* Exit idle state */
73
+
at91_led_on(at91_leds_cpu);
74
+
break;
75
+
#endif
76
+
77
+
default:
78
+
break;
79
+
}
80
+
81
+
local_irq_restore(flags);
82
+
}
83
+
84
+
85
+
static int __init leds_init(void)
86
+
{
87
+
if (!at91_leds_timer || !at91_leds_cpu)
88
+
return -ENODEV;
89
+
90
+
/* Enable PIO to access the LEDs */
91
+
at91_set_gpio_output(at91_leds_timer, 1);
92
+
at91_set_gpio_output(at91_leds_cpu, 1);
93
+
94
+
leds_event = at91_leds_event;
95
+
96
+
leds_event(led_start);
97
+
return 0;
98
+
}
99
+
100
+
__initcall(leds_init);