arch/arm/mach-at91/leds.c

   1 /*
   2  * LED driver for Atmel AT91-based boards.
   3  *
   4  *  Copyright (C) SAN People (Pty) Ltd
   5  *
   6  * This program is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU General Public License
   8  * as published by the Free Software Foundation; either version
   9  * 2 of the License, or (at your option) any later version.
  10 */
  11
  12 #include <linux/kernel.h>
  13 #include <linux/module.h>
  14 #include <linux/init.h>
  15
  16 #include <mach/board.h>
  17 #include <mach/gpio.h>
  18
  19
  20 /* ------------------------------------------------------------------------- */
  21
  22 #if defined(CONFIG_NEW_LEDS)
  23
  24 #include <linux/platform_device.h>
  25
  26 /*
  27  * New cross-platform LED support.
  28  */
  29
  30 static struct gpio_led_platform_data led_data;
  31
  32 static struct platform_device at91_leds = {
  33         .name                   = "leds-gpio",
  34         .id                     = -1,
  35         .dev.platform_data      = &led_data,
  36 };
  37
  38 void __init at91_gpio_leds(struct gpio_led *leds, int nr)
  39 {
  40         int i;
  41
  42         if (!nr)
  43                 return;
  44
  45         for (i = 0; i < nr; i++)
  46                 at91_set_gpio_output(leds[i].gpio, leds[i].active_low);
  47
  48         led_data.leds = leds;
  49         led_data.num_leds = nr;
  50         platform_device_register(&at91_leds);
  51 }
  52
  53 #else
  54 void __init at91_gpio_leds(struct gpio_led *leds, int nr) {}
  55 #endif
  56
  57
  58 /* ------------------------------------------------------------------------- */
  59
  60 #if defined(CONFIG_LEDS)
  61
  62 #include <asm/leds.h>
  63
  64 /*
  65  * Old ARM-specific LED framework; not fully functional when generic time is
  66  * in use.
  67  */
  68
  69 static u8 at91_leds_cpu;
  70 static u8 at91_leds_timer;
  71
  72 static inline void at91_led_on(unsigned int led)
  73 {
  74         at91_set_gpio_value(led, 0);
  75 }
  76
  77 static inline void at91_led_off(unsigned int led)
  78 {
  79         at91_set_gpio_value(led, 1);
  80 }
  81
  82 static inline void at91_led_toggle(unsigned int led)
  83 {
  84         unsigned long is_off = at91_get_gpio_value(led);
  85         if (is_off)
  86                 at91_led_on(led);
  87         else
  88                 at91_led_off(led);
  89 }
  90
  91
  92 /*
  93  * Handle LED events.
  94  */
  95 static void at91_leds_event(led_event_t evt)
  96 {
  97         unsigned long flags;
  98
  99         local_irq_save(flags);
 100
 101         switch(evt) {
 102         case led_start:         /* System startup */
 103                 at91_led_on(at91_leds_cpu);
 104                 break;
 105
 106         case led_stop:          /* System stop / suspend */
 107                 at91_led_off(at91_leds_cpu);
 108                 break;
 109
 110 #ifdef CONFIG_LEDS_TIMER
 111         case led_timer:         /* Every 50 timer ticks */
 112                 at91_led_toggle(at91_leds_timer);
 113                 break;
 114 #endif
 115
 116 #ifdef CONFIG_LEDS_CPU
 117         case led_idle_start:    /* Entering idle state */
 118                 at91_led_off(at91_leds_cpu);
 119                 break;
 120
 121         case led_idle_end:      /* Exit idle state */
 122                 at91_led_on(at91_leds_cpu);
 123                 break;
 124 #endif
 125
 126         default:
 127                 break;
 128         }
 129
 130         local_irq_restore(flags);
 131 }
 132
 133
 134 static int __init leds_init(void)
 135 {
 136         if (!at91_leds_timer || !at91_leds_cpu)
 137                 return -ENODEV;
 138
 139         leds_event = at91_leds_event;
 140
 141         leds_event(led_start);
 142         return 0;
 143 }
 144
 145 __initcall(leds_init);
 146
 147
 148 void __init at91_init_leds(u8 cpu_led, u8 timer_led)
 149 {
 150         /* Enable GPIO to access the LEDs */
 151         at91_set_gpio_output(cpu_led, 1);
 152         at91_set_gpio_output(timer_led, 1);
 153
 154         at91_leds_cpu   = cpu_led;
 155         at91_leds_timer = timer_led;
 156 }
 157
 158 #else
 159 void __init at91_init_leds(u8 cpu_led, u8 timer_led) {}
 160 #endif