diff options
author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /arch/sh/boards/superh/microdev/led.c |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'arch/sh/boards/superh/microdev/led.c')
-rw-r--r-- | arch/sh/boards/superh/microdev/led.c | 102 |
1 files changed, 102 insertions, 0 deletions
diff --git a/arch/sh/boards/superh/microdev/led.c b/arch/sh/boards/superh/microdev/led.c new file mode 100644 index 000000000000..52a98e69d3f0 --- /dev/null +++ b/arch/sh/boards/superh/microdev/led.c | |||
@@ -0,0 +1,102 @@ | |||
1 | /* | ||
2 | * linux/arch/sh/kernel/led_microdev.c | ||
3 | * | ||
4 | * Copyright (C) 2002 Stuart Menefy <stuart.menefy@st.com> | ||
5 | * Copyright (C) 2003 Richard Curnow (Richard.Curnow@superh.com) | ||
6 | * | ||
7 | * May be copied or modified under the terms of the GNU General Public | ||
8 | * License. See linux/COPYING for more information. | ||
9 | * | ||
10 | */ | ||
11 | |||
12 | #include <linux/config.h> | ||
13 | #include <asm/io.h> | ||
14 | |||
15 | #define LED_REGISTER 0xa6104d20 | ||
16 | |||
17 | static void mach_led_d9(int value) | ||
18 | { | ||
19 | unsigned long reg; | ||
20 | reg = ctrl_inl(LED_REGISTER); | ||
21 | reg &= ~1; | ||
22 | reg |= (value & 1); | ||
23 | ctrl_outl(reg, LED_REGISTER); | ||
24 | return; | ||
25 | } | ||
26 | |||
27 | static void mach_led_d10(int value) | ||
28 | { | ||
29 | unsigned long reg; | ||
30 | reg = ctrl_inl(LED_REGISTER); | ||
31 | reg &= ~2; | ||
32 | reg |= ((value & 1) << 1); | ||
33 | ctrl_outl(reg, LED_REGISTER); | ||
34 | return; | ||
35 | } | ||
36 | |||
37 | |||
38 | #ifdef CONFIG_HEARTBEAT | ||
39 | #include <linux/sched.h> | ||
40 | |||
41 | static unsigned char banner_table[] = { | ||
42 | 0x11, 0x01, 0x11, 0x01, 0x11, 0x03, | ||
43 | 0x11, 0x01, 0x11, 0x01, 0x13, 0x03, | ||
44 | 0x11, 0x01, 0x13, 0x01, 0x13, 0x01, 0x11, 0x03, | ||
45 | 0x11, 0x03, | ||
46 | 0x11, 0x01, 0x13, 0x01, 0x11, 0x03, | ||
47 | 0x11, 0x01, 0x11, 0x01, 0x11, 0x01, 0x11, 0x07, | ||
48 | 0x13, 0x01, 0x13, 0x03, | ||
49 | 0x11, 0x01, 0x11, 0x03, | ||
50 | 0x13, 0x01, 0x11, 0x01, 0x13, 0x01, 0x11, 0x03, | ||
51 | 0x11, 0x01, 0x13, 0x01, 0x11, 0x03, | ||
52 | 0x13, 0x01, 0x13, 0x01, 0x13, 0x03, | ||
53 | 0x13, 0x01, 0x11, 0x01, 0x11, 0x03, | ||
54 | 0x11, 0x03, | ||
55 | 0x11, 0x01, 0x11, 0x01, 0x11, 0x01, 0x13, 0x07, | ||
56 | 0xff | ||
57 | }; | ||
58 | |||
59 | static void banner(void) | ||
60 | { | ||
61 | static int pos = 0; | ||
62 | static int count = 0; | ||
63 | |||
64 | if (count) { | ||
65 | count--; | ||
66 | } else { | ||
67 | int val = banner_table[pos]; | ||
68 | if (val == 0xff) { | ||
69 | pos = 0; | ||
70 | val = banner_table[pos]; | ||
71 | } | ||
72 | pos++; | ||
73 | mach_led_d10((val >> 4) & 1); | ||
74 | count = 10 * (val & 0xf); | ||
75 | } | ||
76 | } | ||
77 | |||
78 | /* From heartbeat_harp in the stboards directory */ | ||
79 | /* acts like an actual heart beat -- ie thump-thump-pause... */ | ||
80 | void microdev_heartbeat(void) | ||
81 | { | ||
82 | static unsigned cnt = 0, period = 0, dist = 0; | ||
83 | |||
84 | if (cnt == 0 || cnt == dist) | ||
85 | mach_led_d9(1); | ||
86 | else if (cnt == 7 || cnt == dist+7) | ||
87 | mach_led_d9(0); | ||
88 | |||
89 | if (++cnt > period) { | ||
90 | cnt = 0; | ||
91 | /* The hyperbolic function below modifies the heartbeat period | ||
92 | * length in dependency of the current (5min) load. It goes | ||
93 | * through the points f(0)=126, f(1)=86, f(5)=51, | ||
94 | * f(inf)->30. */ | ||
95 | period = ((672<<FSHIFT)/(5*avenrun[0]+(7<<FSHIFT))) + 30; | ||
96 | dist = period / 4; | ||
97 | } | ||
98 | |||
99 | banner(); | ||
100 | } | ||
101 | |||
102 | #endif | ||