firm/junk/03/os/leddrv.c

   1 #include "leddrv.h"
   2 #include "led.h"
   3 #include "kozos.h"
   4
   5 /* \e$B%9%l%C%I$+$i$NMW5a$r=hM}$9$k\e(B */
   6 static int leddrv_command(char *p)
   7 {
   8   int cmd = p[0];
   9   int led = p[1] - '0';
  10   switch (cmd) {
  11   case LEDDRV_CMD_LED_ON:
  12     led_write(led, LedOn);
  13     break;
  14   case LEDDRV_CMD_LED_OFF:
  15     led_write(led, LedOff);
  16     break;
  17   case LEDDRV_CMD_LED_TOGGLE:
  18     led_toggle(led);
  19     break;
  20   default:
  21     break;
  22   }
  23   kz_kmfree(p);
  24
  25   return 0;
  26 }
  27
  28 int leddrv_main(int argc, char *argv[])
  29 {
  30   int size;
  31   char *p;
  32
  33   led_init();
  34   while (1) {
  35     kz_recv(MSGBOX_ID_LEDDRIVE, &size, &p);
  36     leddrv_command(p);
  37   }
  38
  39   return 0;
  40 }