sh: Add support for Solution Engine 7206 and 7619 boards.
[linux-2.6.git] / arch / sh / boards / se / 7206 / led.c
1 /*
2  * linux/arch/sh/kernel/led_se.c
3  *
4  * Copyright (C) 2000 Stuart Menefy <stuart.menefy@st.com>
5  *
6  * May be copied or modified under the terms of the GNU General Public
7  * License.  See linux/COPYING for more information.
8  *
9  * This file contains Solution Engine specific LED code.
10  */
11
12 #include <linux/config.h>
13 #include <asm/se7206.h>
14
15 #ifdef CONFIG_HEARTBEAT
16
17 #include <linux/sched.h>
18
19 /* Cycle the LED's in the clasic Knightrider/Sun pattern */
20 void heartbeat_se(void)
21 {
22         static unsigned int cnt = 0, period = 0;
23         volatile unsigned short* p = (volatile unsigned short*)PA_LED;
24         static unsigned bit = 0, up = 1;
25
26         cnt += 1;
27         if (cnt < period) {
28                 return;
29         }
30
31         cnt = 0;
32
33         /* Go through the points (roughly!):
34          * f(0)=10, f(1)=16, f(2)=20, f(5)=35,f(inf)->110
35          */
36         period = 110 - ( (300<<FSHIFT)/
37                          ((avenrun[0]/5) + (3<<FSHIFT)) );
38
39         if (up) {
40                 if (bit == 7) {
41                         bit--;
42                         up=0;
43                 } else {
44                         bit ++;
45                 }
46         } else {
47                 if (bit == 0) {
48                         bit++;
49                         up=1;
50                 } else {
51                         bit--;
52                 }
53         }
54         *p = 1<<(bit+8);
55
56 }
57 #endif /* CONFIG_HEARTBEAT */