[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
7fdcef8a	1	/*
a59ce658	2	* LEDs driver for Freescale MC13783/MC13892/MC34708
7fdcef8a PR	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>
f3ca0782	24	#include <linux/mfd/mc13xxx.h>
7fdcef8a	25
9d263813 AS	26	struct mc13xxx_led_devtype {
	27	int led_min;
	28	int led_max;
	29	int num_regs;
a59ce658	30	u32 ledctrl_base;
9d263813 AS	31	};
	32
	33	struct mc13xxx_led {
7fdcef8a PR	34	struct led_classdev cdev;
7fdcef8a PR	35	struct work_struct work;
7fdcef8a PR	36	enum led_brightness new_brightness;
7fdcef8a PR	37	int id;
a59ce658	38	struct mc13xxx_leds *leds;
7fdcef8a PR	39	};
7fdcef8a PR	40
9d263813	41	struct mc13xxx_leds {
a59ce658	42	struct mc13xxx *master;
9d263813 AS	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)
7fdcef8a	49	{
9d263813	50	struct mc13xxx_led *led = container_of(work, struct mc13xxx_led, work);
a59ce658 AS	51	struct mc13xxx_leds *leds = led->leds;
a59ce658 AS	52	unsigned int reg, mask, value, bank, off, shift;
7fdcef8a PR	53
	54	switch (led->id) {
	55	case MC13783_LED_MD:
7fdcef8a	56	case MC13783_LED_AD:
7fdcef8a	57	case MC13783_LED_KP:
a59ce658 AS	58	reg = 2;
a59ce658 AS	59	shift = 9 + (led->id - MC13783_LED_MD) * 4;
9d263813 AS	60	mask = 0x0f;
9d263813 AS	61	value = led->new_brightness >> 4;
7fdcef8a PR	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;
9d263813	73	bank = off / 3;
a59ce658	74	reg = 3 + bank;
9d263813 AS	75	shift = (off - bank * 3) * 5 + 6;
	76	value = led->new_brightness >> 3;
	77	mask = 0x1f;
7fdcef8a	78	break;
ae6cdb03	79	case MC13892_LED_MD:
ae6cdb03	80	case MC13892_LED_AD:
ae6cdb03	81	case MC13892_LED_KP:
a59ce658 AS	82	reg = (led->id - MC13892_LED_MD) / 2;
a59ce658 AS	83	shift = 3 + (led->id - MC13892_LED_MD) * 12;
ae6cdb03 AS	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;
a59ce658	92	reg = 2 + bank;
ae6cdb03 AS	93	shift = (off - bank * 2) * 12 + 3;
	94	value = led->new_brightness >> 2;
	95	mask = 0x3f;
	96	break;
a59ce658 AS	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;
9d263813 AS	104	default:
9d263813 AS	105	BUG();
7fdcef8a PR	106	}
7fdcef8a PR	107
a59ce658 AS	108	mc13xxx_reg_rmw(leds->master, leds->devtype->ledctrl_base + reg,
a59ce658 AS	109	mask << shift, value << shift);
7fdcef8a PR	110	}
7fdcef8a PR	111
9d263813 AS	112	static void mc13xxx_led_set(struct led_classdev *led_cdev,
9d263813 AS	113	enum led_brightness value)
7fdcef8a	114	{
9d263813 AS	115	struct mc13xxx_led *led =
9d263813 AS	116	container_of(led_cdev, struct mc13xxx_led, cdev);
7fdcef8a	117
7fdcef8a PR	118	led->new_brightness = value;
	119	schedule_work(&led->work);
	120	}
	121
9d263813	122	static int __init mc13xxx_led_probe(struct platform_device *pdev)
7fdcef8a	123	{
a59ce658 AS	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);
9d263813 AS	127	struct mc13xxx_led_devtype *devtype =
	128	(struct mc13xxx_led_devtype *)pdev->id_entry->driver_data;
	129	struct mc13xxx_leds *leds;
cf3b1c2b	130	int i, id, num_leds, ret = -ENODATA;
a59ce658	131	u32 init_led = 0;
9d263813 AS	132
9d263813 AS	133	if (!pdata) {
a59ce658	134	dev_err(dev, "Missing platform data\n");
7fdcef8a PR	135	return -ENODEV;
	136	}
	137
9d263813 AS	138	num_leds = pdata->num_leds;
	139
	140	if ((num_leds < 1) \|\|
	141	(num_leds > (devtype->led_max - devtype->led_min + 1))) {
a59ce658	142	dev_err(dev, "Invalid LED count %d\n", num_leds);
7fdcef8a PR	143	return -EINVAL;
	144	}
	145
a59ce658	146	leds = devm_kzalloc(dev, num_leds * sizeof(struct mc13xxx_led) +
9d263813 AS	147	sizeof(struct mc13xxx_leds), GFP_KERNEL);
9d263813 AS	148	if (!leds)
7fdcef8a	149	return -ENOMEM;
9d263813 AS	150
	151	leds->devtype = devtype;
	152	leds->num_leds = num_leds;
a59ce658	153	leds->master = mcdev;
9d263813 AS	154	platform_set_drvdata(pdev, leds);
9d263813 AS	155
9d263813	156	for (i = 0; i < devtype->num_regs; i++) {
a59ce658 AS	157	ret = mc13xxx_reg_write(mcdev, leds->devtype->ledctrl_base + i,
a59ce658 AS	158	pdata->led_control[i]);
9d263813	159	if (ret)
3df22c06	160	return ret;
7fdcef8a PR	161	}
7fdcef8a PR	162
9d263813 AS	163	for (i = 0; i < num_leds; i++) {
9d263813 AS	164	const char name, trig;
7fdcef8a	165
9d263813 AS	166	ret = -EINVAL;
	167
	168	id = pdata->led[i].id;
	169	name = pdata->led[i].name;
	170	trig = pdata->led[i].default_trigger;
9d263813 AS	171
9d263813 AS	172	if ((id > devtype->led_max) \|\| (id < devtype->led_min)) {
a59ce658	173	dev_err(dev, "Invalid ID %i\n", id);
9d263813	174	break;
7fdcef8a PR	175	}
7fdcef8a PR	176
9d263813	177	if (init_led & (1 << id)) {
a59ce658	178	dev_warn(dev, "LED %i already initialized\n", id);
9d263813	179	break;
7fdcef8a PR	180	}
7fdcef8a PR	181
9d263813 AS	182	init_led \|= 1 << id;
9d263813 AS	183	leds->led[i].id = id;
a59ce658	184	leds->led[i].leds = leds;
9d263813 AS	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;
7fdcef8a	189
9d263813	190	INIT_WORK(&leds->led[i].work, mc13xxx_led_work);
7fdcef8a	191
a59ce658	192	ret = led_classdev_register(dev->parent, &leds->led[i].cdev);
7fdcef8a	193	if (ret) {
a59ce658	194	dev_err(dev, "Failed to register LED %i\n", id);
9d263813	195	break;
7fdcef8a PR	196	}
	197	}
	198
9d263813 AS	199	if (ret)
	200	while (--i >= 0) {
	201	led_classdev_unregister(&leds->led[i].cdev);
	202	cancel_work_sync(&leds->led[i].work);
	203	}
7fdcef8a	204
7fdcef8a PR	205	return ret;
	206	}
	207
9d263813	208	static int mc13xxx_led_remove(struct platform_device *pdev)
7fdcef8a	209	{
9d263813	210	struct mc13xxx_leds *leds = platform_get_drvdata(pdev);
a59ce658	211	struct mc13xxx *mcdev = leds->master;
7fdcef8a PR	212	int i;
7fdcef8a PR	213
9d263813 AS	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);
7fdcef8a PR	217	}
7fdcef8a PR	218
9d263813	219	for (i = 0; i < leds->devtype->num_regs; i++)
a59ce658	220	mc13xxx_reg_write(mcdev, leds->devtype->ledctrl_base + i, 0);
7fdcef8a	221
7fdcef8a PR	222	return 0;
	223	}
	224
9d263813 AS	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,
a59ce658	229	.ledctrl_base = 51,
9d263813 AS	230	};
9d263813 AS	231
ae6cdb03 AS	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,
a59ce658 AS	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,
ae6cdb03 AS	244	};
ae6cdb03 AS	245
9d263813 AS	246	static const struct platform_device_id mc13xxx_led_id_table[] = {
9d263813 AS	247	{ "mc13783-led", (kernel_ulong_t)&mc13783_led_devtype, },
ae6cdb03	248	{ "mc13892-led", (kernel_ulong_t)&mc13892_led_devtype, },
a59ce658	249	{ "mc34708-led", (kernel_ulong_t)&mc34708_led_devtype, },
9d263813 AS	250	{ }
	251	};
	252	MODULE_DEVICE_TABLE(platform, mc13xxx_led_id_table);
	253
	254	static struct platform_driver mc13xxx_led_driver = {
7fdcef8a	255	.driver = {
9d263813	256	.name = "mc13xxx-led",
7fdcef8a PR	257	.owner = THIS_MODULE,
7fdcef8a PR	258	},
9d263813 AS	259	.remove = mc13xxx_led_remove,
9d263813 AS	260	.id_table = mc13xxx_led_id_table,
7fdcef8a	261	};
9d263813	262	module_platform_driver_probe(mc13xxx_led_driver, mc13xxx_led_probe);
7fdcef8a	263
9d263813	264	MODULE_DESCRIPTION("LEDs driver for Freescale MC13XXX PMIC");
7fdcef8a PR	265	MODULE_AUTHOR("Philippe Retornaz <philippe.retornaz@epfl.ch>");
7fdcef8a PR	266	MODULE_LICENSE("GPL");