[deliverable/linux.git] / drivers / leds / leds-locomo.c

/*
 * 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)
		return ret;

	return  devm_led_classdev_register(&ldev->dev, &locomo_led1);
}


static struct locomo_driver locomoled_driver = {
	.drv = {
		.name = "locomoled"
	},
	.devid	= LOCOMO_DEVID_LED,
	.probe	= locomoled_probe,
};

static int __init locomoled_init(void)
{
	return locomo_driver_register(&locomoled_driver);
}
module_init(locomoled_init);

MODULE_AUTHOR("John Lenz <lenz@cs.wisc.edu>");
MODULE_DESCRIPTION("Locomo LED driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
	1	/*
	2	* linux/drivers/leds/leds-locomo.c
	3	*
	4	* Copyright (C) 2005 John Lenz <lenz@cs.wisc.edu>
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License version 2 as
	8	* published by the Free Software Foundation.
	9	*/
	10
	11	#include <linux/kernel.h>
	12	#include <linux/init.h>
	13	#include <linux/module.h>
	14	#include <linux/device.h>
	15	#include <linux/leds.h>
	16
	17	#include <mach/hardware.h>
	18	#include <asm/hardware/locomo.h>
	19
	20	static void locomoled_brightness_set(struct led_classdev *led_cdev,
	21	enum led_brightness value, int offset)
	22	{
	23	struct locomo_dev *locomo_dev = LOCOMO_DEV(led_cdev->dev->parent);
	24	unsigned long flags;
	25
	26	local_irq_save(flags);
	27	if (value)
	28	locomo_writel(LOCOMO_LPT_TOFH, locomo_dev->mapbase + offset);
	29	else
	30	locomo_writel(LOCOMO_LPT_TOFL, locomo_dev->mapbase + offset);
	31	local_irq_restore(flags);
	32	}
	33
	34	static void locomoled_brightness_set0(struct led_classdev *led_cdev,
	35	enum led_brightness value)
	36	{
	37	locomoled_brightness_set(led_cdev, value, LOCOMO_LPT0);
	38	}
	39
	40	static void locomoled_brightness_set1(struct led_classdev *led_cdev,
	41	enum led_brightness value)
	42	{
	43	locomoled_brightness_set(led_cdev, value, LOCOMO_LPT1);
	44	}
	45
	46	static struct led_classdev locomo_led0 = {
	47	.name = "locomo:amber:charge",
	48	.default_trigger = "main-battery-charging",
	49	.brightness_set = locomoled_brightness_set0,
	50	};
	51
	52	static struct led_classdev locomo_led1 = {
	53	.name = "locomo:green:mail",
	54	.default_trigger = "nand-disk",
	55	.brightness_set = locomoled_brightness_set1,
	56	};
	57
	58	static int locomoled_probe(struct locomo_dev *ldev)
	59	{
	60	int ret;
	61
	62	ret = devm_led_classdev_register(&ldev->dev, &locomo_led0);
	63	if (ret < 0)
	64	return ret;
	65
	66	return devm_led_classdev_register(&ldev->dev, &locomo_led1);
	67	}
	68
	69
	70	static struct locomo_driver locomoled_driver = {
	71	.drv = {
	72	.name = "locomoled"
	73	},
	74	.devid = LOCOMO_DEVID_LED,
	75	.probe = locomoled_probe,
	76	};
	77
	78	static int __init locomoled_init(void)
	79	{
	80	return locomo_driver_register(&locomoled_driver);
	81	}
	82	module_init(locomoled_init);
	83
	84	MODULE_AUTHOR("John Lenz <lenz@cs.wisc.edu>");
	85	MODULE_DESCRIPTION("Locomo LED driver");
	86	MODULE_LICENSE("GPL");