summaryrefslogtreecommitdiff
path: root/packages/openslug-init
diff options
context:
space:
mode:
authorJohn Bowler <jbowler@nslu2-linux.org>2005-05-23 16:19:43 +0000
committerJohn Bowler <jbowler@nslu2-linux.org>2005-05-23 16:19:43 +0000
commit18eee2c488db374851ff2ec09845134d9f791fb8 (patch)
tree1e1f3903bde216f9a6e1153357f66cd9aae6f532 /packages/openslug-init
parent8bc11aeda8d5540d1625fe46725178725e1826c1 (diff)
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
Diffstat (limited to 'packages/openslug-init')
-rw-r--r--packages/openslug-init/openslug-init-0.10/leds.c190
-rw-r--r--packages/openslug-init/openslug-init-0.10/leds.h21
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