mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-11-17 01:04:19 +08:00
5a429bdd6f
There is no need to return -EIO, because backlight_device_register() already returns correct error values. Signed-off-by: Jingoo Han <jg1.han@samsung.com> Acked-by: Daniel Jeong <daniel.jeong@ti.com> Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
476 lines
12 KiB
C
476 lines
12 KiB
C
/*
|
|
* Simple driver for Texas Instruments LM3630 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/platform_data/lm3630_bl.h>
|
|
|
|
#define REG_CTRL 0x00
|
|
#define REG_CONFIG 0x01
|
|
#define REG_BRT_A 0x03
|
|
#define REG_BRT_B 0x04
|
|
#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
|
|
|
|
enum lm3630_leds {
|
|
BLED_ALL = 0,
|
|
BLED_1,
|
|
BLED_2
|
|
};
|
|
|
|
static const char * const bled_name[] = {
|
|
[BLED_ALL] = "lm3630_bled", /*Bank1 controls all string */
|
|
[BLED_1] = "lm3630_bled1", /*Bank1 controls bled1 */
|
|
[BLED_2] = "lm3630_bled2", /*Bank1 or 2 controls bled2 */
|
|
};
|
|
|
|
struct lm3630_chip_data {
|
|
struct device *dev;
|
|
struct delayed_work work;
|
|
int irq;
|
|
struct workqueue_struct *irqthread;
|
|
struct lm3630_platform_data *pdata;
|
|
struct backlight_device *bled1;
|
|
struct backlight_device *bled2;
|
|
struct regmap *regmap;
|
|
};
|
|
|
|
/* initialize chip */
|
|
static int lm3630_chip_init(struct lm3630_chip_data *pchip)
|
|
{
|
|
int ret;
|
|
unsigned int reg_val;
|
|
struct lm3630_platform_data *pdata = pchip->pdata;
|
|
|
|
/*pwm control */
|
|
reg_val = ((pdata->pwm_active & 0x01) << 2) | (pdata->pwm_ctrl & 0x03);
|
|
ret = regmap_update_bits(pchip->regmap, REG_CONFIG, 0x07, reg_val);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
/* bank control */
|
|
reg_val = ((pdata->bank_b_ctrl & 0x01) << 1) |
|
|
(pdata->bank_a_ctrl & 0x07);
|
|
ret = regmap_update_bits(pchip->regmap, REG_CTRL, 0x07, reg_val);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
ret = regmap_update_bits(pchip->regmap, REG_CTRL, 0x80, 0x00);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
/* set initial brightness */
|
|
if (pdata->bank_a_ctrl != BANK_A_CTRL_DISABLE) {
|
|
ret = regmap_write(pchip->regmap,
|
|
REG_BRT_A, pdata->init_brt_led1);
|
|
if (ret < 0)
|
|
goto out;
|
|
}
|
|
|
|
if (pdata->bank_b_ctrl != BANK_B_CTRL_DISABLE) {
|
|
ret = regmap_write(pchip->regmap,
|
|
REG_BRT_B, pdata->init_brt_led2);
|
|
if (ret < 0)
|
|
goto out;
|
|
}
|
|
return ret;
|
|
|
|
out:
|
|
dev_err(pchip->dev, "i2c failed to access register\n");
|
|
return ret;
|
|
}
|
|
|
|
/* interrupt handling */
|
|
static void lm3630_delayed_func(struct work_struct *work)
|
|
{
|
|
int ret;
|
|
unsigned int reg_val;
|
|
struct lm3630_chip_data *pchip;
|
|
|
|
pchip = container_of(work, struct lm3630_chip_data, work.work);
|
|
|
|
ret = regmap_read(pchip->regmap, REG_INT_STATUS, ®_val);
|
|
if (ret < 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", reg_val);
|
|
}
|
|
|
|
static irqreturn_t lm3630_isr_func(int irq, void *chip)
|
|
{
|
|
int ret;
|
|
struct lm3630_chip_data *pchip = chip;
|
|
unsigned long delay = msecs_to_jiffies(INT_DEBOUNCE_MSEC);
|
|
|
|
queue_delayed_work(pchip->irqthread, &pchip->work, delay);
|
|
|
|
ret = regmap_update_bits(pchip->regmap, REG_CTRL, 0x80, 0x00);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
return IRQ_HANDLED;
|
|
out:
|
|
dev_err(pchip->dev, "i2c failed to access register\n");
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static int lm3630_intr_config(struct lm3630_chip_data *pchip)
|
|
{
|
|
INIT_DELAYED_WORK(&pchip->work, lm3630_delayed_func);
|
|
pchip->irqthread = create_singlethread_workqueue("lm3630-irqthd");
|
|
if (!pchip->irqthread) {
|
|
dev_err(pchip->dev, "create irq thread fail...\n");
|
|
return -1;
|
|
}
|
|
if (request_threaded_irq
|
|
(pchip->irq, NULL, lm3630_isr_func,
|
|
IRQF_TRIGGER_FALLING | IRQF_ONESHOT, "lm3630_irq", pchip)) {
|
|
dev_err(pchip->dev, "request threaded irq fail..\n");
|
|
return -1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static bool
|
|
set_intensity(struct backlight_device *bl, struct lm3630_chip_data *pchip)
|
|
{
|
|
if (!pchip->pdata->pwm_set_intensity)
|
|
return false;
|
|
pchip->pdata->pwm_set_intensity(bl->props.brightness - 1,
|
|
pchip->pdata->pwm_period);
|
|
return true;
|
|
}
|
|
|
|
/* update and get brightness */
|
|
static int lm3630_bank_a_update_status(struct backlight_device *bl)
|
|
{
|
|
int ret;
|
|
struct lm3630_chip_data *pchip = bl_get_data(bl);
|
|
enum lm3630_pwm_ctrl pwm_ctrl = pchip->pdata->pwm_ctrl;
|
|
|
|
/* brightness 0 means disable */
|
|
if (!bl->props.brightness) {
|
|
ret = regmap_update_bits(pchip->regmap, REG_CTRL, 0x04, 0x00);
|
|
if (ret < 0)
|
|
goto out;
|
|
return bl->props.brightness;
|
|
}
|
|
|
|
/* pwm control */
|
|
if (pwm_ctrl == PWM_CTRL_BANK_A || pwm_ctrl == PWM_CTRL_BANK_ALL) {
|
|
if (!set_intensity(bl, pchip))
|
|
dev_err(pchip->dev, "No pwm control func. in plat-data\n");
|
|
} else {
|
|
|
|
/* i2c control */
|
|
ret = regmap_update_bits(pchip->regmap, REG_CTRL, 0x80, 0x00);
|
|
if (ret < 0)
|
|
goto out;
|
|
mdelay(1);
|
|
ret = regmap_write(pchip->regmap,
|
|
REG_BRT_A, bl->props.brightness - 1);
|
|
if (ret < 0)
|
|
goto out;
|
|
}
|
|
return bl->props.brightness;
|
|
out:
|
|
dev_err(pchip->dev, "i2c failed to access REG_CTRL\n");
|
|
return bl->props.brightness;
|
|
}
|
|
|
|
static int lm3630_bank_a_get_brightness(struct backlight_device *bl)
|
|
{
|
|
unsigned int reg_val;
|
|
int brightness, ret;
|
|
struct lm3630_chip_data *pchip = bl_get_data(bl);
|
|
enum lm3630_pwm_ctrl pwm_ctrl = pchip->pdata->pwm_ctrl;
|
|
|
|
if (pwm_ctrl == PWM_CTRL_BANK_A || pwm_ctrl == PWM_CTRL_BANK_ALL) {
|
|
ret = regmap_read(pchip->regmap, REG_PWM_OUTHIGH, ®_val);
|
|
if (ret < 0)
|
|
goto out;
|
|
brightness = reg_val & 0x01;
|
|
ret = regmap_read(pchip->regmap, REG_PWM_OUTLOW, ®_val);
|
|
if (ret < 0)
|
|
goto out;
|
|
brightness = ((brightness << 8) | reg_val) + 1;
|
|
} else {
|
|
ret = regmap_update_bits(pchip->regmap, REG_CTRL, 0x80, 0x00);
|
|
if (ret < 0)
|
|
goto out;
|
|
mdelay(1);
|
|
ret = regmap_read(pchip->regmap, REG_BRT_A, ®_val);
|
|
if (ret < 0)
|
|
goto out;
|
|
brightness = reg_val + 1;
|
|
}
|
|
bl->props.brightness = brightness;
|
|
return bl->props.brightness;
|
|
out:
|
|
dev_err(pchip->dev, "i2c failed to access register\n");
|
|
return 0;
|
|
}
|
|
|
|
static const struct backlight_ops lm3630_bank_a_ops = {
|
|
.options = BL_CORE_SUSPENDRESUME,
|
|
.update_status = lm3630_bank_a_update_status,
|
|
.get_brightness = lm3630_bank_a_get_brightness,
|
|
};
|
|
|
|
static int lm3630_bank_b_update_status(struct backlight_device *bl)
|
|
{
|
|
int ret;
|
|
struct lm3630_chip_data *pchip = bl_get_data(bl);
|
|
enum lm3630_pwm_ctrl pwm_ctrl = pchip->pdata->pwm_ctrl;
|
|
|
|
if (pwm_ctrl == PWM_CTRL_BANK_B || pwm_ctrl == PWM_CTRL_BANK_ALL) {
|
|
if (!set_intensity(bl, pchip))
|
|
dev_err(pchip->dev,
|
|
"no pwm control func. in plat-data\n");
|
|
} else {
|
|
ret = regmap_update_bits(pchip->regmap, REG_CTRL, 0x80, 0x00);
|
|
if (ret < 0)
|
|
goto out;
|
|
mdelay(1);
|
|
ret = regmap_write(pchip->regmap,
|
|
REG_BRT_B, bl->props.brightness - 1);
|
|
}
|
|
return bl->props.brightness;
|
|
out:
|
|
dev_err(pchip->dev, "i2c failed to access register\n");
|
|
return bl->props.brightness;
|
|
}
|
|
|
|
static int lm3630_bank_b_get_brightness(struct backlight_device *bl)
|
|
{
|
|
unsigned int reg_val;
|
|
int brightness, ret;
|
|
struct lm3630_chip_data *pchip = bl_get_data(bl);
|
|
enum lm3630_pwm_ctrl pwm_ctrl = pchip->pdata->pwm_ctrl;
|
|
|
|
if (pwm_ctrl == PWM_CTRL_BANK_B || pwm_ctrl == PWM_CTRL_BANK_ALL) {
|
|
ret = regmap_read(pchip->regmap, REG_PWM_OUTHIGH, ®_val);
|
|
if (ret < 0)
|
|
goto out;
|
|
brightness = reg_val & 0x01;
|
|
ret = regmap_read(pchip->regmap, REG_PWM_OUTLOW, ®_val);
|
|
if (ret < 0)
|
|
goto out;
|
|
brightness = ((brightness << 8) | reg_val) + 1;
|
|
} else {
|
|
ret = regmap_update_bits(pchip->regmap, REG_CTRL, 0x80, 0x00);
|
|
if (ret < 0)
|
|
goto out;
|
|
mdelay(1);
|
|
ret = regmap_read(pchip->regmap, REG_BRT_B, ®_val);
|
|
if (ret < 0)
|
|
goto out;
|
|
brightness = reg_val + 1;
|
|
}
|
|
bl->props.brightness = brightness;
|
|
|
|
return bl->props.brightness;
|
|
out:
|
|
dev_err(pchip->dev, "i2c failed to access register\n");
|
|
return bl->props.brightness;
|
|
}
|
|
|
|
static const struct backlight_ops lm3630_bank_b_ops = {
|
|
.options = BL_CORE_SUSPENDRESUME,
|
|
.update_status = lm3630_bank_b_update_status,
|
|
.get_brightness = lm3630_bank_b_get_brightness,
|
|
};
|
|
|
|
static int lm3630_backlight_register(struct lm3630_chip_data *pchip,
|
|
enum lm3630_leds ledno)
|
|
{
|
|
const char *name = bled_name[ledno];
|
|
struct backlight_properties props;
|
|
struct lm3630_platform_data *pdata = pchip->pdata;
|
|
|
|
props.type = BACKLIGHT_RAW;
|
|
switch (ledno) {
|
|
case BLED_1:
|
|
case BLED_ALL:
|
|
props.brightness = pdata->init_brt_led1;
|
|
props.max_brightness = pdata->max_brt_led1;
|
|
pchip->bled1 =
|
|
backlight_device_register(name, pchip->dev, pchip,
|
|
&lm3630_bank_a_ops, &props);
|
|
if (IS_ERR(pchip->bled1))
|
|
return PTR_ERR(pchip->bled1);
|
|
break;
|
|
case BLED_2:
|
|
props.brightness = pdata->init_brt_led2;
|
|
props.max_brightness = pdata->max_brt_led2;
|
|
pchip->bled2 =
|
|
backlight_device_register(name, pchip->dev, pchip,
|
|
&lm3630_bank_b_ops, &props);
|
|
if (IS_ERR(pchip->bled2))
|
|
return PTR_ERR(pchip->bled2);
|
|
break;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static void lm3630_backlight_unregister(struct lm3630_chip_data *pchip)
|
|
{
|
|
if (pchip->bled1)
|
|
backlight_device_unregister(pchip->bled1);
|
|
if (pchip->bled2)
|
|
backlight_device_unregister(pchip->bled2);
|
|
}
|
|
|
|
static const struct regmap_config lm3630_regmap = {
|
|
.reg_bits = 8,
|
|
.val_bits = 8,
|
|
.max_register = REG_MAX,
|
|
};
|
|
|
|
static int lm3630_probe(struct i2c_client *client,
|
|
const struct i2c_device_id *id)
|
|
{
|
|
struct lm3630_platform_data *pdata = client->dev.platform_data;
|
|
struct lm3630_chip_data *pchip;
|
|
int ret;
|
|
|
|
if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
|
|
dev_err(&client->dev, "fail : i2c functionality check...\n");
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
if (pdata == NULL) {
|
|
dev_err(&client->dev, "fail : no platform data.\n");
|
|
return -ENODATA;
|
|
}
|
|
|
|
pchip = devm_kzalloc(&client->dev, sizeof(struct lm3630_chip_data),
|
|
GFP_KERNEL);
|
|
if (!pchip)
|
|
return -ENOMEM;
|
|
pchip->pdata = pdata;
|
|
pchip->dev = &client->dev;
|
|
|
|
pchip->regmap = devm_regmap_init_i2c(client, &lm3630_regmap);
|
|
if (IS_ERR(pchip->regmap)) {
|
|
ret = PTR_ERR(pchip->regmap);
|
|
dev_err(&client->dev, "fail : allocate register map: %d\n",
|
|
ret);
|
|
return ret;
|
|
}
|
|
i2c_set_clientdata(client, pchip);
|
|
|
|
/* chip initialize */
|
|
ret = lm3630_chip_init(pchip);
|
|
if (ret < 0) {
|
|
dev_err(&client->dev, "fail : init chip\n");
|
|
goto err_chip_init;
|
|
}
|
|
|
|
switch (pdata->bank_a_ctrl) {
|
|
case BANK_A_CTRL_ALL:
|
|
ret = lm3630_backlight_register(pchip, BLED_ALL);
|
|
pdata->bank_b_ctrl = BANK_B_CTRL_DISABLE;
|
|
break;
|
|
case BANK_A_CTRL_LED1:
|
|
ret = lm3630_backlight_register(pchip, BLED_1);
|
|
break;
|
|
case BANK_A_CTRL_LED2:
|
|
ret = lm3630_backlight_register(pchip, BLED_2);
|
|
pdata->bank_b_ctrl = BANK_B_CTRL_DISABLE;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
if (ret < 0)
|
|
goto err_bl_reg;
|
|
|
|
if (pdata->bank_b_ctrl && pchip->bled2 == NULL) {
|
|
ret = lm3630_backlight_register(pchip, BLED_2);
|
|
if (ret < 0)
|
|
goto err_bl_reg;
|
|
}
|
|
|
|
/* interrupt enable : irq 0 is not allowed for lm3630 */
|
|
pchip->irq = client->irq;
|
|
if (pchip->irq)
|
|
lm3630_intr_config(pchip);
|
|
|
|
dev_info(&client->dev, "LM3630 backlight register OK.\n");
|
|
return 0;
|
|
|
|
err_bl_reg:
|
|
dev_err(&client->dev, "fail : backlight register.\n");
|
|
lm3630_backlight_unregister(pchip);
|
|
err_chip_init:
|
|
return ret;
|
|
}
|
|
|
|
static int lm3630_remove(struct i2c_client *client)
|
|
{
|
|
int ret;
|
|
struct lm3630_chip_data *pchip = i2c_get_clientdata(client);
|
|
|
|
ret = regmap_write(pchip->regmap, REG_BRT_A, 0);
|
|
if (ret < 0)
|
|
dev_err(pchip->dev, "i2c failed to access register\n");
|
|
|
|
ret = regmap_write(pchip->regmap, REG_BRT_B, 0);
|
|
if (ret < 0)
|
|
dev_err(pchip->dev, "i2c failed to access register\n");
|
|
|
|
lm3630_backlight_unregister(pchip);
|
|
if (pchip->irq) {
|
|
free_irq(pchip->irq, pchip);
|
|
flush_workqueue(pchip->irqthread);
|
|
destroy_workqueue(pchip->irqthread);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static const struct i2c_device_id lm3630_id[] = {
|
|
{LM3630_NAME, 0},
|
|
{}
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(i2c, lm3630_id);
|
|
|
|
static struct i2c_driver lm3630_i2c_driver = {
|
|
.driver = {
|
|
.name = LM3630_NAME,
|
|
},
|
|
.probe = lm3630_probe,
|
|
.remove = lm3630_remove,
|
|
.id_table = lm3630_id,
|
|
};
|
|
|
|
module_i2c_driver(lm3630_i2c_driver);
|
|
|
|
MODULE_DESCRIPTION("Texas Instruments Backlight driver for LM3630");
|
|
MODULE_AUTHOR("G.Shark Jeong <gshark.jeong@gmail.com>");
|
|
MODULE_AUTHOR("Daniel Jeong <daniel.jeong@ti.com>");
|
|
MODULE_LICENSE("GPL v2");
|