Allow leds to work in early user space by getting the

device entry in /dev, allow leds to be set to different
settings using 'leds'.

BKrev: 4292029fJdJ4KZzDf8ka7UNhpcVhkQ

2 files changed, 211 insertions, 0 deletions

diff --git a/packages/openslug-init/openslug-init-0.10/leds.c b/packages/openslug-init/openslug-init-0.10/leds.c
index e69de29bb2..e2120ae5d6 100644
--- a/packages/openslug-init/openslug-init-0.10/leds.c
+++ b/packages/openslug-init/openslug-init-0.10/leds.c
@@ -0,0 +1,190 @@
+ #include <stdio.h>
+ #include <stdlib.h>
+ #include <math.h>
+ #include <errno.h>
+ #include <string.h>
+ #include <endian.h>
+ #include <unistd.h>
+ #include <fcntl.h>
+ #include <sys/ioctl.h>
+ #include "leds.h"
+
+ static int leds;
+ static int reset;
+ static int verbose = 0;
+ enum {
+   off=0, on=1, blink, unknown, transition=unknown
+ };
+
+
+ void init_leds(void)
+ {
+   int i;
+   if ((leds = open("/dev/leds", O_RDWR)) < 0) {
+     int e1 = errno;
+     if (e1 != ENOENT) {
+
+       fprintf(stderr,"Error: Could not open LEDS device file '/dev/leds' : %s\n",
+               strerror(e1));
+       if(e1 == EACCES)
+         fprintf(stderr,"Run as root\n");
+       exit(1);
+     }
+   }
+
+   if (verbose)
+     printf("leds: initialized.\n");
+ }
+
+ void led_ioctl( int cmd, int num )
+ {
+   int i, st;
+
+   if (ioctl(leds, cmd, num) < 0) {
+     int e1 = errno;
+     fprintf(stderr, "leds: ioctl(%d,%d): failed to set leds: %s\n",
+	 cmd, num, strerror(e1));
+     exit(1);
+   }
+ }
+
+ void led_set( int led, int state )
+ {
+   switch (state) {
+   case off:   if (!reset) led_ioctl(N2_LM_OFF, led); break;
+   case on:    led_ioctl(N2_LM_ON, led); break;
+   case blink: /* Ensure any previous timer gets deleted first and that
+		* the LED is in a well known state.
+		*/
+	       if (!reset) led_ioctl(N2_LM_OFF, led);
+	       led_ioctl(N2_LM_BLINK, led); break;
+   }
+ }
+
+ int led( int ch ) {
+   switch (ch) {
+   case 'r': return LED_RS_RED;
+   case 'g': return LED_RS_GRN;
+   case '1': return LED_DISK1;
+   case '2': return LED_DISK2;
+   case 'A': reset = 1; return LED_ALL;
+   default:  fprintf(stderr, "leds: %c: unknown LED (use r,g,0,1 or A)\n", ch);
+	     exit(1);
+   }
+ }
+
+ int main( int argc, char **argv ) 
+ {
+	/* Default: switch green on, red off (-A +g). */
+	if (argc == 1) {
+	  verbose = 1;
+	  init_leds();
+	  led_ioctl(N2_LM_ALL_OFF, 0);
+	  led_ioctl(N2_LM_ON, LED_RS_GRN);
+	} else {
+	  int i, alt=0, state[PHYS_LEDS];
+	  for(i=0; i<PHYS_LEDS; ++i)
+	    state[i] = unknown;
+	  reset = 0;
+
+	  while (--argc > 0) {
+	    char *arg = *++argv;
+	    int st;
+	    if (strcmp(arg, "-v") == 0) {
+	      ++verbose;
+	      continue;
+	    }
+
+	    switch (*arg) {
+	    case '+': st = on; break;
+	    case '-': st = off; break;
+	    case '!': st = blink; break;
+	    case '/': st = transition; break;
+	    default:  fprintf(stderr, "leds: %c: unknown option\n", *arg);
+		      exit(1);
+	    }
+
+	    if (st != transition) {
+	      while (*++arg) {
+		i = led(*arg);
+		if (i == LED_ALL)
+		  for (i=0; i<PHYS_LEDS; ++i) state[i] = st;
+		else
+		  state[i] = st;
+	      }
+	    } else {
+	      int done, newstate[PHYS_LEDS];
+	      for(i=0; i<PHYS_LEDS; ++i)
+		newstate[i] = off;
+	      while (*++arg) {
+		i = led(*arg);
+		if (i == LED_ALL)
+		  for (i=0; i<PHYS_LEDS; ++i) newstate[i] = on;
+		else
+		  newstate[i] = on;
+	      }
+
+	      /* Merge the newstate back in.  This sets 'alt' if going
+	       * from an old state of just red to a new of just green
+	       * or vice versa (and this is the only way of getting
+	       * 'alt')
+	       */
+	      /* Blink anything which changes from off to on or from
+	       * on to off (this ignores anything already blinking).
+	       */
+	      for (done=i=0; i<PHYS_LEDS; ++i) {
+		if (state[i] == !newstate[i]) {
+		  done = 1;
+		  state[i] = blink;
+		}
+	      }
+
+	      /* Is anything (new) blinking?  If it is then deal
+	       * with the red/green case - blinking red,green is
+	       * amber, is that what we want?  This could be
+	       * improved by a better kernel interface - it would
+	       * be nice just to specify on/off times and a start
+	       * time for each LED.
+	       */
+	      if (done) {
+		if (state[LED_RS_RED] == blink && state[LED_RS_GRN] == blink &&
+		    newstate[LED_RS_RED] == !newstate[LED_RS_GRN]) {
+		  /* Kernel bug: must switch off r and g first. */
+		  alt = 1;
+		}
+	      } else {
+		for (i=0; i<PHYS_LEDS; ++i) {
+		  if (newstate[i] == on) {
+		    state[i] = blink;
+		  }
+		}
+	      }
+	    }
+	  }
+
+	  /* Go through the list making the required settings.  'alt' is
+	   * special.  'reset' means A was given and all the settings are
+	   * known.
+	   */
+	  init_leds();
+	  if (reset)
+	    led_ioctl(N2_LM_ALL_OFF, 0);
+	  if (alt) {
+	    /* Turn the leds off first to get to a known state. */
+	    led_set(LED_RS_GRN, off);
+	    led_set(LED_RS_RED, off);
+	    led_ioctl(N2_LM_ALT, LED_RS_RED);
+	  } else {
+	    /* KERNEL BUG: setting the green timer zaps the red behaviour
+	     * to toggle the green, therefore if red blink is set before
+	     * green blink no blink will happen!
+	     */
+	    led_set(LED_RS_GRN, state[LED_RS_GRN]);
+	    led_set(LED_RS_RED, state[LED_RS_RED]);
+	  }
+	  led_set(LED_DISK1, state[LED_DISK1]);
+	  led_set(LED_DISK2, state[LED_DISK2]);
+	}
+
+	return 0;
+ }
diff --git a/packages/openslug-init/openslug-init-0.10/leds.h b/packages/openslug-init/openslug-init-0.10/leds.h
index e69de29bb2..0b236dd6c0 100644
--- a/packages/openslug-init/openslug-init-0.10/leds.h
+++ b/packages/openslug-init/openslug-init-0.10/leds.h
@@ -0,0 +1,21 @@
+ void init_leds(void);
+ void led_on(int);
+ void led_off( int );
+ void led_toggle(int num);
+
+ // ioctls -- 'M" is used for sound cards...we don't got one so it seems safe
+ #define N2_LM_OFF               _IOW('M',32,long)
+ #define N2_LM_ON                _IOW('M',33,long)
+ #define N2_LM_BLINK             _IOW('M',34,long)
+ #define N2_LM_ALT               _IOW('M',35,long)
+ #define N2_LM_ALL_ON            _IO('M',36)
+ #define N2_LM_ALL_OFF           _IO('M',37)
+
+ // The LED names for switches
+ #define LED_RS_RED              0
+ #define LED_RS_GRN              1
+ #define LED_DISK1               2
+ #define LED_DISK2               3
+ #define LED_ALL                 4
+
+ #define PHYS_LEDS               4