[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / leds / leds-da903x.c

/*
 * LEDs driver for Dialog Semiconductor DA9030/DA9034
 *
 * 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/da903x.h>
#include <linux/slab.h>

#define DA9030_LED1_CONTROL	0x20
#define DA9030_LED2_CONTROL	0x21
#define DA9030_LED3_CONTROL	0x22
#define DA9030_LED4_CONTROL	0x23
#define DA9030_LEDPC_CONTROL	0x24
#define DA9030_MISC_CONTROL_A	0x26	/* Vibrator Control */

#define DA9034_LED1_CONTROL	0x35
#define DA9034_LED2_CONTROL	0x36
#define DA9034_VIBRA		0x40

struct da903x_led {
	struct led_classdev	cdev;
	struct work_struct	work;
	struct device		*master;
	enum led_brightness	new_brightness;
	int			id;
	int			flags;
};

#define DA9030_LED_OFFSET(id)	((id) - DA9030_ID_LED_1)
#define DA9034_LED_OFFSET(id)	((id) - DA9034_ID_LED_1)

static void da903x_led_work(struct work_struct *work)
{
	struct da903x_led *led = container_of(work, struct da903x_led, work);
	uint8_t val;
	int offset;

	switch (led->id) {
	case DA9030_ID_LED_1:
	case DA9030_ID_LED_2:
	case DA9030_ID_LED_3:
	case DA9030_ID_LED_4:
	case DA9030_ID_LED_PC:
		offset = DA9030_LED_OFFSET(led->id);
		val = led->flags & ~0x87;
		val |= (led->new_brightness) ? 0x80 : 0; /* EN bit */
		val |= (0x7 - (led->new_brightness >> 5)) & 0x7; /* PWM<2:0> */
		da903x_write(led->master, DA9030_LED1_CONTROL + offset, val);
		break;
	case DA9030_ID_VIBRA:
		val = led->flags & ~0x80;
		val |= (led->new_brightness) ? 0x80 : 0; /* EN bit */
		da903x_write(led->master, DA9030_MISC_CONTROL_A, val);
		break;
	case DA9034_ID_LED_1:
	case DA9034_ID_LED_2:
		offset = DA9034_LED_OFFSET(led->id);
		val = (led->new_brightness * 0x5f / LED_FULL) & 0x7f;
		val |= (led->flags & DA9034_LED_RAMP) ? 0x80 : 0;
		da903x_write(led->master, DA9034_LED1_CONTROL + offset, val);
		break;
	case DA9034_ID_VIBRA:
		val = led->new_brightness & 0xfe;
		da903x_write(led->master, DA9034_VIBRA, val);
		break;
	}
}

static void da903x_led_set(struct led_classdev *led_cdev,
			   enum led_brightness value)
{
	struct da903x_led *led;

	led = container_of(led_cdev, struct da903x_led, cdev);
	led->new_brightness = value;
	schedule_work(&led->work);
}

static int da903x_led_probe(struct platform_device *pdev)
{
	struct led_info *pdata = pdev->dev.platform_data;
	struct da903x_led *led;
	int id, ret;

	if (pdata == NULL)
		return 0;

	id = pdev->id;

	if (!((id >= DA9030_ID_LED_1 && id <= DA9030_ID_VIBRA) ||
	      (id >= DA9034_ID_LED_1 && id <= DA9034_ID_VIBRA))) {
		dev_err(&pdev->dev, "invalid LED ID (%d) specified\n", id);
		return -EINVAL;
	}

	led = devm_kzalloc(&pdev->dev, sizeof(struct da903x_led), GFP_KERNEL);
	if (led == NULL) {
		dev_err(&pdev->dev, "failed to alloc memory for LED%d\n", id);
		return -ENOMEM;
	}

	led->cdev.name = pdata->name;
	led->cdev.default_trigger = pdata->default_trigger;
	led->cdev.brightness_set = da903x_led_set;
	led->cdev.brightness = LED_OFF;

	led->id = id;
	led->flags = pdata->flags;
	led->master = pdev->dev.parent;
	led->new_brightness = LED_OFF;

	INIT_WORK(&led->work, da903x_led_work);

	ret = led_classdev_register(led->master, &led->cdev);
	if (ret) {
		dev_err(&pdev->dev, "failed to register LED %d\n", id);
		return ret;
	}

	platform_set_drvdata(pdev, led);
	return 0;
}

static int da903x_led_remove(struct platform_device *pdev)
{
	struct da903x_led *led = platform_get_drvdata(pdev);

	led_classdev_unregister(&led->cdev);
	return 0;
}

static struct platform_driver da903x_led_driver = {
	.driver	= {
		.name	= "da903x-led",
		.owner	= THIS_MODULE,
	},
	.probe		= da903x_led_probe,
	.remove		= da903x_led_remove,
};

module_platform_driver(da903x_led_driver);

MODULE_DESCRIPTION("LEDs driver for Dialog Semiconductor DA9030/DA9034");
MODULE_AUTHOR("Eric Miao <eric.miao@marvell.com>");
MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>");
MODULE_LICENSE("GPL");
MODULE_ALIAS("platform:da903x-led");
Commit	Line	Data
9e84561c MR	1	/*
	2	* LEDs driver for Dialog Semiconductor DA9030/DA9034
	3	*
	4	* Copyright (C) 2008 Compulab, Ltd.
141bfeea	5	* Mike Rapoport <mike@compulab.co.il>
9e84561c MR	6	*
9e84561c MR	7	* Copyright (C) 2006-2008 Marvell International Ltd.
141bfeea	8	* Eric Miao <eric.miao@marvell.com>
9e84561c MR	9	*
	10	* This program is free software; you can redistribute it and/or modify
	11	* it under the terms of the GNU General Public License version 2 as
	12	* published by the Free Software Foundation.
	13	*/
	14
	15	#include <linux/module.h>
	16	#include <linux/kernel.h>
	17	#include <linux/init.h>
	18	#include <linux/platform_device.h>
	19	#include <linux/leds.h>
b9b54aa2	20	#include <linux/workqueue.h>
9e84561c	21	#include <linux/mfd/da903x.h>
5a0e3ad6	22	#include <linux/slab.h>
9e84561c MR	23
	24	#define DA9030_LED1_CONTROL 0x20
	25	#define DA9030_LED2_CONTROL 0x21
	26	#define DA9030_LED3_CONTROL 0x22
	27	#define DA9030_LED4_CONTROL 0x23
	28	#define DA9030_LEDPC_CONTROL 0x24
	29	#define DA9030_MISC_CONTROL_A 0x26 /* Vibrator Control */
	30
	31	#define DA9034_LED1_CONTROL 0x35
	32	#define DA9034_LED2_CONTROL 0x36
	33	#define DA9034_VIBRA 0x40
	34
	35	struct da903x_led {
	36	struct led_classdev cdev;
	37	struct work_struct work;
	38	struct device *master;
	39	enum led_brightness new_brightness;
	40	int id;
	41	int flags;
	42	};
	43
	44	#define DA9030_LED_OFFSET(id) ((id) - DA9030_ID_LED_1)
	45	#define DA9034_LED_OFFSET(id) ((id) - DA9034_ID_LED_1)
	46
	47	static void da903x_led_work(struct work_struct *work)
	48	{
	49	struct da903x_led *led = container_of(work, struct da903x_led, work);
	50	uint8_t val;
	51	int offset;
	52
	53	switch (led->id) {
	54	case DA9030_ID_LED_1:
	55	case DA9030_ID_LED_2:
	56	case DA9030_ID_LED_3:
	57	case DA9030_ID_LED_4:
	58	case DA9030_ID_LED_PC:
	59	offset = DA9030_LED_OFFSET(led->id);
	60	val = led->flags & ~0x87;
	61	val \|= (led->new_brightness) ? 0x80 : 0; /* EN bit */
a0601c89	62	val \|= (0x7 - (led->new_brightness >> 5)) & 0x7; /* PWM<2:0> */
9e84561c MR	63	da903x_write(led->master, DA9030_LED1_CONTROL + offset, val);
	64	break;
	65	case DA9030_ID_VIBRA:
	66	val = led->flags & ~0x80;
	67	val \|= (led->new_brightness) ? 0x80 : 0; /* EN bit */
	68	da903x_write(led->master, DA9030_MISC_CONTROL_A, val);
	69	break;
	70	case DA9034_ID_LED_1:
	71	case DA9034_ID_LED_2:
	72	offset = DA9034_LED_OFFSET(led->id);
	73	val = (led->new_brightness * 0x5f / LED_FULL) & 0x7f;
	74	val \|= (led->flags & DA9034_LED_RAMP) ? 0x80 : 0;
	75	da903x_write(led->master, DA9034_LED1_CONTROL + offset, val);
	76	break;
	77	case DA9034_ID_VIBRA:
	78	val = led->new_brightness & 0xfe;
	79	da903x_write(led->master, DA9034_VIBRA, val);
	80	break;
	81	}
	82	}
	83
	84	static void da903x_led_set(struct led_classdev *led_cdev,
	85	enum led_brightness value)
	86	{
	87	struct da903x_led *led;
141bfeea	88
9e84561c MR	89	led = container_of(led_cdev, struct da903x_led, cdev);
	90	led->new_brightness = value;
	91	schedule_work(&led->work);
	92	}
	93
98ea1ea2	94	static int da903x_led_probe(struct platform_device *pdev)
9e84561c MR	95	{
	96	struct led_info *pdata = pdev->dev.platform_data;
	97	struct da903x_led *led;
	98	int id, ret;
	99
	100	if (pdata == NULL)
	101	return 0;
	102
	103	id = pdev->id;
	104
	105	if (!((id >= DA9030_ID_LED_1 && id <= DA9030_ID_VIBRA) \|\|
	106	(id >= DA9034_ID_LED_1 && id <= DA9034_ID_VIBRA))) {
	107	dev_err(&pdev->dev, "invalid LED ID (%d) specified\n", id);
	108	return -EINVAL;
	109	}
	110
bad1c898	111	led = devm_kzalloc(&pdev->dev, sizeof(struct da903x_led), GFP_KERNEL);
9e84561c MR	112	if (led == NULL) {
	113	dev_err(&pdev->dev, "failed to alloc memory for LED%d\n", id);
	114	return -ENOMEM;
	115	}
	116
	117	led->cdev.name = pdata->name;
	118	led->cdev.default_trigger = pdata->default_trigger;
	119	led->cdev.brightness_set = da903x_led_set;
	120	led->cdev.brightness = LED_OFF;
	121
	122	led->id = id;
	123	led->flags = pdata->flags;
	124	led->master = pdev->dev.parent;
	125	led->new_brightness = LED_OFF;
	126
	127	INIT_WORK(&led->work, da903x_led_work);
	128
	129	ret = led_classdev_register(led->master, &led->cdev);
	130	if (ret) {
	131	dev_err(&pdev->dev, "failed to register LED %d\n", id);
bad1c898	132	return ret;
9e84561c MR	133	}
	134
	135	platform_set_drvdata(pdev, led);
	136	return 0;
9e84561c MR	137	}
9e84561c MR	138
678e8a6b	139	static int da903x_led_remove(struct platform_device *pdev)
9e84561c MR	140	{
	141	struct da903x_led *led = platform_get_drvdata(pdev);
	142
	143	led_classdev_unregister(&led->cdev);
9e84561c MR	144	return 0;
	145	}
	146
	147	static struct platform_driver da903x_led_driver = {
	148	.driver = {
	149	.name = "da903x-led",
	150	.owner = THIS_MODULE,
	151	},
	152	.probe = da903x_led_probe,
df07cf81	153	.remove = da903x_led_remove,
9e84561c MR	154	};
9e84561c MR	155
892a8843	156	module_platform_driver(da903x_led_driver);
9e84561c MR	157
9e84561c MR	158	MODULE_DESCRIPTION("LEDs driver for Dialog Semiconductor DA9030/DA9034");
141bfeea SK	159	MODULE_AUTHOR("Eric Miao <eric.miao@marvell.com>");
141bfeea SK	160	MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>");
9e84561c MR	161	MODULE_LICENSE("GPL");
9e84561c MR	162	MODULE_ALIAS("platform:da903x-led");