linux-imx

/*

 * linux/drivers/leds/leds-locomo.c

 *

 * Copyright (C) 2005 John Lenz <lenz@cs.wisc.edu>

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License version 2 as

 * published by the Free Software Foundation.

 */

​

#include <linux/kernel.h>

#include <linux/init.h>

#include <linux/module.h>

#include <linux/device.h>

#include <linux/leds.h>

​

#include <mach/hardware.h>

#include <asm/hardware/locomo.h>

​

static void locomoled_brightness_set(struct led_classdev *led_cdev,

                enum led_brightness value, int offset)

{

    struct locomo_dev *locomo_dev = LOCOMO_DEV(led_cdev->dev->parent);

    unsigned long flags;

​

    local_irq_save(flags);

    if (value)

        locomo_writel(LOCOMO_LPT_TOFH, locomo_dev->mapbase + offset);

    else

        locomo_writel(LOCOMO_LPT_TOFL, locomo_dev->mapbase + offset);

    local_irq_restore(flags);

}

​

static void locomoled_brightness_set0(struct led_classdev *led_cdev,

                enum led_brightness value)

{

    locomoled_brightness_set(led_cdev, value, LOCOMO_LPT0);

}

​

static void locomoled_brightness_set1(struct led_classdev *led_cdev,

                enum led_brightness value)

{

    locomoled_brightness_set(led_cdev, value, LOCOMO_LPT1);

}

​

static struct led_classdev locomo_led0 = {

    .name           = "locomo:amber:charge",

    .default_trigger    = "main-battery-charging",

    .brightness_set     = locomoled_brightness_set0,

};

​

static struct led_classdev locomo_led1 = {

    .name           = "locomo:green:mail",

    .default_trigger    = "nand-disk",

    .brightness_set     = locomoled_brightness_set1,

};

​

static int locomoled_probe(struct locomo_dev *ldev)

{

    int ret;

​

    ret = devm_led_classdev_register(&ldev->dev, &locomo_led0);

    if (ret < 0)