arch/arm/kernel/leds-footbridge.c

   1 /*
   2  * arch/arm/kernel/leds-footbridge.c
   3  *
   4  * Copyright (C) 1998-1999 Russell King
   5  *
   6  * EBSA-285 and NetWinder LED control routines.
   7  *
   8  * The EBSA-285 uses the leds as follows:
   9  *  - Green - toggles state every 50 timer interrupts
  10  *  - Amber - On if system is not idle
  11  *  - Red   - currently unused
  12  *
  13  * The Netwinder uses the leds as follows:
  14  *  - Green - toggles state every 50 timer interrupts
  15  *  - Red   - On if the system is not idle
  16  *
  17  * Changelog:
  18  *   02-05-1999 RMK     Various cleanups
  19  */
  20 #include <linux/config.h>
  21 #include <linux/kernel.h>
  22 #include <linux/module.h>
  23 #include <linux/init.h>
  24 #include <linux/spinlock.h>
  25
  26 #include <asm/hardware.h>
  27 #include <asm/leds.h>
  28 #include <asm/system.h>
  29
  30 #define LED_STATE_ENABLED       1
  31 #define LED_STATE_CLAIMED       2
  32 static char led_state;
  33 static char hw_led_state;
  34
  35 static spinlock_t leds_lock = SPIN_LOCK_UNLOCKED;
  36 extern spinlock_t gpio_lock;
  37
  38 #ifdef CONFIG_FOOTBRIDGE
  39
  40 static void __ebsa285_text ebsa285_leds_event(led_event_t evt)
  41 {
  42         unsigned long flags;
  43
  44         spin_lock_irqsave(&leds_lock, flags);
  45
  46         switch (evt) {
  47         case led_start:
  48                 hw_led_state = XBUS_LED_RED | XBUS_LED_GREEN;
  49 #ifndef CONFIG_LEDS_IDLE
  50                 hw_led_state |= XBUS_LED_AMBER;
  51 #endif
  52                 led_state |= LED_STATE_ENABLED;
  53                 break;
  54
  55         case led_stop:
  56                 led_state &= ~LED_STATE_ENABLED;
  57                 break;
  58
  59         case led_claim:
  60                 led_state |= LED_STATE_CLAIMED;
  61                 hw_led_state = XBUS_LED_RED | XBUS_LED_GREEN | XBUS_LED_AMBER;
  62                 break;
  63
  64         case led_release:
  65                 led_state &= ~LED_STATE_CLAIMED;
  66                 hw_led_state = XBUS_LED_RED | XBUS_LED_GREEN | XBUS_LED_AMBER;
  67                 break;
  68
  69 #ifdef CONFIG_LEDS_TIMER
  70         case led_timer:
  71                 if (!(led_state & LED_STATE_CLAIMED))
  72                         hw_led_state ^= XBUS_LED_GREEN;
  73                 break;
  74 #endif
  75
  76 #ifdef CONFIG_LEDS_CPU
  77         case led_idle_start:
  78                 if (!(led_state & LED_STATE_CLAIMED))
  79                         hw_led_state |= XBUS_LED_RED;
  80                 break;
  81
  82         case led_idle_end:
  83                 if (!(led_state & LED_STATE_CLAIMED))
  84                         hw_led_state &= ~XBUS_LED_RED;
  85                 break;
  86 #endif
  87
  88         case led_green_on:
  89                 if (led_state & LED_STATE_CLAIMED)
  90                         hw_led_state &= ~XBUS_LED_GREEN;
  91                 break;
  92
  93         case led_green_off:
  94                 if (led_state & LED_STATE_CLAIMED)
  95                         hw_led_state |= XBUS_LED_GREEN;
  96                 break;
  97
  98         case led_amber_on:
  99                 if (led_state & LED_STATE_CLAIMED)
 100                         hw_led_state &= ~XBUS_LED_AMBER;
 101                 break;
 102
 103         case led_amber_off:
 104                 if (led_state & LED_STATE_CLAIMED)
 105                         hw_led_state |= XBUS_LED_AMBER;
 106                 break;
 107
 108         case led_red_on:
 109                 if (led_state & LED_STATE_CLAIMED)
 110                         hw_led_state &= ~XBUS_LED_RED;
 111                 break;
 112
 113         case led_red_off:
 114                 if (led_state & LED_STATE_CLAIMED)
 115                         hw_led_state |= XBUS_LED_RED;
 116                 break;
 117
 118         default:
 119                 break;
 120         }
 121
 122         if  (led_state & LED_STATE_ENABLED)
 123                 *XBUS_LEDS = hw_led_state;
 124
 125         spin_unlock_irqrestore(&leds_lock, flags);
 126 }
 127
 128 #endif
 129
 130 #ifdef CONFIG_ARCH_NETWINDER
 131
 132 static void __netwinder_text netwinder_leds_event(led_event_t evt)
 133 {
 134         unsigned long flags;
 135
 136         spin_lock_irqsave(&leds_lock, flags);
 137
 138         switch (evt) {
 139         case led_start:
 140                 led_state |= LED_STATE_ENABLED;
 141                 hw_led_state = 0;
 142                 break;
 143
 144         case led_stop:
 145                 led_state &= ~LED_STATE_ENABLED;
 146                 break;
 147
 148         case led_claim:
 149                 led_state |= LED_STATE_CLAIMED;
 150                 hw_led_state = 0;
 151                 break;
 152
 153         case led_release:
 154                 led_state &= ~LED_STATE_CLAIMED;
 155                 hw_led_state = 0;
 156                 break;
 157
 158 #ifdef CONFIG_LEDS_TIMER
 159         case led_timer:
 160                 if (!(led_state & LED_STATE_CLAIMED))
 161                         hw_led_state ^= GPIO_GREEN_LED;
 162                 break;
 163 #endif
 164
 165 #ifdef CONFIG_LEDS_CPU
 166         case led_idle_start:
 167                 if (!(led_state & LED_STATE_CLAIMED))
 168                         hw_led_state &= ~GPIO_RED_LED;
 169                 break;
 170
 171         case led_idle_end:
 172                 if (!(led_state & LED_STATE_CLAIMED))
 173                         hw_led_state |= GPIO_RED_LED;
 174                 break;
 175 #endif
 176
 177         case led_green_on:
 178                 if (led_state & LED_STATE_CLAIMED)
 179                         hw_led_state |= GPIO_GREEN_LED;
 180                 break;
 181
 182         case led_green_off:
 183                 if (led_state & LED_STATE_CLAIMED)
 184                         hw_led_state &= ~GPIO_GREEN_LED;
 185                 break;
 186
 187         case led_amber_on:
 188                 if (led_state & LED_STATE_CLAIMED)
 189                         hw_led_state |= GPIO_GREEN_LED | GPIO_RED_LED;
 190                 break;
 191
 192         case led_amber_off:
 193                 if (led_state & LED_STATE_CLAIMED)
 194                         hw_led_state &= ~(GPIO_GREEN_LED | GPIO_RED_LED);
 195                 break;
 196
 197         case led_red_on:
 198                 if (led_state & LED_STATE_CLAIMED)
 199                         hw_led_state |= GPIO_RED_LED;
 200                 break;
 201
 202         case led_red_off:
 203                 if (led_state & LED_STATE_CLAIMED)
 204                         hw_led_state &= ~GPIO_RED_LED;
 205                 break;
 206
 207         default:
 208                 break;
 209         }
 210
 211         spin_unlock_irqrestore(&leds_lock, flags);
 212
 213         if  (led_state & LED_STATE_ENABLED) {
 214                 spin_lock_irqsave(&gpio_lock, flags);
 215                 gpio_modify_op(GPIO_RED_LED | GPIO_GREEN_LED, hw_led_state);
 216                 spin_unlock_irqrestore(&gpio_lock, flags);
 217         }
 218 }
 219
 220 #endif
 221
 222 static void dummy_leds_event(led_event_t evt)
 223 {
 224 }
 225
 226 void __init
 227 init_leds_event(led_event_t evt)
 228 {
 229         switch (machine_arch_type) {
 230 #ifdef CONFIG_FOOTBRIDGE
 231         case MACH_TYPE_EBSA285:
 232         case MACH_TYPE_CO285:
 233                 leds_event = ebsa285_leds_event;
 234                 break;
 235 #endif
 236 #ifdef CONFIG_ARCH_NETWINDER
 237         case MACH_TYPE_NETWINDER:
 238                 leds_event = netwinder_leds_event;
 239                 break;
 240 #endif
 241
 242         default:
 243                 leds_event = dummy_leds_event;
 244         }
 245
 246         leds_event(evt);
 247 }
 248
 249 void (*leds_event)(led_event_t) = init_leds_event;
 250
 251 EXPORT_SYMBOL(leds_event);