release/src-rt-6.x.4708/linux/linux-2.6.36/arch/arm/mach-sa1100/leds-badge4.c

   1 /*
   2  * linux/arch/arm/mach-sa1100/leds-badge4.c
   3  *
   4  * Author: Christopher Hoover <ch@hpl.hp.com>
   5  * Copyright (C) 2002 Hewlett-Packard Company
   6  *
   7  * This program is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License version 2 as
   9  * published by the Free Software Foundation.
  10  *
  11  */
  12
  13 #include <linux/init.h>
  14
  15 #include <mach/hardware.h>
  16 #include <asm/leds.h>
  17 #include <asm/system.h>
  18
  19 #include "leds.h"
  20
  21 #define LED_STATE_ENABLED       1
  22 #define LED_STATE_CLAIMED       2
  23
  24 static unsigned int led_state;
  25 static unsigned int hw_led_state;
  26
  27 #define LED_RED         GPIO_GPIO(7)
  28 #define LED_GREEN       GPIO_GPIO(9)
  29 #define LED_MASK        (LED_RED|LED_GREEN)
  30
  31 #define LED_IDLE        LED_GREEN
  32 #define LED_TIMER       LED_RED
  33
  34 void badge4_leds_event(led_event_t evt)
  35 {
  36         unsigned long flags;
  37
  38         local_irq_save(flags);
  39
  40         switch (evt) {
  41         case led_start:
  42                 GPDR |= LED_MASK;
  43                 hw_led_state = LED_MASK;
  44                 led_state = LED_STATE_ENABLED;
  45                 break;
  46
  47         case led_stop:
  48                 led_state &= ~LED_STATE_ENABLED;
  49                 break;
  50
  51         case led_claim:
  52                 led_state |= LED_STATE_CLAIMED;
  53                 hw_led_state = LED_MASK;
  54                 break;
  55
  56         case led_release:
  57                 led_state &= ~LED_STATE_CLAIMED;
  58                 hw_led_state = LED_MASK;
  59                 break;
  60
  61 #ifdef CONFIG_LEDS_TIMER
  62         case led_timer:
  63                 if (!(led_state & LED_STATE_CLAIMED))
  64                         hw_led_state ^= LED_TIMER;
  65                 break;
  66 #endif
  67
  68 #ifdef CONFIG_LEDS_CPU
  69         case led_idle_start:
  70                 /* LED off when system is idle */
  71                 if (!(led_state & LED_STATE_CLAIMED))
  72                         hw_led_state &= ~LED_IDLE;
  73                 break;
  74
  75         case led_idle_end:
  76                 if (!(led_state & LED_STATE_CLAIMED))
  77                         hw_led_state |= LED_IDLE;
  78                 break;
  79 #endif
  80
  81         case led_red_on:
  82                 if (!(led_state & LED_STATE_CLAIMED))
  83                         hw_led_state &= ~LED_RED;
  84                 break;
  85
  86         case led_red_off:
  87                 if (!(led_state & LED_STATE_CLAIMED))
  88                         hw_led_state |= LED_RED;
  89                 break;
  90
  91         case led_green_on:
  92                 if (!(led_state & LED_STATE_CLAIMED))
  93                         hw_led_state &= ~LED_GREEN;
  94                 break;
  95
  96         case led_green_off:
  97                 if (!(led_state & LED_STATE_CLAIMED))
  98                         hw_led_state |= LED_GREEN;
  99                 break;
 100
 101         default:
 102                 break;
 103         }
 104
 105         if  (led_state & LED_STATE_ENABLED) {
 106                 GPSR = hw_led_state;
 107                 GPCR = hw_led_state ^ LED_MASK;
 108         }
 109
 110         local_irq_restore(flags);
 111 }