diff options
Diffstat (limited to 'arch/arm/mach-integrator')
-rw-r--r-- | arch/arm/mach-integrator/leds.c | 48 |
1 files changed, 2 insertions, 46 deletions
diff --git a/arch/arm/mach-integrator/leds.c b/arch/arm/mach-integrator/leds.c index f1dcb57a59e2..56f243744b98 100644 --- a/arch/arm/mach-integrator/leds.c +++ b/arch/arm/mach-integrator/leds.c @@ -16,12 +16,8 @@ #if defined(CONFIG_NEW_LEDS) && defined(CONFIG_LEDS_CLASS) -#define ALPHA_REG __io_address(INTEGRATOR_DBG_BASE) -#define LEDREG (__io_address(INTEGRATOR_DBG_BASE) + INTEGRATOR_DBG_LEDS_OFFSET) - struct integrator_led { struct led_classdev cdev; - u8 mask; }; /* @@ -32,40 +28,9 @@ static const struct { const char *name; const char *trigger; } integrator_leds[] = { - { "integrator:green0", "heartbeat", }, - { "integrator:yellow", }, - { "integrator:red", }, - { "integrator:green1", }, { "integrator:core_module", "cpu0", }, }; -static void integrator_led_set(struct led_classdev *cdev, - enum led_brightness b) -{ - struct integrator_led *led = container_of(cdev, - struct integrator_led, cdev); - u32 reg = __raw_readl(LEDREG); - - if (b != LED_OFF) - reg |= led->mask; - else - reg &= ~led->mask; - - while (__raw_readl(ALPHA_REG) & 1) - cpu_relax(); - - __raw_writel(reg, LEDREG); -} - -static enum led_brightness integrator_led_get(struct led_classdev *cdev) -{ - struct integrator_led *led = container_of(cdev, - struct integrator_led, cdev); - u32 reg = __raw_readl(LEDREG); - - return (reg & led->mask) ? LED_FULL : LED_OFF; -} - static void cm_led_set(struct led_classdev *cdev, enum led_brightness b) { @@ -93,19 +58,10 @@ static int __init integrator_leds_init(void) if (!led) break; - led->cdev.name = integrator_leds[i].name; - - if (i == 4) { /* Setting for LED in core module */ - led->cdev.brightness_set = cm_led_set; - led->cdev.brightness_get = cm_led_get; - } else { - led->cdev.brightness_set = integrator_led_set; - led->cdev.brightness_get = integrator_led_get; - } - + led->cdev.brightness_set = cm_led_set; + led->cdev.brightness_get = cm_led_get; led->cdev.default_trigger = integrator_leds[i].trigger; - led->mask = BIT(i); if (led_classdev_register(NULL, &led->cdev) < 0) { kfree(led); |