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

/*
 * LEDs driver for Freescale MC13783/MC13892/MC34708
 *
 * Copyright (C) 2010 Philippe Rétornaz
 *
 * Based on leds-da903x:
 * Copyright (C) 2008 Compulab, Ltd.
 *      Mike Rapoport <mike@compulab.co.il>
 *
 * Copyright (C) 2006-2008 Marvell International Ltd.
 *      Eric Miao <eric.miao@marvell.com>
 *
 * 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/module.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/leds.h>
#include <linux/workqueue.h>
#include <linux/mfd/mc13xxx.h>

struct mc13xxx_led_devtype {
	int	led_min;
	int	led_max;
	int	num_regs;
	u32	ledctrl_base;
};

struct mc13xxx_led {
	struct led_classdev	cdev;
	struct work_struct	work;
	enum led_brightness	new_brightness;
	int			id;
	struct mc13xxx_leds	*leds;
};

struct mc13xxx_leds {
	struct mc13xxx			*master;
	struct mc13xxx_led_devtype	*devtype;
	int				num_leds;
	struct mc13xxx_led		led[0];
};

static void mc13xxx_led_work(struct work_struct *work)
{
	struct mc13xxx_led *led = container_of(work, struct mc13xxx_led, work);
	struct mc13xxx_leds *leds = led->leds;
	unsigned int reg, mask, value, bank, off, shift;

	switch (led->id) {
	case MC13783_LED_MD:
	case MC13783_LED_AD:
	case MC13783_LED_KP:
		reg = 2;
		shift = 9 + (led->id - MC13783_LED_MD) * 4;
		mask = 0x0f;
		value = led->new_brightness >> 4;
		break;
	case MC13783_LED_R1:
	case MC13783_LED_G1:
	case MC13783_LED_B1:
	case MC13783_LED_R2:
	case MC13783_LED_G2:
	case MC13783_LED_B2:
	case MC13783_LED_R3:
	case MC13783_LED_G3:
	case MC13783_LED_B3:
		off = led->id - MC13783_LED_R1;
		bank = off / 3;
		reg = 3 + bank;
		shift = (off - bank * 3) * 5 + 6;
		value = led->new_brightness >> 3;
		mask = 0x1f;
		break;
	case MC13892_LED_MD:
	case MC13892_LED_AD:
	case MC13892_LED_KP:
		reg = (led->id - MC13892_LED_MD) / 2;
		shift = 3 + (led->id - MC13892_LED_MD) * 12;
		mask = 0x3f;
		value = led->new_brightness >> 2;
		break;
	case MC13892_LED_R:
	case MC13892_LED_G:
	case MC13892_LED_B:
		off = led->id - MC13892_LED_R;
		bank = off / 2;
		reg = 2 + bank;
		shift = (off - bank * 2) * 12 + 3;
		value = led->new_brightness >> 2;
		mask = 0x3f;
		break;
	case MC34708_LED_R:
	case MC34708_LED_G:
		reg = 0;
		shift = 3 + (led->id - MC34708_LED_R) * 12;
		value = led->new_brightness >> 2;
		mask = 0x3f;
		break;
	default:
		BUG();
	}

	mc13xxx_reg_rmw(leds->master, leds->devtype->ledctrl_base + reg,
			mask << shift, value << shift);
}

static void mc13xxx_led_set(struct led_classdev *led_cdev,
			    enum led_brightness value)
{
	struct mc13xxx_led *led =
		container_of(led_cdev, struct mc13xxx_led, cdev);

	led->new_brightness = value;
	schedule_work(&led->work);
}

static int __init mc13xxx_led_probe(struct platform_device *pdev)
{
	struct device *dev = &pdev->dev;
	struct mc13xxx_leds_platform_data *pdata = dev_get_platdata(dev);
	struct mc13xxx *mcdev = dev_get_drvdata(dev->parent);
	struct mc13xxx_led_devtype *devtype =
		(struct mc13xxx_led_devtype *)pdev->id_entry->driver_data;
	struct mc13xxx_leds *leds;
	int i, id, num_leds, ret = -ENODATA;
	u32 init_led = 0;

	if (!pdata) {
		dev_err(dev, "Missing platform data\n");
		return -ENODEV;
	}

	num_leds = pdata->num_leds;

	if ((num_leds < 1) ||
	    (num_leds > (devtype->led_max - devtype->led_min + 1))) {
		dev_err(dev, "Invalid LED count %d\n", num_leds);
		return -EINVAL;
	}

	leds = devm_kzalloc(dev, num_leds * sizeof(struct mc13xxx_led) +
			    sizeof(struct mc13xxx_leds), GFP_KERNEL);
	if (!leds)
		return -ENOMEM;

	leds->devtype = devtype;
	leds->num_leds = num_leds;
	leds->master = mcdev;
	platform_set_drvdata(pdev, leds);

	for (i = 0; i < devtype->num_regs; i++) {
		ret = mc13xxx_reg_write(mcdev, leds->devtype->ledctrl_base + i,
					pdata->led_control[i]);
		if (ret)
			return ret;
	}

	for (i = 0; i < num_leds; i++) {
		const char *name, *trig;

		ret = -EINVAL;

		id = pdata->led[i].id;
		name = pdata->led[i].name;
		trig = pdata->led[i].default_trigger;

		if ((id > devtype->led_max) || (id < devtype->led_min)) {
			dev_err(dev, "Invalid ID %i\n", id);
			break;
		}

		if (init_led & (1 << id)) {
			dev_warn(dev, "LED %i already initialized\n", id);
			break;
		}

		init_led |= 1 << id;
		leds->led[i].id = id;
		leds->led[i].leds = leds;
		leds->led[i].cdev.name = name;
		leds->led[i].cdev.default_trigger = trig;
		leds->led[i].cdev.brightness_set = mc13xxx_led_set;
		leds->led[i].cdev.brightness = LED_OFF;

		INIT_WORK(&leds->led[i].work, mc13xxx_led_work);

		ret = led_classdev_register(dev->parent, &leds->led[i].cdev);
		if (ret) {
			dev_err(dev, "Failed to register LED %i\n", id);
			break;
		}
	}

	if (ret)
		while (--i >= 0) {
			led_classdev_unregister(&leds->led[i].cdev);
			cancel_work_sync(&leds->led[i].work);
		}

	return ret;
}

static int mc13xxx_led_remove(struct platform_device *pdev)
{
	struct mc13xxx_leds *leds = platform_get_drvdata(pdev);
	struct mc13xxx *mcdev = leds->master;
	int i;

	for (i = 0; i < leds->num_leds; i++) {
		led_classdev_unregister(&leds->led[i].cdev);
		cancel_work_sync(&leds->led[i].work);
	}

	for (i = 0; i < leds->devtype->num_regs; i++)
		mc13xxx_reg_write(mcdev, leds->devtype->ledctrl_base + i, 0);

	return 0;
}

static const struct mc13xxx_led_devtype mc13783_led_devtype = {
	.led_min	= MC13783_LED_MD,
	.led_max	= MC13783_LED_B3,
	.num_regs	= 6,
	.ledctrl_base	= 51,
};

static const struct mc13xxx_led_devtype mc13892_led_devtype = {
	.led_min	= MC13892_LED_MD,
	.led_max	= MC13892_LED_B,
	.num_regs	= 4,
	.ledctrl_base	= 51,
};

static const struct mc13xxx_led_devtype mc34708_led_devtype = {
	.led_min	= MC34708_LED_R,
	.led_max	= MC34708_LED_G,
	.num_regs	= 1,
	.ledctrl_base	= 54,
};

static const struct platform_device_id mc13xxx_led_id_table[] = {
	{ "mc13783-led", (kernel_ulong_t)&mc13783_led_devtype, },
	{ "mc13892-led", (kernel_ulong_t)&mc13892_led_devtype, },
	{ "mc34708-led", (kernel_ulong_t)&mc34708_led_devtype, },
	{ }
};
MODULE_DEVICE_TABLE(platform, mc13xxx_led_id_table);

static struct platform_driver mc13xxx_led_driver = {
	.driver	= {
		.name	= "mc13xxx-led",
		.owner	= THIS_MODULE,
	},
	.remove		= mc13xxx_led_remove,
	.id_table	= mc13xxx_led_id_table,
};
module_platform_driver_probe(mc13xxx_led_driver, mc13xxx_led_probe);

MODULE_DESCRIPTION("LEDs driver for Freescale MC13XXX PMIC");
MODULE_AUTHOR("Philippe Retornaz <philippe.retornaz@epfl.ch>");
MODULE_LICENSE("GPL");
Commit	Line	Data
	1	/*
	2	* LEDs driver for Freescale MC13783/MC13892/MC34708
	3	*
	4	* Copyright (C) 2010 Philippe Rétornaz
	5	*
	6	* Based on leds-da903x:
	7	* Copyright (C) 2008 Compulab, Ltd.
	8	* Mike Rapoport <mike@compulab.co.il>
	9	*
	10	* Copyright (C) 2006-2008 Marvell International Ltd.
	11	* Eric Miao <eric.miao@marvell.com>
	12	*
	13	* This program is free software; you can redistribute it and/or modify
	14	* it under the terms of the GNU General Public License version 2 as
	15	* published by the Free Software Foundation.
	16	*/
	17
	18	#include <linux/module.h>
	19	#include <linux/kernel.h>
	20	#include <linux/init.h>
	21	#include <linux/platform_device.h>
	22	#include <linux/leds.h>
	23	#include <linux/workqueue.h>
	24	#include <linux/mfd/mc13xxx.h>
	25
	26	struct mc13xxx_led_devtype {
	27	int led_min;
	28	int led_max;
	29	int num_regs;
	30	u32 ledctrl_base;
	31	};
	32
	33	struct mc13xxx_led {
	34	struct led_classdev cdev;
	35	struct work_struct work;
	36	enum led_brightness new_brightness;
	37	int id;
	38	struct mc13xxx_leds *leds;
	39	};
	40
	41	struct mc13xxx_leds {
	42	struct mc13xxx *master;
	43	struct mc13xxx_led_devtype *devtype;
	44	int num_leds;
	45	struct mc13xxx_led led[0];
	46	};
	47
	48	static void mc13xxx_led_work(struct work_struct *work)
	49	{
	50	struct mc13xxx_led *led = container_of(work, struct mc13xxx_led, work);
	51	struct mc13xxx_leds *leds = led->leds;
	52	unsigned int reg, mask, value, bank, off, shift;
	53
	54	switch (led->id) {
	55	case MC13783_LED_MD:
	56	case MC13783_LED_AD:
	57	case MC13783_LED_KP:
	58	reg = 2;
	59	shift = 9 + (led->id - MC13783_LED_MD) * 4;
	60	mask = 0x0f;
	61	value = led->new_brightness >> 4;
	62	break;
	63	case MC13783_LED_R1:
	64	case MC13783_LED_G1:
	65	case MC13783_LED_B1:
	66	case MC13783_LED_R2:
	67	case MC13783_LED_G2:
	68	case MC13783_LED_B2:
	69	case MC13783_LED_R3:
	70	case MC13783_LED_G3:
	71	case MC13783_LED_B3:
	72	off = led->id - MC13783_LED_R1;
	73	bank = off / 3;
	74	reg = 3 + bank;
	75	shift = (off - bank * 3) * 5 + 6;
	76	value = led->new_brightness >> 3;
	77	mask = 0x1f;
	78	break;
	79	case MC13892_LED_MD:
	80	case MC13892_LED_AD:
	81	case MC13892_LED_KP:
	82	reg = (led->id - MC13892_LED_MD) / 2;
	83	shift = 3 + (led->id - MC13892_LED_MD) * 12;
	84	mask = 0x3f;
	85	value = led->new_brightness >> 2;
	86	break;
	87	case MC13892_LED_R:
	88	case MC13892_LED_G:
	89	case MC13892_LED_B:
	90	off = led->id - MC13892_LED_R;
	91	bank = off / 2;
	92	reg = 2 + bank;
	93	shift = (off - bank * 2) * 12 + 3;
	94	value = led->new_brightness >> 2;
	95	mask = 0x3f;
	96	break;
	97	case MC34708_LED_R:
	98	case MC34708_LED_G:
	99	reg = 0;
	100	shift = 3 + (led->id - MC34708_LED_R) * 12;
	101	value = led->new_brightness >> 2;
	102	mask = 0x3f;
	103	break;
	104	default:
	105	BUG();
	106	}
	107
	108	mc13xxx_reg_rmw(leds->master, leds->devtype->ledctrl_base + reg,
	109	mask << shift, value << shift);
	110	}
	111
	112	static void mc13xxx_led_set(struct led_classdev *led_cdev,
	113	enum led_brightness value)
	114	{
	115	struct mc13xxx_led *led =
	116	container_of(led_cdev, struct mc13xxx_led, cdev);
	117
	118	led->new_brightness = value;
	119	schedule_work(&led->work);
	120	}
	121
	122	static int __init mc13xxx_led_probe(struct platform_device *pdev)
	123	{
	124	struct device *dev = &pdev->dev;
	125	struct mc13xxx_leds_platform_data *pdata = dev_get_platdata(dev);
	126	struct mc13xxx *mcdev = dev_get_drvdata(dev->parent);
	127	struct mc13xxx_led_devtype *devtype =
	128	(struct mc13xxx_led_devtype *)pdev->id_entry->driver_data;
	129	struct mc13xxx_leds *leds;
	130	int i, id, num_leds, ret = -ENODATA;
	131	u32 init_led = 0;
	132
	133	if (!pdata) {
	134	dev_err(dev, "Missing platform data\n");
	135	return -ENODEV;
	136	}
	137
	138	num_leds = pdata->num_leds;
	139
	140	if ((num_leds < 1) \|\|
	141	(num_leds > (devtype->led_max - devtype->led_min + 1))) {
	142	dev_err(dev, "Invalid LED count %d\n", num_leds);
	143	return -EINVAL;
	144	}
	145
	146	leds = devm_kzalloc(dev, num_leds * sizeof(struct mc13xxx_led) +
	147	sizeof(struct mc13xxx_leds), GFP_KERNEL);
	148	if (!leds)
	149	return -ENOMEM;
	150
	151	leds->devtype = devtype;
	152	leds->num_leds = num_leds;
	153	leds->master = mcdev;
	154	platform_set_drvdata(pdev, leds);
	155
	156	for (i = 0; i < devtype->num_regs; i++) {
	157	ret = mc13xxx_reg_write(mcdev, leds->devtype->ledctrl_base + i,
	158	pdata->led_control[i]);
	159	if (ret)
	160	return ret;
	161	}
	162
	163	for (i = 0; i < num_leds; i++) {
	164	const char name, trig;
	165
	166	ret = -EINVAL;
	167
	168	id = pdata->led[i].id;
	169	name = pdata->led[i].name;
	170	trig = pdata->led[i].default_trigger;
	171
	172	if ((id > devtype->led_max) \|\| (id < devtype->led_min)) {
	173	dev_err(dev, "Invalid ID %i\n", id);
	174	break;
	175	}
	176
	177	if (init_led & (1 << id)) {
	178	dev_warn(dev, "LED %i already initialized\n", id);
	179	break;
	180	}
	181
	182	init_led \|= 1 << id;
	183	leds->led[i].id = id;
	184	leds->led[i].leds = leds;
	185	leds->led[i].cdev.name = name;
	186	leds->led[i].cdev.default_trigger = trig;
	187	leds->led[i].cdev.brightness_set = mc13xxx_led_set;
	188	leds->led[i].cdev.brightness = LED_OFF;
	189
	190	INIT_WORK(&leds->led[i].work, mc13xxx_led_work);
	191
	192	ret = led_classdev_register(dev->parent, &leds->led[i].cdev);
	193	if (ret) {
	194	dev_err(dev, "Failed to register LED %i\n", id);
	195	break;
	196	}
	197	}
	198
	199	if (ret)
	200	while (--i >= 0) {
	201	led_classdev_unregister(&leds->led[i].cdev);
	202	cancel_work_sync(&leds->led[i].work);
	203	}
	204
	205	return ret;
	206	}
	207
	208	static int mc13xxx_led_remove(struct platform_device *pdev)
	209	{
	210	struct mc13xxx_leds *leds = platform_get_drvdata(pdev);
	211	struct mc13xxx *mcdev = leds->master;
	212	int i;
	213
	214	for (i = 0; i < leds->num_leds; i++) {
	215	led_classdev_unregister(&leds->led[i].cdev);
	216	cancel_work_sync(&leds->led[i].work);
	217	}
	218
	219	for (i = 0; i < leds->devtype->num_regs; i++)
	220	mc13xxx_reg_write(mcdev, leds->devtype->ledctrl_base + i, 0);
	221
	222	return 0;
	223	}
	224
	225	static const struct mc13xxx_led_devtype mc13783_led_devtype = {
	226	.led_min = MC13783_LED_MD,
	227	.led_max = MC13783_LED_B3,
	228	.num_regs = 6,
	229	.ledctrl_base = 51,
	230	};
	231
	232	static const struct mc13xxx_led_devtype mc13892_led_devtype = {
	233	.led_min = MC13892_LED_MD,
	234	.led_max = MC13892_LED_B,
	235	.num_regs = 4,
	236	.ledctrl_base = 51,
	237	};
	238
	239	static const struct mc13xxx_led_devtype mc34708_led_devtype = {
	240	.led_min = MC34708_LED_R,
	241	.led_max = MC34708_LED_G,
	242	.num_regs = 1,
	243	.ledctrl_base = 54,
	244	};
	245
	246	static const struct platform_device_id mc13xxx_led_id_table[] = {
	247	{ "mc13783-led", (kernel_ulong_t)&mc13783_led_devtype, },
	248	{ "mc13892-led", (kernel_ulong_t)&mc13892_led_devtype, },
	249	{ "mc34708-led", (kernel_ulong_t)&mc34708_led_devtype, },
	250	{ }
	251	};
	252	MODULE_DEVICE_TABLE(platform, mc13xxx_led_id_table);
	253
	254	static struct platform_driver mc13xxx_led_driver = {
	255	.driver = {
	256	.name = "mc13xxx-led",
	257	.owner = THIS_MODULE,
	258	},
	259	.remove = mc13xxx_led_remove,
	260	.id_table = mc13xxx_led_id_table,
	261	};
	262	module_platform_driver_probe(mc13xxx_led_driver, mc13xxx_led_probe);
	263
	264	MODULE_DESCRIPTION("LEDs driver for Freescale MC13XXX PMIC");
	265	MODULE_AUTHOR("Philippe Retornaz <philippe.retornaz@epfl.ch>");
	266	MODULE_LICENSE("GPL");