/* * LED driver for Atmel AT91-based boards. * * Copyright (C) SAN People (Pty) Ltd * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License * as published by the Free Software Foundation; either version * 2 of the License, or (at your option) any later version. */ #include <linux/kernel.h> #include <linux/module.h> #include <linux/init.h> #include <asm/mach-types.h> #include <asm/leds.h> #include <asm/arch/board.h> #include <asm/arch/gpio.h> static inline void at91_led_on(unsigned int led) { at91_set_gpio_value(led, 0); } static inline void at91_led_off(unsigned int led) { at91_set_gpio_value(led, 1); } static inline void at91_led_toggle(unsigned int led) { unsigned long is_off = at91_get_gpio_value(led); if (is_off) at91_led_on(led); else at91_led_off(led); } /* * Handle LED events. */ static void at91_leds_event(led_event_t evt) { unsigned long flags; local_irq_save(flags); switch(evt) { case led_start: /* System startup */ at91_led_on(at91_leds_cpu); break; case led_stop: /* System stop / suspend */ at91_led_off(at91_leds_cpu); break; #ifdef CONFIG_LEDS_TIMER case led_timer: /* Every 50 timer ticks */ at91_led_toggle(at91_leds_timer); break; #endif #ifdef CONFIG_LEDS_CPU case led_idle_start: /* Entering idle state */ at91_led_off(at91_leds_cpu); break; case led_idle_end: /* Exit idle state */ at91_led_on(at91_leds_cpu); break; #endif default: break; } local_irq_restore(flags); } static int __init leds_init(void) { if (!at91_leds_timer || !at91_leds_cpu) return -ENODEV; /* Enable PIO to access the LEDs */ at91_set_gpio_output(at91_leds_timer, 1); at91_set_gpio_output(at91_leds_cpu, 1); leds_event = at91_leds_event; leds_event(led_start); return 0; } __initcall(leds_init);