| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
|  | 2 | * linux/arch/arm/mach-sa1100/leds-simpad.c | 
|  | 3 | * | 
|  | 4 | * Author: Juergen Messerer <juergen.messerer@siemens.ch> | 
|  | 5 | */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 6 | #include <linux/init.h> | 
|  | 7 |  | 
| Russell King | a09e64f | 2008-08-05 16:14:15 +0100 | [diff] [blame] | 8 | #include <mach/hardware.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 9 | #include <asm/leds.h> | 
|  | 10 | #include <asm/system.h> | 
| Russell King | a09e64f | 2008-08-05 16:14:15 +0100 | [diff] [blame] | 11 | #include <mach/simpad.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 12 |  | 
|  | 13 | #include "leds.h" | 
|  | 14 |  | 
|  | 15 |  | 
|  | 16 | #define LED_STATE_ENABLED	1 | 
|  | 17 | #define LED_STATE_CLAIMED	2 | 
|  | 18 |  | 
|  | 19 | static unsigned int led_state; | 
|  | 20 | static unsigned int hw_led_state; | 
|  | 21 |  | 
|  | 22 | #define	LED_GREEN	(1) | 
|  | 23 | #define	LED_MASK	(1) | 
|  | 24 |  | 
|  | 25 | extern void set_cs3_bit(int value); | 
|  | 26 | extern void clear_cs3_bit(int value); | 
|  | 27 |  | 
|  | 28 | void simpad_leds_event(led_event_t evt) | 
|  | 29 | { | 
|  | 30 | switch (evt) | 
|  | 31 | { | 
|  | 32 | case led_start: | 
|  | 33 | hw_led_state = LED_GREEN; | 
|  | 34 | led_state = LED_STATE_ENABLED; | 
|  | 35 | break; | 
|  | 36 |  | 
|  | 37 | case led_stop: | 
|  | 38 | led_state &= ~LED_STATE_ENABLED; | 
|  | 39 | break; | 
|  | 40 |  | 
|  | 41 | case led_claim: | 
|  | 42 | led_state |= LED_STATE_CLAIMED; | 
|  | 43 | hw_led_state = LED_GREEN; | 
|  | 44 | break; | 
|  | 45 |  | 
|  | 46 | case led_release: | 
|  | 47 | led_state &= ~LED_STATE_CLAIMED; | 
|  | 48 | hw_led_state = LED_GREEN; | 
|  | 49 | break; | 
|  | 50 |  | 
|  | 51 | #ifdef CONFIG_LEDS_TIMER | 
|  | 52 | case led_timer: | 
|  | 53 | if (!(led_state & LED_STATE_CLAIMED)) | 
|  | 54 | hw_led_state ^= LED_GREEN; | 
|  | 55 | break; | 
|  | 56 | #endif | 
|  | 57 |  | 
|  | 58 | #ifdef CONFIG_LEDS_CPU | 
|  | 59 | case led_idle_start: | 
|  | 60 | break; | 
|  | 61 |  | 
|  | 62 | case led_idle_end: | 
|  | 63 | break; | 
|  | 64 | #endif | 
|  | 65 |  | 
|  | 66 | case led_halted: | 
|  | 67 | break; | 
|  | 68 |  | 
|  | 69 | case led_green_on: | 
|  | 70 | if (led_state & LED_STATE_CLAIMED) | 
|  | 71 | hw_led_state |= LED_GREEN; | 
|  | 72 | break; | 
|  | 73 |  | 
|  | 74 | case led_green_off: | 
|  | 75 | if (led_state & LED_STATE_CLAIMED) | 
|  | 76 | hw_led_state &= ~LED_GREEN; | 
|  | 77 | break; | 
|  | 78 |  | 
|  | 79 | case led_amber_on: | 
|  | 80 | break; | 
|  | 81 |  | 
|  | 82 | case led_amber_off: | 
|  | 83 | break; | 
|  | 84 |  | 
|  | 85 | case led_red_on: | 
|  | 86 | break; | 
|  | 87 |  | 
|  | 88 | case led_red_off: | 
|  | 89 | break; | 
|  | 90 |  | 
|  | 91 | default: | 
|  | 92 | break; | 
|  | 93 | } | 
|  | 94 |  | 
|  | 95 | if  (led_state & LED_STATE_ENABLED) | 
|  | 96 | set_cs3_bit(LED2_ON); | 
|  | 97 | else | 
|  | 98 | clear_cs3_bit(LED2_ON); | 
|  | 99 | } | 
|  | 100 |  |