[linux-2.6-block.git] / drivers / leds / leds-sead3.c

/*
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
 *
 * Copyright (C) 2012 MIPS Technologies, Inc.  All rights reserved.
 * Copyright (C) 2015 Imagination Technologies, Inc.
 */
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/leds.h>
#include <linux/err.h>
#include <linux/io.h>

#include <asm/mips-boards/sead3-addr.h>

static void sead3_pled_set(struct led_classdev *led_cdev,
		enum led_brightness value)
{
	writel(value, (void __iomem *)SEAD3_CPLD_P_LED);
}

static void sead3_fled_set(struct led_classdev *led_cdev,
		enum led_brightness value)
{
	writel(value, (void __iomem *)SEAD3_CPLD_F_LED);
}

static struct led_classdev sead3_pled = {
	.name		= "sead3::pled",
	.brightness_set = sead3_pled_set,
	.flags		= LED_CORE_SUSPENDRESUME,
};

static struct led_classdev sead3_fled = {
	.name		= "sead3::fled",
	.brightness_set = sead3_fled_set,
	.flags		= LED_CORE_SUSPENDRESUME,
};

static int sead3_led_probe(struct platform_device *pdev)
{
	int ret;

	ret = led_classdev_register(&pdev->dev, &sead3_pled);
	if (ret < 0)
		return ret;

	ret = led_classdev_register(&pdev->dev, &sead3_fled);
	if (ret < 0)
		led_classdev_unregister(&sead3_pled);

	return ret;
}

static int sead3_led_remove(struct platform_device *pdev)
{
	led_classdev_unregister(&sead3_pled);
	led_classdev_unregister(&sead3_fled);

	return 0;
}

static struct platform_driver sead3_led_driver = {
	.probe		= sead3_led_probe,
	.remove		= sead3_led_remove,
	.driver		= {
		.name		= "sead3-led",
	},
};

module_platform_driver(sead3_led_driver);

MODULE_AUTHOR("Kristian Kielhofner <kris@krisk.org>");
MODULE_DESCRIPTION("SEAD3 LED driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
3070033a SH	1	/*
	2	* This file is subject to the terms and conditions of the GNU General Public
	3	* License. See the file "COPYING" in the main directory of this archive
	4	* for more details.
	5	*
	6	* Copyright (C) 2012 MIPS Technologies, Inc. All rights reserved.
fbacc8df	7	* Copyright (C) 2015 Imagination Technologies, Inc.
3070033a SH	8	*/
	9	#include <linux/kernel.h>
	10	#include <linux/module.h>
	11	#include <linux/init.h>
	12	#include <linux/platform_device.h>
	13	#include <linux/leds.h>
	14	#include <linux/err.h>
	15	#include <linux/io.h>
	16
fbacc8df RB	17	#include <asm/mips-boards/sead3-addr.h>
fbacc8df RB	18
3070033a SH	19	static void sead3_pled_set(struct led_classdev *led_cdev,
	20	enum led_brightness value)
	21	{
fbacc8df	22	writel(value, (void __iomem *)SEAD3_CPLD_P_LED);
3070033a SH	23	}
	24
	25	static void sead3_fled_set(struct led_classdev *led_cdev,
	26	enum led_brightness value)
	27	{
fbacc8df	28	writel(value, (void __iomem *)SEAD3_CPLD_F_LED);
3070033a SH	29	}
	30
	31	static struct led_classdev sead3_pled = {
	32	.name = "sead3::pled",
70342287	33	.brightness_set = sead3_pled_set,
f4d1f2be	34	.flags = LED_CORE_SUSPENDRESUME,
3070033a SH	35	};
	36
	37	static struct led_classdev sead3_fled = {
	38	.name = "sead3::fled",
70342287	39	.brightness_set = sead3_fled_set,
f4d1f2be	40	.flags = LED_CORE_SUSPENDRESUME,
3070033a SH	41	};
3070033a SH	42
3070033a SH	43	static int sead3_led_probe(struct platform_device *pdev)
	44	{
	45	int ret;
	46
	47	ret = led_classdev_register(&pdev->dev, &sead3_pled);
	48	if (ret < 0)
	49	return ret;
	50
	51	ret = led_classdev_register(&pdev->dev, &sead3_fled);
	52	if (ret < 0)
	53	led_classdev_unregister(&sead3_pled);
	54
	55	return ret;
	56	}
	57
	58	static int sead3_led_remove(struct platform_device *pdev)
	59	{
	60	led_classdev_unregister(&sead3_pled);
	61	led_classdev_unregister(&sead3_fled);
22a16873	62
3070033a SH	63	return 0;
	64	}
	65
	66	static struct platform_driver sead3_led_driver = {
	67	.probe = sead3_led_probe,
	68	.remove = sead3_led_remove,
3070033a	69	.driver = {
2c0916d4	70	.name = "sead3-led",
3070033a SH	71	},
	72	};
	73
4558e094	74	module_platform_driver(sead3_led_driver);
3070033a SH	75
	76	MODULE_AUTHOR("Kristian Kielhofner <kris@krisk.org>");
	77	MODULE_DESCRIPTION("SEAD3 LED driver");
	78	MODULE_LICENSE("GPL");