[linux-2.6-block.git] / drivers / video / backlight / lm3630a_bl.c

/*
* Simple driver for Texas Instruments LM3630A Backlight driver chip
* Copyright (C) 2012 Texas Instruments
*
* 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/slab.h>
#include <linux/i2c.h>
#include <linux/backlight.h>
#include <linux/err.h>
#include <linux/delay.h>
#include <linux/uaccess.h>
#include <linux/interrupt.h>
#include <linux/regmap.h>
#include <linux/pwm.h>
#include <linux/platform_data/lm3630a_bl.h>

#define REG_CTRL	0x00
#define REG_BOOST	0x02
#define REG_CONFIG	0x01
#define REG_BRT_A	0x03
#define REG_BRT_B	0x04
#define REG_I_A		0x05
#define REG_I_B		0x06
#define REG_INT_STATUS	0x09
#define REG_INT_EN	0x0A
#define REG_FAULT	0x0B
#define REG_PWM_OUTLOW	0x12
#define REG_PWM_OUTHIGH	0x13
#define REG_MAX		0x1F

#define INT_DEBOUNCE_MSEC	10
struct lm3630a_chip {
	struct device *dev;
	struct delayed_work work;

	int irq;
	struct workqueue_struct *irqthread;
	struct lm3630a_platform_data *pdata;
	struct backlight_device *bleda;
	struct backlight_device *bledb;
	struct regmap *regmap;
	struct pwm_device *pwmd;
};

/* i2c access */
static int lm3630a_read(struct lm3630a_chip *pchip, unsigned int reg)
{
	int rval;
	unsigned int reg_val;

	rval = regmap_read(pchip->regmap, reg, &reg_val);
	if (rval < 0)
		return rval;
	return reg_val & 0xFF;
}

static int lm3630a_write(struct lm3630a_chip *pchip,
			 unsigned int reg, unsigned int data)
{
	return regmap_write(pchip->regmap, reg, data);
}

static int lm3630a_update(struct lm3630a_chip *pchip,
			  unsigned int reg, unsigned int mask,
			  unsigned int data)
{
	return regmap_update_bits(pchip->regmap, reg, mask, data);
}

/* initialize chip */
static int lm3630a_chip_init(struct lm3630a_chip *pchip)
{
	int rval;
	struct lm3630a_platform_data *pdata = pchip->pdata;

	usleep_range(1000, 2000);
	/* set Filter Strength Register */
	rval = lm3630a_write(pchip, 0x50, 0x03);
	/* set Cofig. register */
	rval |= lm3630a_update(pchip, REG_CONFIG, 0x07, pdata->pwm_ctrl);
	/* set boost control */
	rval |= lm3630a_write(pchip, REG_BOOST, 0x38);
	/* set current A */
	rval |= lm3630a_update(pchip, REG_I_A, 0x1F, 0x1F);
	/* set current B */
	rval |= lm3630a_write(pchip, REG_I_B, 0x1F);
	/* set control */
	rval |= lm3630a_update(pchip, REG_CTRL, 0x14, pdata->leda_ctrl);
	rval |= lm3630a_update(pchip, REG_CTRL, 0x0B, pdata->ledb_ctrl);
	usleep_range(1000, 2000);
	/* set brightness A and B */
	rval |= lm3630a_write(pchip, REG_BRT_A, pdata->leda_init_brt);
	rval |= lm3630a_write(pchip, REG_BRT_B, pdata->ledb_init_brt);

	if (rval < 0)
		dev_err(pchip->dev, "i2c failed to access register\n");
	return rval;
}

/* interrupt handling */
static void lm3630a_delayed_func(struct work_struct *work)
{
	int rval;
	struct lm3630a_chip *pchip;

	pchip = container_of(work, struct lm3630a_chip, work.work);

	rval = lm3630a_read(pchip, REG_INT_STATUS);
	if (rval < 0) {
		dev_err(pchip->dev,
			"i2c failed to access REG_INT_STATUS Register\n");
		return;
	}

	dev_info(pchip->dev, "REG_INT_STATUS Register is 0x%x\n", rval);
}

static irqreturn_t lm3630a_isr_func(int irq, void *chip)
{
	int rval;
	struct lm3630a_chip *pchip = chip;
	unsigned long delay = msecs_to_jiffies(INT_DEBOUNCE_MSEC);

	queue_delayed_work(pchip->irqthread, &pchip->work, delay);

	rval = lm3630a_update(pchip, REG_CTRL, 0x80, 0x00);
	if (rval < 0) {
		dev_err(pchip->dev, "i2c failed to access register\n");
		return IRQ_NONE;
	}
	return IRQ_HANDLED;
}

static int lm3630a_intr_config(struct lm3630a_chip *pchip)
{
	int rval;

	rval = lm3630a_write(pchip, REG_INT_EN, 0x87);
	if (rval < 0)
		return rval;

	INIT_DELAYED_WORK(&pchip->work, lm3630a_delayed_func);
	pchip->irqthread = create_singlethread_workqueue("lm3630a-irqthd");
	if (!pchip->irqthread) {
		dev_err(pchip->dev, "create irq thread fail\n");
		return -ENOMEM;
	}
	if (request_threaded_irq
	    (pchip->irq, NULL, lm3630a_isr_func,
	     IRQF_TRIGGER_FALLING | IRQF_ONESHOT, "lm3630a_irq", pchip)) {
		dev_err(pchip->dev, "request threaded irq fail\n");
		destroy_workqueue(pchip->irqthread);
		return -ENOMEM;
	}
	return rval;
}

static void lm3630a_pwm_ctrl(struct lm3630a_chip *pchip, int br, int br_max)
{
	unsigned int period = pwm_get_period(pchip->pwmd);
	unsigned int duty = br * period / br_max;

	pwm_config(pchip->pwmd, duty, period);
	if (duty)
		pwm_enable(pchip->pwmd);
	else
		pwm_disable(pchip->pwmd);
}

/* update and get brightness */
static int lm3630a_bank_a_update_status(struct backlight_device *bl)
{
	int ret;
	struct lm3630a_chip *pchip = bl_get_data(bl);
	enum lm3630a_pwm_ctrl pwm_ctrl = pchip->pdata->pwm_ctrl;

	/* pwm control */
	if ((pwm_ctrl & LM3630A_PWM_BANK_A) != 0) {
		lm3630a_pwm_ctrl(pchip, bl->props.brightness,
				 bl->props.max_brightness);
		return bl->props.brightness;
	}

	/* disable sleep */
	ret = lm3630a_update(pchip, REG_CTRL, 0x80, 0x00);
	if (ret < 0)
		goto out_i2c_err;
	usleep_range(1000, 2000);
	/* minimum brightness is 0x04 */
	ret = lm3630a_write(pchip, REG_BRT_A, bl->props.brightness);
	if (bl->props.brightness < 0x4)
		ret |= lm3630a_update(pchip, REG_CTRL, LM3630A_LEDA_ENABLE, 0);
	else
		ret |= lm3630a_update(pchip, REG_CTRL,
				      LM3630A_LEDA_ENABLE, LM3630A_LEDA_ENABLE);
	if (ret < 0)
		goto out_i2c_err;
	return bl->props.brightness;

out_i2c_err:
	dev_err(pchip->dev, "i2c failed to access\n");
	return bl->props.brightness;
}

static int lm3630a_bank_a_get_brightness(struct backlight_device *bl)
{
	int brightness, rval;
	struct lm3630a_chip *pchip = bl_get_data(bl);
	enum lm3630a_pwm_ctrl pwm_ctrl = pchip->pdata->pwm_ctrl;

	if ((pwm_ctrl & LM3630A_PWM_BANK_A) != 0) {
		rval = lm3630a_read(pchip, REG_PWM_OUTHIGH);
		if (rval < 0)
			goto out_i2c_err;
		brightness = (rval & 0x01) << 8;
		rval = lm3630a_read(pchip, REG_PWM_OUTLOW);
		if (rval < 0)
			goto out_i2c_err;
		brightness |= rval;
		goto out;
	}

	/* disable sleep */
	rval = lm3630a_update(pchip, REG_CTRL, 0x80, 0x00);
	if (rval < 0)
		goto out_i2c_err;
	usleep_range(1000, 2000);
	rval = lm3630a_read(pchip, REG_BRT_A);
	if (rval < 0)
		goto out_i2c_err;
	brightness = rval;

out:
	bl->props.brightness = brightness;
	return bl->props.brightness;
out_i2c_err:
	dev_err(pchip->dev, "i2c failed to access register\n");
	return 0;
}

static const struct backlight_ops lm3630a_bank_a_ops = {
	.options = BL_CORE_SUSPENDRESUME,
	.update_status = lm3630a_bank_a_update_status,
	.get_brightness = lm3630a_bank_a_get_brightness,
};

/* update and get brightness */
static int lm3630a_bank_b_update_status(struct backlight_device *bl)
{
	int ret;
	struct lm3630a_chip *pchip = bl_get_data(bl);
	enum lm3630a_pwm_ctrl pwm_ctrl = pchip->pdata->pwm_ctrl;

	/* pwm control */
	if ((pwm_ctrl & LM3630A_PWM_BANK_B) != 0) {
		lm3630a_pwm_ctrl(pchip, bl->props.brightness,
				 bl->props.max_brightness);
		return bl->props.brightness;
	}

	/* disable sleep */
	ret = lm3630a_update(pchip, REG_CTRL, 0x80, 0x00);
	if (ret < 0)
		goto out_i2c_err;
	usleep_range(1000, 2000);
	/* minimum brightness is 0x04 */
	ret = lm3630a_write(pchip, REG_BRT_B, bl->props.brightness);
	if (bl->props.brightness < 0x4)
		ret |= lm3630a_update(pchip, REG_CTRL, LM3630A_LEDB_ENABLE, 0);
	else
		ret |= lm3630a_update(pchip, REG_CTRL,
				      LM3630A_LEDB_ENABLE, LM3630A_LEDB_ENABLE);
	if (ret < 0)
		goto out_i2c_err;
	return bl->props.brightness;

out_i2c_err:
	dev_err(pchip->dev, "i2c failed to access REG_CTRL\n");
	return bl->props.brightness;
}

static int lm3630a_bank_b_get_brightness(struct backlight_device *bl)
{
	int brightness, rval;
	struct lm3630a_chip *pchip = bl_get_data(bl);
	enum lm3630a_pwm_ctrl pwm_ctrl = pchip->pdata->pwm_ctrl;

	if ((pwm_ctrl & LM3630A_PWM_BANK_B) != 0) {
		rval = lm3630a_read(pchip, REG_PWM_OUTHIGH);
		if (rval < 0)
			goto out_i2c_err;
		brightness = (rval & 0x01) << 8;
		rval = lm3630a_read(pchip, REG_PWM_OUTLOW);
		if (rval < 0)
			goto out_i2c_err;
		brightness |= rval;
		goto out;
	}

	/* disable sleep */
	rval = lm3630a_update(pchip, REG_CTRL, 0x80, 0x00);
	if (rval < 0)
		goto out_i2c_err;
	usleep_range(1000, 2000);
	rval = lm3630a_read(pchip, REG_BRT_B);
	if (rval < 0)
		goto out_i2c_err;
	brightness = rval;

out:
	bl->props.brightness = brightness;
	return bl->props.brightness;
out_i2c_err:
	dev_err(pchip->dev, "i2c failed to access register\n");
	return 0;
}

static const struct backlight_ops lm3630a_bank_b_ops = {
	.options = BL_CORE_SUSPENDRESUME,
	.update_status = lm3630a_bank_b_update_status,
	.get_brightness = lm3630a_bank_b_get_brightness,
};

static int lm3630a_backlight_register(struct lm3630a_chip *pchip)
{
	struct backlight_properties props;
	struct lm3630a_platform_data *pdata = pchip->pdata;

	props.type = BACKLIGHT_RAW;
	if (pdata->leda_ctrl != LM3630A_LEDA_DISABLE) {
		props.brightness = pdata->leda_init_brt;
		props.max_brightness = pdata->leda_max_brt;
		pchip->bleda =
		    devm_backlight_device_register(pchip->dev, "lm3630a_leda",
						   pchip->dev, pchip,
						   &lm3630a_bank_a_ops, &props);
		if (IS_ERR(pchip->bleda))
			return PTR_ERR(pchip->bleda);
	}

	if ((pdata->ledb_ctrl != LM3630A_LEDB_DISABLE) &&
	    (pdata->ledb_ctrl != LM3630A_LEDB_ON_A)) {
		props.brightness = pdata->ledb_init_brt;
		props.max_brightness = pdata->ledb_max_brt;
		pchip->bledb =
		    devm_backlight_device_register(pchip->dev, "lm3630a_ledb",
						   pchip->dev, pchip,
						   &lm3630a_bank_b_ops, &props);
		if (IS_ERR(pchip->bledb))
			return PTR_ERR(pchip->bledb);
	}
	return 0;
}

static const struct regmap_config lm3630a_regmap = {
	.reg_bits = 8,
	.val_bits = 8,
	.max_register = REG_MAX,
};

static int lm3630a_probe(struct i2c_client *client,
			 const struct i2c_device_id *id)
{
	struct lm3630a_platform_data *pdata = dev_get_platdata(&client->dev);
	struct lm3630a_chip *pchip;
	int rval;

	if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
		dev_err(&client->dev, "fail : i2c functionality check\n");
		return -EOPNOTSUPP;
	}

	pchip = devm_kzalloc(&client->dev, sizeof(struct lm3630a_chip),
			     GFP_KERNEL);
	if (!pchip)
		return -ENOMEM;
	pchip->dev = &client->dev;

	pchip->regmap = devm_regmap_init_i2c(client, &lm3630a_regmap);
	if (IS_ERR(pchip->regmap)) {
		rval = PTR_ERR(pchip->regmap);
		dev_err(&client->dev, "fail : allocate reg. map: %d\n", rval);
		return rval;
	}

	i2c_set_clientdata(client, pchip);
	if (pdata == NULL) {
		pdata = devm_kzalloc(pchip->dev,
				     sizeof(struct lm3630a_platform_data),
				     GFP_KERNEL);
		if (pdata == NULL)
			return -ENOMEM;
		/* default values */
		pdata->leda_ctrl = LM3630A_LEDA_ENABLE;
		pdata->ledb_ctrl = LM3630A_LEDB_ENABLE;
		pdata->leda_max_brt = LM3630A_MAX_BRIGHTNESS;
		pdata->ledb_max_brt = LM3630A_MAX_BRIGHTNESS;
		pdata->leda_init_brt = LM3630A_MAX_BRIGHTNESS;
		pdata->ledb_init_brt = LM3630A_MAX_BRIGHTNESS;
	}
	pchip->pdata = pdata;

	/* chip initialize */
	rval = lm3630a_chip_init(pchip);
	if (rval < 0) {
		dev_err(&client->dev, "fail : init chip\n");
		return rval;
	}
	/* backlight register */
	rval = lm3630a_backlight_register(pchip);
	if (rval < 0) {
		dev_err(&client->dev, "fail : backlight register.\n");
		return rval;
	}
	/* pwm */
	if (pdata->pwm_ctrl != LM3630A_PWM_DISABLE) {
		pchip->pwmd = devm_pwm_get(pchip->dev, "lm3630a-pwm");
		if (IS_ERR(pchip->pwmd)) {
			dev_err(&client->dev, "fail : get pwm device\n");
			return PTR_ERR(pchip->pwmd);
		}
	}
	pchip->pwmd->period = pdata->pwm_period;

	/* interrupt enable  : irq 0 is not allowed */
	pchip->irq = client->irq;
	if (pchip->irq) {
		rval = lm3630a_intr_config(pchip);
		if (rval < 0)
			return rval;
	}
	dev_info(&client->dev, "LM3630A backlight register OK.\n");
	return 0;
}

static int lm3630a_remove(struct i2c_client *client)
{
	int rval;
	struct lm3630a_chip *pchip = i2c_get_clientdata(client);

	rval = lm3630a_write(pchip, REG_BRT_A, 0);
	if (rval < 0)
		dev_err(pchip->dev, "i2c failed to access register\n");

	rval = lm3630a_write(pchip, REG_BRT_B, 0);
	if (rval < 0)
		dev_err(pchip->dev, "i2c failed to access register\n");

	if (pchip->irq) {
		free_irq(pchip->irq, pchip);
		flush_workqueue(pchip->irqthread);
		destroy_workqueue(pchip->irqthread);
	}
	return 0;
}

static const struct i2c_device_id lm3630a_id[] = {
	{LM3630A_NAME, 0},
	{}
};

MODULE_DEVICE_TABLE(i2c, lm3630a_id);

static struct i2c_driver lm3630a_i2c_driver = {
	.driver = {
		   .name = LM3630A_NAME,
		   },
	.probe = lm3630a_probe,
	.remove = lm3630a_remove,
	.id_table = lm3630a_id,
};

module_i2c_driver(lm3630a_i2c_driver);

MODULE_DESCRIPTION("Texas Instruments Backlight driver for LM3630A");
MODULE_AUTHOR("Daniel Jeong <gshark.jeong@gmail.com>");
MODULE_AUTHOR("LDD MLP <ldd-mlp@list.ti.com>");
MODULE_LICENSE("GPL v2");
Commit	Line	Data
28e64a68 DJ	1	/*
	2	* Simple driver for Texas Instruments LM3630A Backlight driver chip
	3	* Copyright (C) 2012 Texas Instruments
	4	*
	5	* This program is free software; you can redistribute it and/or modify
	6	* it under the terms of the GNU General Public License version 2 as
	7	* published by the Free Software Foundation.
	8	*
	9	*/
	10	#include <linux/module.h>
	11	#include <linux/slab.h>
	12	#include <linux/i2c.h>
	13	#include <linux/backlight.h>
	14	#include <linux/err.h>
	15	#include <linux/delay.h>
	16	#include <linux/uaccess.h>
	17	#include <linux/interrupt.h>
	18	#include <linux/regmap.h>
	19	#include <linux/pwm.h>
	20	#include <linux/platform_data/lm3630a_bl.h>
	21
	22	#define REG_CTRL 0x00
	23	#define REG_BOOST 0x02
	24	#define REG_CONFIG 0x01
	25	#define REG_BRT_A 0x03
	26	#define REG_BRT_B 0x04
	27	#define REG_I_A 0x05
	28	#define REG_I_B 0x06
	29	#define REG_INT_STATUS 0x09
	30	#define REG_INT_EN 0x0A
	31	#define REG_FAULT 0x0B
	32	#define REG_PWM_OUTLOW 0x12
	33	#define REG_PWM_OUTHIGH 0x13
	34	#define REG_MAX 0x1F
	35
	36	#define INT_DEBOUNCE_MSEC 10
	37	struct lm3630a_chip {
	38	struct device *dev;
	39	struct delayed_work work;
	40
	41	int irq;
	42	struct workqueue_struct *irqthread;
	43	struct lm3630a_platform_data *pdata;
	44	struct backlight_device *bleda;
	45	struct backlight_device *bledb;
	46	struct regmap *regmap;
	47	struct pwm_device *pwmd;
	48	};
	49
	50	/* i2c access */
	51	static int lm3630a_read(struct lm3630a_chip *pchip, unsigned int reg)
	52	{
	53	int rval;
	54	unsigned int reg_val;
	55
	56	rval = regmap_read(pchip->regmap, reg, &reg_val);
	57	if (rval < 0)
	58	return rval;
	59	return reg_val & 0xFF;
	60	}
	61
	62	static int lm3630a_write(struct lm3630a_chip *pchip,
	63	unsigned int reg, unsigned int data)
	64	{
65	return regmap_write(pchip->regmap, reg, data);
66	}
67
68	static int lm3630a_update(struct lm3630a_chip *pchip,
69	unsigned int reg, unsigned int mask,
70	unsigned int data)
71	{
72	return regmap_update_bits(pchip->regmap, reg, mask, data);
73	}
74
75	/* initialize chip */
76	static int lm3630a_chip_init(struct lm3630a_chip *pchip)
77	{
78	int rval;
79	struct lm3630a_platform_data *pdata = pchip->pdata;
80
81	usleep_range(1000, 2000);
82	/* set Filter Strength Register */
83	rval = lm3630a_write(pchip, 0x50, 0x03);
84	/* set Cofig. register */
85	rval \|= lm3630a_update(pchip, REG_CONFIG, 0x07, pdata->pwm_ctrl);
86	/* set boost control */
87	rval \|= lm3630a_write(pchip, REG_BOOST, 0x38);
88	/* set current A */
89	rval \|= lm3630a_update(pchip, REG_I_A, 0x1F, 0x1F);
90	/* set current B */
91	rval \|= lm3630a_write(pchip, REG_I_B, 0x1F);
92	/* set control */
4c4d2a3a DJ	93	rval \|= lm3630a_update(pchip, REG_CTRL, 0x14, pdata->leda_ctrl);
4c4d2a3a DJ	94	rval \|= lm3630a_update(pchip, REG_CTRL, 0x0B, pdata->ledb_ctrl);
28e64a68 DJ	95	usleep_range(1000, 2000);
	96	/* set brightness A and B */
	97	rval \|= lm3630a_write(pchip, REG_BRT_A, pdata->leda_init_brt);
	98	rval \|= lm3630a_write(pchip, REG_BRT_B, pdata->ledb_init_brt);
	99
	100	if (rval < 0)
	101	dev_err(pchip->dev, "i2c failed to access register\n");
	102	return rval;
	103	}
	104
	105	/* interrupt handling */
	106	static void lm3630a_delayed_func(struct work_struct *work)
	107	{
2a0c316b	108	int rval;
28e64a68 DJ	109	struct lm3630a_chip *pchip;
	110
	111	pchip = container_of(work, struct lm3630a_chip, work.work);
	112
	113	rval = lm3630a_read(pchip, REG_INT_STATUS);
	114	if (rval < 0) {
	115	dev_err(pchip->dev,
	116	"i2c failed to access REG_INT_STATUS Register\n");
	117	return;
	118	}
	119
	120	dev_info(pchip->dev, "REG_INT_STATUS Register is 0x%x\n", rval);
	121	}
	122
	123	static irqreturn_t lm3630a_isr_func(int irq, void *chip)
	124	{
	125	int rval;
	126	struct lm3630a_chip *pchip = chip;
	127	unsigned long delay = msecs_to_jiffies(INT_DEBOUNCE_MSEC);
	128
	129	queue_delayed_work(pchip->irqthread, &pchip->work, delay);
	130
	131	rval = lm3630a_update(pchip, REG_CTRL, 0x80, 0x00);
	132	if (rval < 0) {
	133	dev_err(pchip->dev, "i2c failed to access register\n");
	134	return IRQ_NONE;
	135	}
	136	return IRQ_HANDLED;
	137	}
	138
	139	static int lm3630a_intr_config(struct lm3630a_chip *pchip)
	140	{
	141	int rval;
	142
	143	rval = lm3630a_write(pchip, REG_INT_EN, 0x87);
	144	if (rval < 0)
	145	return rval;
	146
	147	INIT_DELAYED_WORK(&pchip->work, lm3630a_delayed_func);
	148	pchip->irqthread = create_singlethread_workqueue("lm3630a-irqthd");
	149	if (!pchip->irqthread) {
	150	dev_err(pchip->dev, "create irq thread fail\n");
	151	return -ENOMEM;
	152	}
	153	if (request_threaded_irq
	154	(pchip->irq, NULL, lm3630a_isr_func,
	155	IRQF_TRIGGER_FALLING \| IRQF_ONESHOT, "lm3630a_irq", pchip)) {
	156	dev_err(pchip->dev, "request threaded irq fail\n");
bcd5b416	157	destroy_workqueue(pchip->irqthread);
28e64a68 DJ	158	return -ENOMEM;
	159	}
	160	return rval;
	161	}
	162
	163	static void lm3630a_pwm_ctrl(struct lm3630a_chip *pchip, int br, int br_max)
	164	{
	165	unsigned int period = pwm_get_period(pchip->pwmd);
	166	unsigned int duty = br * period / br_max;
	167
	168	pwm_config(pchip->pwmd, duty, period);
	169	if (duty)
	170	pwm_enable(pchip->pwmd);
	171	else
	172	pwm_disable(pchip->pwmd);
	173	}
	174
	175	/* update and get brightness */
	176	static int lm3630a_bank_a_update_status(struct backlight_device *bl)
	177	{
	178	int ret;
	179	struct lm3630a_chip *pchip = bl_get_data(bl);
	180	enum lm3630a_pwm_ctrl pwm_ctrl = pchip->pdata->pwm_ctrl;
	181
	182	/* pwm control */
	183	if ((pwm_ctrl & LM3630A_PWM_BANK_A) != 0) {
	184	lm3630a_pwm_ctrl(pchip, bl->props.brightness,
	185	bl->props.max_brightness);
	186	return bl->props.brightness;
	187	}
	188
	189	/* disable sleep */
	190	ret = lm3630a_update(pchip, REG_CTRL, 0x80, 0x00);
	191	if (ret < 0)
	192	goto out_i2c_err;
	193	usleep_range(1000, 2000);
	194	/* minimum brightness is 0x04 */
	195	ret = lm3630a_write(pchip, REG_BRT_A, bl->props.brightness);
	196	if (bl->props.brightness < 0x4)
	197	ret \|= lm3630a_update(pchip, REG_CTRL, LM3630A_LEDA_ENABLE, 0);
	198	else
	199	ret \|= lm3630a_update(pchip, REG_CTRL,
	200	LM3630A_LEDA_ENABLE, LM3630A_LEDA_ENABLE);
	201	if (ret < 0)
	202	goto out_i2c_err;
	203	return bl->props.brightness;
	204
	205	out_i2c_err:
	206	dev_err(pchip->dev, "i2c failed to access\n");
	207	return bl->props.brightness;
	208	}
	209
	210	static int lm3630a_bank_a_get_brightness(struct backlight_device *bl)
	211	{
	212	int brightness, rval;
	213	struct lm3630a_chip *pchip = bl_get_data(bl);
	214	enum lm3630a_pwm_ctrl pwm_ctrl = pchip->pdata->pwm_ctrl;
	215
	216	if ((pwm_ctrl & LM3630A_PWM_BANK_A) != 0) {
	217	rval = lm3630a_read(pchip, REG_PWM_OUTHIGH);
	218	if (rval < 0)
	219	goto out_i2c_err;
	220	brightness = (rval & 0x01) << 8;
	221	rval = lm3630a_read(pchip, REG_PWM_OUTLOW);
222	if (rval < 0)
223	goto out_i2c_err;
224	brightness \|= rval;
225	goto out;
226	}
227
228	/* disable sleep */
229	rval = lm3630a_update(pchip, REG_CTRL, 0x80, 0x00);
230	if (rval < 0)
231	goto out_i2c_err;
232	usleep_range(1000, 2000);
233	rval = lm3630a_read(pchip, REG_BRT_A);
234	if (rval < 0)
235	goto out_i2c_err;
236	brightness = rval;
237
238	out:
239	bl->props.brightness = brightness;
240	return bl->props.brightness;
241	out_i2c_err:
242	dev_err(pchip->dev, "i2c failed to access register\n");
243	return 0;
244	}
245
246	static const struct backlight_ops lm3630a_bank_a_ops = {
247	.options = BL_CORE_SUSPENDRESUME,
248	.update_status = lm3630a_bank_a_update_status,
249	.get_brightness = lm3630a_bank_a_get_brightness,
250	};
251
252	/* update and get brightness */
253	static int lm3630a_bank_b_update_status(struct backlight_device *bl)
254	{
255	int ret;
256	struct lm3630a_chip *pchip = bl_get_data(bl);
257	enum lm3630a_pwm_ctrl pwm_ctrl = pchip->pdata->pwm_ctrl;
258
259	/* pwm control */
260	if ((pwm_ctrl & LM3630A_PWM_BANK_B) != 0) {
261	lm3630a_pwm_ctrl(pchip, bl->props.brightness,
262	bl->props.max_brightness);
263	return bl->props.brightness;
264	}
265
266	/* disable sleep */
267	ret = lm3630a_update(pchip, REG_CTRL, 0x80, 0x00);
268	if (ret < 0)
269	goto out_i2c_err;
270	usleep_range(1000, 2000);
271	/* minimum brightness is 0x04 */
272	ret = lm3630a_write(pchip, REG_BRT_B, bl->props.brightness);
273	if (bl->props.brightness < 0x4)
274	ret \|= lm3630a_update(pchip, REG_CTRL, LM3630A_LEDB_ENABLE, 0);
275	else
276	ret \|= lm3630a_update(pchip, REG_CTRL,
277	LM3630A_LEDB_ENABLE, LM3630A_LEDB_ENABLE);
278	if (ret < 0)
279	goto out_i2c_err;
280	return bl->props.brightness;
281
282	out_i2c_err:
283	dev_err(pchip->dev, "i2c failed to access REG_CTRL\n");
284	return bl->props.brightness;
285	}
286
287	static int lm3630a_bank_b_get_brightness(struct backlight_device *bl)
288	{
289	int brightness, rval;
290	struct lm3630a_chip *pchip = bl_get_data(bl);
291	enum lm3630a_pwm_ctrl pwm_ctrl = pchip->pdata->pwm_ctrl;
292
293	if ((pwm_ctrl & LM3630A_PWM_BANK_B) != 0) {
294	rval = lm3630a_read(pchip, REG_PWM_OUTHIGH);
295	if (rval < 0)
296	goto out_i2c_err;
297	brightness = (rval & 0x01) << 8;
298	rval = lm3630a_read(pchip, REG_PWM_OUTLOW);
299	if (rval < 0)
300	goto out_i2c_err;
301	brightness \|= rval;
302	goto out;
303	}
304
305	/* disable sleep */
306	rval = lm3630a_update(pchip, REG_CTRL, 0x80, 0x00);
307	if (rval < 0)
308	goto out_i2c_err;
309	usleep_range(1000, 2000);
310	rval = lm3630a_read(pchip, REG_BRT_B);
311	if (rval < 0)
312	goto out_i2c_err;
313	brightness = rval;
314
315	out:
316	bl->props.brightness = brightness;
317	return bl->props.brightness;
318	out_i2c_err:
319	dev_err(pchip->dev, "i2c failed to access register\n");
320	return 0;
321	}
322
323	static const struct backlight_ops lm3630a_bank_b_ops = {
324	.options = BL_CORE_SUSPENDRESUME,
325	.update_status = lm3630a_bank_b_update_status,
326	.get_brightness = lm3630a_bank_b_get_brightness,
327	};
328
329	static int lm3630a_backlight_register(struct lm3630a_chip *pchip)
330	{
331	struct backlight_properties props;
332	struct lm3630a_platform_data *pdata = pchip->pdata;
333
334	props.type = BACKLIGHT_RAW;
335	if (pdata->leda_ctrl != LM3630A_LEDA_DISABLE) {
336	props.brightness = pdata->leda_init_brt;
337	props.max_brightness = pdata->leda_max_brt;
338	pchip->bleda =
339	devm_backlight_device_register(pchip->dev, "lm3630a_leda",
340	pchip->dev, pchip,
341	&lm3630a_bank_a_ops, &props);
342	if (IS_ERR(pchip->bleda))
343	return PTR_ERR(pchip->bleda);
344	}
345
346	if ((pdata->ledb_ctrl != LM3630A_LEDB_DISABLE) &&
347	(pdata->ledb_ctrl != LM3630A_LEDB_ON_A)) {
348	props.brightness = pdata->ledb_init_brt;
349	props.max_brightness = pdata->ledb_max_brt;
350	pchip->bledb =
351	devm_backlight_device_register(pchip->dev, "lm3630a_ledb",
352	pchip->dev, pchip,
353	&lm3630a_bank_b_ops, &props);
354	if (IS_ERR(pchip->bledb))
355	return PTR_ERR(pchip->bledb);
356	}
357	return 0;
358	}
359
360	static const struct regmap_config lm3630a_regmap = {
361	.reg_bits = 8,
362	.val_bits = 8,
363	.max_register = REG_MAX,
364	};
365
366	static int lm3630a_probe(struct i2c_client *client,
367	const struct i2c_device_id *id)
368	{
c512794c	369	struct lm3630a_platform_data *pdata = dev_get_platdata(&client->dev);
28e64a68 DJ	370	struct lm3630a_chip *pchip;
	371	int rval;
	372
	373	if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
	374	dev_err(&client->dev, "fail : i2c functionality check\n");
	375	return -EOPNOTSUPP;
	376	}
	377
	378	pchip = devm_kzalloc(&client->dev, sizeof(struct lm3630a_chip),
	379	GFP_KERNEL);
	380	if (!pchip)
	381	return -ENOMEM;
	382	pchip->dev = &client->dev;
	383
	384	pchip->regmap = devm_regmap_init_i2c(client, &lm3630a_regmap);
	385	if (IS_ERR(pchip->regmap)) {
	386	rval = PTR_ERR(pchip->regmap);
	387	dev_err(&client->dev, "fail : allocate reg. map: %d\n", rval);
	388	return rval;
	389	}
	390
	391	i2c_set_clientdata(client, pchip);
	392	if (pdata == NULL) {
e19493c1 DC	393	pdata = devm_kzalloc(pchip->dev,
	394	sizeof(struct lm3630a_platform_data),
	395	GFP_KERNEL);
	396	if (pdata == NULL)
28e64a68 DJ	397	return -ENOMEM;
28e64a68 DJ	398	/* default values */
e19493c1 DC	399	pdata->leda_ctrl = LM3630A_LEDA_ENABLE;
	400	pdata->ledb_ctrl = LM3630A_LEDB_ENABLE;
	401	pdata->leda_max_brt = LM3630A_MAX_BRIGHTNESS;
	402	pdata->ledb_max_brt = LM3630A_MAX_BRIGHTNESS;
	403	pdata->leda_init_brt = LM3630A_MAX_BRIGHTNESS;
	404	pdata->ledb_init_brt = LM3630A_MAX_BRIGHTNESS;
28e64a68	405	}
e19493c1 DC	406	pchip->pdata = pdata;
e19493c1 DC	407
28e64a68 DJ	408	/* chip initialize */
	409	rval = lm3630a_chip_init(pchip);
	410	if (rval < 0) {
	411	dev_err(&client->dev, "fail : init chip\n");
	412	return rval;
	413	}
	414	/* backlight register */
	415	rval = lm3630a_backlight_register(pchip);
	416	if (rval < 0) {
	417	dev_err(&client->dev, "fail : backlight register.\n");
	418	return rval;
	419	}
	420	/* pwm */
	421	if (pdata->pwm_ctrl != LM3630A_PWM_DISABLE) {
	422	pchip->pwmd = devm_pwm_get(pchip->dev, "lm3630a-pwm");
	423	if (IS_ERR(pchip->pwmd)) {
	424	dev_err(&client->dev, "fail : get pwm device\n");
	425	return PTR_ERR(pchip->pwmd);
	426	}
	427	}
	428	pchip->pwmd->period = pdata->pwm_period;
	429
	430	/* interrupt enable : irq 0 is not allowed */
	431	pchip->irq = client->irq;
	432	if (pchip->irq) {
	433	rval = lm3630a_intr_config(pchip);
	434	if (rval < 0)
	435	return rval;
	436	}
	437	dev_info(&client->dev, "LM3630A backlight register OK.\n");
	438	return 0;
	439	}
	440
	441	static int lm3630a_remove(struct i2c_client *client)
	442	{
	443	int rval;
	444	struct lm3630a_chip *pchip = i2c_get_clientdata(client);
	445
	446	rval = lm3630a_write(pchip, REG_BRT_A, 0);
	447	if (rval < 0)
	448	dev_err(pchip->dev, "i2c failed to access register\n");
	449
	450	rval = lm3630a_write(pchip, REG_BRT_B, 0);
	451	if (rval < 0)
	452	dev_err(pchip->dev, "i2c failed to access register\n");
	453
	454	if (pchip->irq) {
	455	free_irq(pchip->irq, pchip);
	456	flush_workqueue(pchip->irqthread);
	457	destroy_workqueue(pchip->irqthread);
	458	}
	459	return 0;
	460	}
	461
	462	static const struct i2c_device_id lm3630a_id[] = {
	463	{LM3630A_NAME, 0},
	464	{}
	465	};
	466
	467	MODULE_DEVICE_TABLE(i2c, lm3630a_id);
	468
	469	static struct i2c_driver lm3630a_i2c_driver = {
	470	.driver = {
	471	.name = LM3630A_NAME,
472	},
473	.probe = lm3630a_probe,
474	.remove = lm3630a_remove,
475	.id_table = lm3630a_id,
476	};
477
478	module_i2c_driver(lm3630a_i2c_driver);
479
480	MODULE_DESCRIPTION("Texas Instruments Backlight driver for LM3630A");
481	MODULE_AUTHOR("Daniel Jeong <gshark.jeong@gmail.com>");
482	MODULE_AUTHOR("LDD MLP <ldd-mlp@list.ti.com>");
483	MODULE_LICENSE("GPL v2");