11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * linux/arch/arm/mach-footbridge/ebsa285.c 31da177e4SLinus Torvalds * 41da177e4SLinus Torvalds * EBSA285 machine fixup 51da177e4SLinus Torvalds */ 61da177e4SLinus Torvalds #include <linux/init.h> 770d13e08SRussell King #include <linux/spinlock.h> 8cf6856d6SBryan Wu #include <linux/slab.h> 9cf6856d6SBryan Wu #include <linux/leds.h> 101da177e4SLinus Torvalds 111da177e4SLinus Torvalds #include <asm/hardware/dec21285.h> 121da177e4SLinus Torvalds #include <asm/mach-types.h> 131da177e4SLinus Torvalds 141da177e4SLinus Torvalds #include <asm/mach/arch.h> 151da177e4SLinus Torvalds 161da177e4SLinus Torvalds #include "common.h" 171da177e4SLinus Torvalds 18cf6856d6SBryan Wu /* LEDs */ 19cf6856d6SBryan Wu #if defined(CONFIG_NEW_LEDS) && defined(CONFIG_LEDS_CLASS) 20cf6856d6SBryan Wu struct ebsa285_led { 21cf6856d6SBryan Wu struct led_classdev cdev; 22cf6856d6SBryan Wu u8 mask; 23cf6856d6SBryan Wu }; 24cf6856d6SBryan Wu 25cf6856d6SBryan Wu /* 26cf6856d6SBryan Wu * The triggers lines up below will only be used if the 27cf6856d6SBryan Wu * LED triggers are compiled in. 28cf6856d6SBryan Wu */ 29cf6856d6SBryan Wu static const struct { 30cf6856d6SBryan Wu const char *name; 31cf6856d6SBryan Wu const char *trigger; 32cf6856d6SBryan Wu } ebsa285_leds[] = { 33cf6856d6SBryan Wu { "ebsa285:amber", "heartbeat", }, 34cf6856d6SBryan Wu { "ebsa285:green", "cpu0", }, 35cf6856d6SBryan Wu { "ebsa285:red",}, 36cf6856d6SBryan Wu }; 37cf6856d6SBryan Wu 38cf6856d6SBryan Wu static void ebsa285_led_set(struct led_classdev *cdev, 39cf6856d6SBryan Wu enum led_brightness b) 40cf6856d6SBryan Wu { 41cf6856d6SBryan Wu struct ebsa285_led *led = container_of(cdev, 42cf6856d6SBryan Wu struct ebsa285_led, cdev); 43cf6856d6SBryan Wu 44cf6856d6SBryan Wu if (b != LED_OFF) 45cf6856d6SBryan Wu *XBUS_LEDS |= led->mask; 46cf6856d6SBryan Wu else 47cf6856d6SBryan Wu *XBUS_LEDS &= ~led->mask; 48cf6856d6SBryan Wu } 49cf6856d6SBryan Wu 50cf6856d6SBryan Wu static enum led_brightness ebsa285_led_get(struct led_classdev *cdev) 51cf6856d6SBryan Wu { 52cf6856d6SBryan Wu struct ebsa285_led *led = container_of(cdev, 53cf6856d6SBryan Wu struct ebsa285_led, cdev); 54cf6856d6SBryan Wu 55cf6856d6SBryan Wu return (*XBUS_LEDS & led->mask) ? LED_FULL : LED_OFF; 56cf6856d6SBryan Wu } 57cf6856d6SBryan Wu 58cf6856d6SBryan Wu static int __init ebsa285_leds_init(void) 59cf6856d6SBryan Wu { 60cf6856d6SBryan Wu int i; 61cf6856d6SBryan Wu 62cf6856d6SBryan Wu if (machine_is_ebsa285()) 63cf6856d6SBryan Wu return -ENODEV; 64cf6856d6SBryan Wu 65cf6856d6SBryan Wu /* 3 LEDS All ON */ 66cf6856d6SBryan Wu *XBUS_LEDS |= XBUS_LED_AMBER | XBUS_LED_GREEN | XBUS_LED_RED; 67cf6856d6SBryan Wu 68cf6856d6SBryan Wu for (i = 0; i < ARRAY_SIZE(ebsa285_leds); i++) { 69cf6856d6SBryan Wu struct ebsa285_led *led; 70cf6856d6SBryan Wu 71cf6856d6SBryan Wu led = kzalloc(sizeof(*led), GFP_KERNEL); 72cf6856d6SBryan Wu if (!led) 73cf6856d6SBryan Wu break; 74cf6856d6SBryan Wu 75cf6856d6SBryan Wu led->cdev.name = ebsa285_leds[i].name; 76cf6856d6SBryan Wu led->cdev.brightness_set = ebsa285_led_set; 77cf6856d6SBryan Wu led->cdev.brightness_get = ebsa285_led_get; 78cf6856d6SBryan Wu led->cdev.default_trigger = ebsa285_leds[i].trigger; 79cf6856d6SBryan Wu led->mask = BIT(i); 80cf6856d6SBryan Wu 81cf6856d6SBryan Wu if (led_classdev_register(NULL, &led->cdev) < 0) { 82cf6856d6SBryan Wu kfree(led); 83cf6856d6SBryan Wu break; 84cf6856d6SBryan Wu } 85cf6856d6SBryan Wu } 86cf6856d6SBryan Wu 87cf6856d6SBryan Wu return 0; 88cf6856d6SBryan Wu } 89cf6856d6SBryan Wu 90cf6856d6SBryan Wu /* 91cf6856d6SBryan Wu * Since we may have triggers on any subsystem, defer registration 92cf6856d6SBryan Wu * until after subsystem_init. 93cf6856d6SBryan Wu */ 94cf6856d6SBryan Wu fs_initcall(ebsa285_leds_init); 95cf6856d6SBryan Wu #endif 96cf6856d6SBryan Wu 971da177e4SLinus Torvalds MACHINE_START(EBSA285, "EBSA285") 98e9dea0c6SRussell King /* Maintainer: Russell King */ 9993ef8883SNicolas Pitre .atag_offset = 0x100, 100e9dea0c6SRussell King .video_start = 0x000a0000, 101e9dea0c6SRussell King .video_end = 0x000bffff, 102e9dea0c6SRussell King .map_io = footbridge_map_io, 103e9dea0c6SRussell King .init_irq = footbridge_init_irq, 1046bb27d73SStephen Warren .init_time = footbridge_timer_init, 1056fca1e17SRussell King .restart = footbridge_restart, 1061da177e4SLinus Torvalds MACHINE_END 1071da177e4SLinus Torvalds 108