arch/sh64/kernel/led.c

   1 /*
   2  * arch/sh64/kernel/led.c
   3  *
   4  * Copyright (C) 2002 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  * Flash the LEDs
  10  */
  11 #include <linux/config.h>
  12 #include <linux/stddef.h>
  13 #include <linux/sched.h>
  14
  15 void mach_alphanum(int pos, unsigned char val);
  16 void mach_led(int pos, int val);
  17
  18 void print_seg(char *file, int line)
  19 {
  20         int i;
  21         unsigned int nibble;
  22
  23         for (i = 0; i < 5; i++) {
  24                 mach_alphanum(i, file[i]);
  25         }
  26
  27         for (i = 0; i < 3; i++) {
  28                 nibble = ((line >> (i * 4)) & 0xf);
  29                 mach_alphanum(7 - i, nibble + ((nibble > 9) ? 55 : 48));
  30         }
  31 }
  32
  33 void print_seg_num(unsigned num)
  34 {
  35         int i;
  36         unsigned int nibble;
  37
  38         for (i = 0; i < 8; i++) {
  39                 nibble = ((num >> (i * 4)) & 0xf);
  40
  41                 mach_alphanum(7 - i, nibble + ((nibble > 9) ? 55 : 48));
  42         }
  43 }
  44
  45 /* acts like an actual heart beat -- ie thump-thump-pause... */
  46 void heartbeat(void)
  47 {
  48         static unsigned int cnt = 0, period = 0, dist = 0;
  49
  50         if (cnt == 0 || cnt == dist) {
  51                 mach_led(-1, 1);
  52         } else if (cnt == 7 || cnt == dist + 7) {
  53                 mach_led(-1, 0);
  54         }
  55
  56         if (++cnt > period) {
  57                 cnt = 0;
  58
  59                 /*
  60                  * The hyperbolic function below modifies the heartbeat period
  61                  * length in dependency of the current (5min) load. It goes
  62                  * through the points f(0)=126, f(1)=86, f(5)=51, f(inf)->30.
  63                  */
  64                 period = ((672 << FSHIFT) / (5 * avenrun[0] +
  65                                             (7 << FSHIFT))) + 30;
  66                 dist = period / 4;
  67         }
  68 }
  69