18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * TI LP855x Backlight Driver 48c2ecf20Sopenharmony_ci * 58c2ecf20Sopenharmony_ci * Copyright (C) 2011 Texas Instruments 68c2ecf20Sopenharmony_ci */ 78c2ecf20Sopenharmony_ci 88c2ecf20Sopenharmony_ci#include <linux/module.h> 98c2ecf20Sopenharmony_ci#include <linux/slab.h> 108c2ecf20Sopenharmony_ci#include <linux/i2c.h> 118c2ecf20Sopenharmony_ci#include <linux/backlight.h> 128c2ecf20Sopenharmony_ci#include <linux/delay.h> 138c2ecf20Sopenharmony_ci#include <linux/err.h> 148c2ecf20Sopenharmony_ci#include <linux/of.h> 158c2ecf20Sopenharmony_ci#include <linux/platform_data/lp855x.h> 168c2ecf20Sopenharmony_ci#include <linux/pwm.h> 178c2ecf20Sopenharmony_ci#include <linux/regulator/consumer.h> 188c2ecf20Sopenharmony_ci 198c2ecf20Sopenharmony_ci/* LP8550/1/2/3/6 Registers */ 208c2ecf20Sopenharmony_ci#define LP855X_BRIGHTNESS_CTRL 0x00 218c2ecf20Sopenharmony_ci#define LP855X_DEVICE_CTRL 0x01 228c2ecf20Sopenharmony_ci#define LP855X_EEPROM_START 0xA0 238c2ecf20Sopenharmony_ci#define LP855X_EEPROM_END 0xA7 248c2ecf20Sopenharmony_ci#define LP8556_EPROM_START 0xA0 258c2ecf20Sopenharmony_ci#define LP8556_EPROM_END 0xAF 268c2ecf20Sopenharmony_ci 278c2ecf20Sopenharmony_ci/* LP8555/7 Registers */ 288c2ecf20Sopenharmony_ci#define LP8557_BL_CMD 0x00 298c2ecf20Sopenharmony_ci#define LP8557_BL_MASK 0x01 308c2ecf20Sopenharmony_ci#define LP8557_BL_ON 0x01 318c2ecf20Sopenharmony_ci#define LP8557_BL_OFF 0x00 328c2ecf20Sopenharmony_ci#define LP8557_BRIGHTNESS_CTRL 0x04 338c2ecf20Sopenharmony_ci#define LP8557_CONFIG 0x10 348c2ecf20Sopenharmony_ci#define LP8555_EPROM_START 0x10 358c2ecf20Sopenharmony_ci#define LP8555_EPROM_END 0x7A 368c2ecf20Sopenharmony_ci#define LP8557_EPROM_START 0x10 378c2ecf20Sopenharmony_ci#define LP8557_EPROM_END 0x1E 388c2ecf20Sopenharmony_ci 398c2ecf20Sopenharmony_ci#define DEFAULT_BL_NAME "lcd-backlight" 408c2ecf20Sopenharmony_ci#define MAX_BRIGHTNESS 255 418c2ecf20Sopenharmony_ci 428c2ecf20Sopenharmony_cienum lp855x_brightness_ctrl_mode { 438c2ecf20Sopenharmony_ci PWM_BASED = 1, 448c2ecf20Sopenharmony_ci REGISTER_BASED, 458c2ecf20Sopenharmony_ci}; 468c2ecf20Sopenharmony_ci 478c2ecf20Sopenharmony_cistruct lp855x; 488c2ecf20Sopenharmony_ci 498c2ecf20Sopenharmony_ci/* 508c2ecf20Sopenharmony_ci * struct lp855x_device_config 518c2ecf20Sopenharmony_ci * @pre_init_device: init device function call before updating the brightness 528c2ecf20Sopenharmony_ci * @reg_brightness: register address for brigthenss control 538c2ecf20Sopenharmony_ci * @reg_devicectrl: register address for device control 548c2ecf20Sopenharmony_ci * @post_init_device: late init device function call 558c2ecf20Sopenharmony_ci */ 568c2ecf20Sopenharmony_cistruct lp855x_device_config { 578c2ecf20Sopenharmony_ci int (*pre_init_device)(struct lp855x *); 588c2ecf20Sopenharmony_ci u8 reg_brightness; 598c2ecf20Sopenharmony_ci u8 reg_devicectrl; 608c2ecf20Sopenharmony_ci int (*post_init_device)(struct lp855x *); 618c2ecf20Sopenharmony_ci}; 628c2ecf20Sopenharmony_ci 638c2ecf20Sopenharmony_cistruct lp855x { 648c2ecf20Sopenharmony_ci const char *chipname; 658c2ecf20Sopenharmony_ci enum lp855x_chip_id chip_id; 668c2ecf20Sopenharmony_ci enum lp855x_brightness_ctrl_mode mode; 678c2ecf20Sopenharmony_ci struct lp855x_device_config *cfg; 688c2ecf20Sopenharmony_ci struct i2c_client *client; 698c2ecf20Sopenharmony_ci struct backlight_device *bl; 708c2ecf20Sopenharmony_ci struct device *dev; 718c2ecf20Sopenharmony_ci struct lp855x_platform_data *pdata; 728c2ecf20Sopenharmony_ci struct pwm_device *pwm; 738c2ecf20Sopenharmony_ci struct regulator *supply; /* regulator for VDD input */ 748c2ecf20Sopenharmony_ci struct regulator *enable; /* regulator for EN/VDDIO input */ 758c2ecf20Sopenharmony_ci}; 768c2ecf20Sopenharmony_ci 778c2ecf20Sopenharmony_cistatic int lp855x_write_byte(struct lp855x *lp, u8 reg, u8 data) 788c2ecf20Sopenharmony_ci{ 798c2ecf20Sopenharmony_ci return i2c_smbus_write_byte_data(lp->client, reg, data); 808c2ecf20Sopenharmony_ci} 818c2ecf20Sopenharmony_ci 828c2ecf20Sopenharmony_cistatic int lp855x_update_bit(struct lp855x *lp, u8 reg, u8 mask, u8 data) 838c2ecf20Sopenharmony_ci{ 848c2ecf20Sopenharmony_ci int ret; 858c2ecf20Sopenharmony_ci u8 tmp; 868c2ecf20Sopenharmony_ci 878c2ecf20Sopenharmony_ci ret = i2c_smbus_read_byte_data(lp->client, reg); 888c2ecf20Sopenharmony_ci if (ret < 0) { 898c2ecf20Sopenharmony_ci dev_err(lp->dev, "failed to read 0x%.2x\n", reg); 908c2ecf20Sopenharmony_ci return ret; 918c2ecf20Sopenharmony_ci } 928c2ecf20Sopenharmony_ci 938c2ecf20Sopenharmony_ci tmp = (u8)ret; 948c2ecf20Sopenharmony_ci tmp &= ~mask; 958c2ecf20Sopenharmony_ci tmp |= data & mask; 968c2ecf20Sopenharmony_ci 978c2ecf20Sopenharmony_ci return lp855x_write_byte(lp, reg, tmp); 988c2ecf20Sopenharmony_ci} 998c2ecf20Sopenharmony_ci 1008c2ecf20Sopenharmony_cistatic bool lp855x_is_valid_rom_area(struct lp855x *lp, u8 addr) 1018c2ecf20Sopenharmony_ci{ 1028c2ecf20Sopenharmony_ci u8 start, end; 1038c2ecf20Sopenharmony_ci 1048c2ecf20Sopenharmony_ci switch (lp->chip_id) { 1058c2ecf20Sopenharmony_ci case LP8550: 1068c2ecf20Sopenharmony_ci case LP8551: 1078c2ecf20Sopenharmony_ci case LP8552: 1088c2ecf20Sopenharmony_ci case LP8553: 1098c2ecf20Sopenharmony_ci start = LP855X_EEPROM_START; 1108c2ecf20Sopenharmony_ci end = LP855X_EEPROM_END; 1118c2ecf20Sopenharmony_ci break; 1128c2ecf20Sopenharmony_ci case LP8556: 1138c2ecf20Sopenharmony_ci start = LP8556_EPROM_START; 1148c2ecf20Sopenharmony_ci end = LP8556_EPROM_END; 1158c2ecf20Sopenharmony_ci break; 1168c2ecf20Sopenharmony_ci case LP8555: 1178c2ecf20Sopenharmony_ci start = LP8555_EPROM_START; 1188c2ecf20Sopenharmony_ci end = LP8555_EPROM_END; 1198c2ecf20Sopenharmony_ci break; 1208c2ecf20Sopenharmony_ci case LP8557: 1218c2ecf20Sopenharmony_ci start = LP8557_EPROM_START; 1228c2ecf20Sopenharmony_ci end = LP8557_EPROM_END; 1238c2ecf20Sopenharmony_ci break; 1248c2ecf20Sopenharmony_ci default: 1258c2ecf20Sopenharmony_ci return false; 1268c2ecf20Sopenharmony_ci } 1278c2ecf20Sopenharmony_ci 1288c2ecf20Sopenharmony_ci return addr >= start && addr <= end; 1298c2ecf20Sopenharmony_ci} 1308c2ecf20Sopenharmony_ci 1318c2ecf20Sopenharmony_cistatic int lp8557_bl_off(struct lp855x *lp) 1328c2ecf20Sopenharmony_ci{ 1338c2ecf20Sopenharmony_ci /* BL_ON = 0 before updating EPROM settings */ 1348c2ecf20Sopenharmony_ci return lp855x_update_bit(lp, LP8557_BL_CMD, LP8557_BL_MASK, 1358c2ecf20Sopenharmony_ci LP8557_BL_OFF); 1368c2ecf20Sopenharmony_ci} 1378c2ecf20Sopenharmony_ci 1388c2ecf20Sopenharmony_cistatic int lp8557_bl_on(struct lp855x *lp) 1398c2ecf20Sopenharmony_ci{ 1408c2ecf20Sopenharmony_ci /* BL_ON = 1 after updating EPROM settings */ 1418c2ecf20Sopenharmony_ci return lp855x_update_bit(lp, LP8557_BL_CMD, LP8557_BL_MASK, 1428c2ecf20Sopenharmony_ci LP8557_BL_ON); 1438c2ecf20Sopenharmony_ci} 1448c2ecf20Sopenharmony_ci 1458c2ecf20Sopenharmony_cistatic struct lp855x_device_config lp855x_dev_cfg = { 1468c2ecf20Sopenharmony_ci .reg_brightness = LP855X_BRIGHTNESS_CTRL, 1478c2ecf20Sopenharmony_ci .reg_devicectrl = LP855X_DEVICE_CTRL, 1488c2ecf20Sopenharmony_ci}; 1498c2ecf20Sopenharmony_ci 1508c2ecf20Sopenharmony_cistatic struct lp855x_device_config lp8557_dev_cfg = { 1518c2ecf20Sopenharmony_ci .reg_brightness = LP8557_BRIGHTNESS_CTRL, 1528c2ecf20Sopenharmony_ci .reg_devicectrl = LP8557_CONFIG, 1538c2ecf20Sopenharmony_ci .pre_init_device = lp8557_bl_off, 1548c2ecf20Sopenharmony_ci .post_init_device = lp8557_bl_on, 1558c2ecf20Sopenharmony_ci}; 1568c2ecf20Sopenharmony_ci 1578c2ecf20Sopenharmony_ci/* 1588c2ecf20Sopenharmony_ci * Device specific configuration flow 1598c2ecf20Sopenharmony_ci * 1608c2ecf20Sopenharmony_ci * a) pre_init_device(optional) 1618c2ecf20Sopenharmony_ci * b) update the brightness register 1628c2ecf20Sopenharmony_ci * c) update device control register 1638c2ecf20Sopenharmony_ci * d) update ROM area(optional) 1648c2ecf20Sopenharmony_ci * e) post_init_device(optional) 1658c2ecf20Sopenharmony_ci * 1668c2ecf20Sopenharmony_ci */ 1678c2ecf20Sopenharmony_cistatic int lp855x_configure(struct lp855x *lp) 1688c2ecf20Sopenharmony_ci{ 1698c2ecf20Sopenharmony_ci u8 val, addr; 1708c2ecf20Sopenharmony_ci int i, ret; 1718c2ecf20Sopenharmony_ci struct lp855x_platform_data *pd = lp->pdata; 1728c2ecf20Sopenharmony_ci 1738c2ecf20Sopenharmony_ci switch (lp->chip_id) { 1748c2ecf20Sopenharmony_ci case LP8550: 1758c2ecf20Sopenharmony_ci case LP8551: 1768c2ecf20Sopenharmony_ci case LP8552: 1778c2ecf20Sopenharmony_ci case LP8553: 1788c2ecf20Sopenharmony_ci case LP8556: 1798c2ecf20Sopenharmony_ci lp->cfg = &lp855x_dev_cfg; 1808c2ecf20Sopenharmony_ci break; 1818c2ecf20Sopenharmony_ci case LP8555: 1828c2ecf20Sopenharmony_ci case LP8557: 1838c2ecf20Sopenharmony_ci lp->cfg = &lp8557_dev_cfg; 1848c2ecf20Sopenharmony_ci break; 1858c2ecf20Sopenharmony_ci default: 1868c2ecf20Sopenharmony_ci return -EINVAL; 1878c2ecf20Sopenharmony_ci } 1888c2ecf20Sopenharmony_ci 1898c2ecf20Sopenharmony_ci if (lp->cfg->pre_init_device) { 1908c2ecf20Sopenharmony_ci ret = lp->cfg->pre_init_device(lp); 1918c2ecf20Sopenharmony_ci if (ret) { 1928c2ecf20Sopenharmony_ci dev_err(lp->dev, "pre init device err: %d\n", ret); 1938c2ecf20Sopenharmony_ci goto err; 1948c2ecf20Sopenharmony_ci } 1958c2ecf20Sopenharmony_ci } 1968c2ecf20Sopenharmony_ci 1978c2ecf20Sopenharmony_ci val = pd->initial_brightness; 1988c2ecf20Sopenharmony_ci ret = lp855x_write_byte(lp, lp->cfg->reg_brightness, val); 1998c2ecf20Sopenharmony_ci if (ret) 2008c2ecf20Sopenharmony_ci goto err; 2018c2ecf20Sopenharmony_ci 2028c2ecf20Sopenharmony_ci val = pd->device_control; 2038c2ecf20Sopenharmony_ci ret = lp855x_write_byte(lp, lp->cfg->reg_devicectrl, val); 2048c2ecf20Sopenharmony_ci if (ret) 2058c2ecf20Sopenharmony_ci goto err; 2068c2ecf20Sopenharmony_ci 2078c2ecf20Sopenharmony_ci if (pd->size_program > 0) { 2088c2ecf20Sopenharmony_ci for (i = 0; i < pd->size_program; i++) { 2098c2ecf20Sopenharmony_ci addr = pd->rom_data[i].addr; 2108c2ecf20Sopenharmony_ci val = pd->rom_data[i].val; 2118c2ecf20Sopenharmony_ci if (!lp855x_is_valid_rom_area(lp, addr)) 2128c2ecf20Sopenharmony_ci continue; 2138c2ecf20Sopenharmony_ci 2148c2ecf20Sopenharmony_ci ret = lp855x_write_byte(lp, addr, val); 2158c2ecf20Sopenharmony_ci if (ret) 2168c2ecf20Sopenharmony_ci goto err; 2178c2ecf20Sopenharmony_ci } 2188c2ecf20Sopenharmony_ci } 2198c2ecf20Sopenharmony_ci 2208c2ecf20Sopenharmony_ci if (lp->cfg->post_init_device) { 2218c2ecf20Sopenharmony_ci ret = lp->cfg->post_init_device(lp); 2228c2ecf20Sopenharmony_ci if (ret) { 2238c2ecf20Sopenharmony_ci dev_err(lp->dev, "post init device err: %d\n", ret); 2248c2ecf20Sopenharmony_ci goto err; 2258c2ecf20Sopenharmony_ci } 2268c2ecf20Sopenharmony_ci } 2278c2ecf20Sopenharmony_ci 2288c2ecf20Sopenharmony_ci return 0; 2298c2ecf20Sopenharmony_ci 2308c2ecf20Sopenharmony_cierr: 2318c2ecf20Sopenharmony_ci return ret; 2328c2ecf20Sopenharmony_ci} 2338c2ecf20Sopenharmony_ci 2348c2ecf20Sopenharmony_cistatic void lp855x_pwm_ctrl(struct lp855x *lp, int br, int max_br) 2358c2ecf20Sopenharmony_ci{ 2368c2ecf20Sopenharmony_ci unsigned int period = lp->pdata->period_ns; 2378c2ecf20Sopenharmony_ci unsigned int duty = br * period / max_br; 2388c2ecf20Sopenharmony_ci struct pwm_device *pwm; 2398c2ecf20Sopenharmony_ci 2408c2ecf20Sopenharmony_ci /* request pwm device with the consumer name */ 2418c2ecf20Sopenharmony_ci if (!lp->pwm) { 2428c2ecf20Sopenharmony_ci pwm = devm_pwm_get(lp->dev, lp->chipname); 2438c2ecf20Sopenharmony_ci if (IS_ERR(pwm)) 2448c2ecf20Sopenharmony_ci return; 2458c2ecf20Sopenharmony_ci 2468c2ecf20Sopenharmony_ci lp->pwm = pwm; 2478c2ecf20Sopenharmony_ci 2488c2ecf20Sopenharmony_ci /* 2498c2ecf20Sopenharmony_ci * FIXME: pwm_apply_args() should be removed when switching to 2508c2ecf20Sopenharmony_ci * the atomic PWM API. 2518c2ecf20Sopenharmony_ci */ 2528c2ecf20Sopenharmony_ci pwm_apply_args(pwm); 2538c2ecf20Sopenharmony_ci } 2548c2ecf20Sopenharmony_ci 2558c2ecf20Sopenharmony_ci pwm_config(lp->pwm, duty, period); 2568c2ecf20Sopenharmony_ci if (duty) 2578c2ecf20Sopenharmony_ci pwm_enable(lp->pwm); 2588c2ecf20Sopenharmony_ci else 2598c2ecf20Sopenharmony_ci pwm_disable(lp->pwm); 2608c2ecf20Sopenharmony_ci} 2618c2ecf20Sopenharmony_ci 2628c2ecf20Sopenharmony_cistatic int lp855x_bl_update_status(struct backlight_device *bl) 2638c2ecf20Sopenharmony_ci{ 2648c2ecf20Sopenharmony_ci struct lp855x *lp = bl_get_data(bl); 2658c2ecf20Sopenharmony_ci int brightness = bl->props.brightness; 2668c2ecf20Sopenharmony_ci 2678c2ecf20Sopenharmony_ci if (bl->props.state & (BL_CORE_SUSPENDED | BL_CORE_FBBLANK)) 2688c2ecf20Sopenharmony_ci brightness = 0; 2698c2ecf20Sopenharmony_ci 2708c2ecf20Sopenharmony_ci if (lp->mode == PWM_BASED) 2718c2ecf20Sopenharmony_ci lp855x_pwm_ctrl(lp, brightness, bl->props.max_brightness); 2728c2ecf20Sopenharmony_ci else if (lp->mode == REGISTER_BASED) 2738c2ecf20Sopenharmony_ci lp855x_write_byte(lp, lp->cfg->reg_brightness, (u8)brightness); 2748c2ecf20Sopenharmony_ci 2758c2ecf20Sopenharmony_ci return 0; 2768c2ecf20Sopenharmony_ci} 2778c2ecf20Sopenharmony_ci 2788c2ecf20Sopenharmony_cistatic const struct backlight_ops lp855x_bl_ops = { 2798c2ecf20Sopenharmony_ci .options = BL_CORE_SUSPENDRESUME, 2808c2ecf20Sopenharmony_ci .update_status = lp855x_bl_update_status, 2818c2ecf20Sopenharmony_ci}; 2828c2ecf20Sopenharmony_ci 2838c2ecf20Sopenharmony_cistatic int lp855x_backlight_register(struct lp855x *lp) 2848c2ecf20Sopenharmony_ci{ 2858c2ecf20Sopenharmony_ci struct backlight_device *bl; 2868c2ecf20Sopenharmony_ci struct backlight_properties props; 2878c2ecf20Sopenharmony_ci struct lp855x_platform_data *pdata = lp->pdata; 2888c2ecf20Sopenharmony_ci const char *name = pdata->name ? : DEFAULT_BL_NAME; 2898c2ecf20Sopenharmony_ci 2908c2ecf20Sopenharmony_ci memset(&props, 0, sizeof(props)); 2918c2ecf20Sopenharmony_ci props.type = BACKLIGHT_PLATFORM; 2928c2ecf20Sopenharmony_ci props.max_brightness = MAX_BRIGHTNESS; 2938c2ecf20Sopenharmony_ci 2948c2ecf20Sopenharmony_ci if (pdata->initial_brightness > props.max_brightness) 2958c2ecf20Sopenharmony_ci pdata->initial_brightness = props.max_brightness; 2968c2ecf20Sopenharmony_ci 2978c2ecf20Sopenharmony_ci props.brightness = pdata->initial_brightness; 2988c2ecf20Sopenharmony_ci 2998c2ecf20Sopenharmony_ci bl = devm_backlight_device_register(lp->dev, name, lp->dev, lp, 3008c2ecf20Sopenharmony_ci &lp855x_bl_ops, &props); 3018c2ecf20Sopenharmony_ci if (IS_ERR(bl)) 3028c2ecf20Sopenharmony_ci return PTR_ERR(bl); 3038c2ecf20Sopenharmony_ci 3048c2ecf20Sopenharmony_ci lp->bl = bl; 3058c2ecf20Sopenharmony_ci 3068c2ecf20Sopenharmony_ci return 0; 3078c2ecf20Sopenharmony_ci} 3088c2ecf20Sopenharmony_ci 3098c2ecf20Sopenharmony_cistatic ssize_t lp855x_get_chip_id(struct device *dev, 3108c2ecf20Sopenharmony_ci struct device_attribute *attr, char *buf) 3118c2ecf20Sopenharmony_ci{ 3128c2ecf20Sopenharmony_ci struct lp855x *lp = dev_get_drvdata(dev); 3138c2ecf20Sopenharmony_ci 3148c2ecf20Sopenharmony_ci return scnprintf(buf, PAGE_SIZE, "%s\n", lp->chipname); 3158c2ecf20Sopenharmony_ci} 3168c2ecf20Sopenharmony_ci 3178c2ecf20Sopenharmony_cistatic ssize_t lp855x_get_bl_ctl_mode(struct device *dev, 3188c2ecf20Sopenharmony_ci struct device_attribute *attr, char *buf) 3198c2ecf20Sopenharmony_ci{ 3208c2ecf20Sopenharmony_ci struct lp855x *lp = dev_get_drvdata(dev); 3218c2ecf20Sopenharmony_ci char *strmode = NULL; 3228c2ecf20Sopenharmony_ci 3238c2ecf20Sopenharmony_ci if (lp->mode == PWM_BASED) 3248c2ecf20Sopenharmony_ci strmode = "pwm based"; 3258c2ecf20Sopenharmony_ci else if (lp->mode == REGISTER_BASED) 3268c2ecf20Sopenharmony_ci strmode = "register based"; 3278c2ecf20Sopenharmony_ci 3288c2ecf20Sopenharmony_ci return scnprintf(buf, PAGE_SIZE, "%s\n", strmode); 3298c2ecf20Sopenharmony_ci} 3308c2ecf20Sopenharmony_ci 3318c2ecf20Sopenharmony_cistatic DEVICE_ATTR(chip_id, S_IRUGO, lp855x_get_chip_id, NULL); 3328c2ecf20Sopenharmony_cistatic DEVICE_ATTR(bl_ctl_mode, S_IRUGO, lp855x_get_bl_ctl_mode, NULL); 3338c2ecf20Sopenharmony_ci 3348c2ecf20Sopenharmony_cistatic struct attribute *lp855x_attributes[] = { 3358c2ecf20Sopenharmony_ci &dev_attr_chip_id.attr, 3368c2ecf20Sopenharmony_ci &dev_attr_bl_ctl_mode.attr, 3378c2ecf20Sopenharmony_ci NULL, 3388c2ecf20Sopenharmony_ci}; 3398c2ecf20Sopenharmony_ci 3408c2ecf20Sopenharmony_cistatic const struct attribute_group lp855x_attr_group = { 3418c2ecf20Sopenharmony_ci .attrs = lp855x_attributes, 3428c2ecf20Sopenharmony_ci}; 3438c2ecf20Sopenharmony_ci 3448c2ecf20Sopenharmony_ci#ifdef CONFIG_OF 3458c2ecf20Sopenharmony_cistatic int lp855x_parse_dt(struct lp855x *lp) 3468c2ecf20Sopenharmony_ci{ 3478c2ecf20Sopenharmony_ci struct device *dev = lp->dev; 3488c2ecf20Sopenharmony_ci struct device_node *node = dev->of_node; 3498c2ecf20Sopenharmony_ci struct lp855x_platform_data *pdata; 3508c2ecf20Sopenharmony_ci int rom_length; 3518c2ecf20Sopenharmony_ci 3528c2ecf20Sopenharmony_ci if (!node) { 3538c2ecf20Sopenharmony_ci dev_err(dev, "no platform data\n"); 3548c2ecf20Sopenharmony_ci return -EINVAL; 3558c2ecf20Sopenharmony_ci } 3568c2ecf20Sopenharmony_ci 3578c2ecf20Sopenharmony_ci pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL); 3588c2ecf20Sopenharmony_ci if (!pdata) 3598c2ecf20Sopenharmony_ci return -ENOMEM; 3608c2ecf20Sopenharmony_ci 3618c2ecf20Sopenharmony_ci of_property_read_string(node, "bl-name", &pdata->name); 3628c2ecf20Sopenharmony_ci of_property_read_u8(node, "dev-ctrl", &pdata->device_control); 3638c2ecf20Sopenharmony_ci of_property_read_u8(node, "init-brt", &pdata->initial_brightness); 3648c2ecf20Sopenharmony_ci of_property_read_u32(node, "pwm-period", &pdata->period_ns); 3658c2ecf20Sopenharmony_ci 3668c2ecf20Sopenharmony_ci /* Fill ROM platform data if defined */ 3678c2ecf20Sopenharmony_ci rom_length = of_get_child_count(node); 3688c2ecf20Sopenharmony_ci if (rom_length > 0) { 3698c2ecf20Sopenharmony_ci struct lp855x_rom_data *rom; 3708c2ecf20Sopenharmony_ci struct device_node *child; 3718c2ecf20Sopenharmony_ci int i = 0; 3728c2ecf20Sopenharmony_ci 3738c2ecf20Sopenharmony_ci rom = devm_kcalloc(dev, rom_length, sizeof(*rom), GFP_KERNEL); 3748c2ecf20Sopenharmony_ci if (!rom) 3758c2ecf20Sopenharmony_ci return -ENOMEM; 3768c2ecf20Sopenharmony_ci 3778c2ecf20Sopenharmony_ci for_each_child_of_node(node, child) { 3788c2ecf20Sopenharmony_ci of_property_read_u8(child, "rom-addr", &rom[i].addr); 3798c2ecf20Sopenharmony_ci of_property_read_u8(child, "rom-val", &rom[i].val); 3808c2ecf20Sopenharmony_ci i++; 3818c2ecf20Sopenharmony_ci } 3828c2ecf20Sopenharmony_ci 3838c2ecf20Sopenharmony_ci pdata->size_program = rom_length; 3848c2ecf20Sopenharmony_ci pdata->rom_data = &rom[0]; 3858c2ecf20Sopenharmony_ci } 3868c2ecf20Sopenharmony_ci 3878c2ecf20Sopenharmony_ci lp->pdata = pdata; 3888c2ecf20Sopenharmony_ci 3898c2ecf20Sopenharmony_ci return 0; 3908c2ecf20Sopenharmony_ci} 3918c2ecf20Sopenharmony_ci#else 3928c2ecf20Sopenharmony_cistatic int lp855x_parse_dt(struct lp855x *lp) 3938c2ecf20Sopenharmony_ci{ 3948c2ecf20Sopenharmony_ci return -EINVAL; 3958c2ecf20Sopenharmony_ci} 3968c2ecf20Sopenharmony_ci#endif 3978c2ecf20Sopenharmony_ci 3988c2ecf20Sopenharmony_cistatic int lp855x_probe(struct i2c_client *cl, const struct i2c_device_id *id) 3998c2ecf20Sopenharmony_ci{ 4008c2ecf20Sopenharmony_ci struct lp855x *lp; 4018c2ecf20Sopenharmony_ci int ret; 4028c2ecf20Sopenharmony_ci 4038c2ecf20Sopenharmony_ci if (!i2c_check_functionality(cl->adapter, I2C_FUNC_SMBUS_I2C_BLOCK)) 4048c2ecf20Sopenharmony_ci return -EIO; 4058c2ecf20Sopenharmony_ci 4068c2ecf20Sopenharmony_ci lp = devm_kzalloc(&cl->dev, sizeof(struct lp855x), GFP_KERNEL); 4078c2ecf20Sopenharmony_ci if (!lp) 4088c2ecf20Sopenharmony_ci return -ENOMEM; 4098c2ecf20Sopenharmony_ci 4108c2ecf20Sopenharmony_ci lp->client = cl; 4118c2ecf20Sopenharmony_ci lp->dev = &cl->dev; 4128c2ecf20Sopenharmony_ci lp->chipname = id->name; 4138c2ecf20Sopenharmony_ci lp->chip_id = id->driver_data; 4148c2ecf20Sopenharmony_ci lp->pdata = dev_get_platdata(&cl->dev); 4158c2ecf20Sopenharmony_ci 4168c2ecf20Sopenharmony_ci if (!lp->pdata) { 4178c2ecf20Sopenharmony_ci ret = lp855x_parse_dt(lp); 4188c2ecf20Sopenharmony_ci if (ret < 0) 4198c2ecf20Sopenharmony_ci return ret; 4208c2ecf20Sopenharmony_ci } 4218c2ecf20Sopenharmony_ci 4228c2ecf20Sopenharmony_ci if (lp->pdata->period_ns > 0) 4238c2ecf20Sopenharmony_ci lp->mode = PWM_BASED; 4248c2ecf20Sopenharmony_ci else 4258c2ecf20Sopenharmony_ci lp->mode = REGISTER_BASED; 4268c2ecf20Sopenharmony_ci 4278c2ecf20Sopenharmony_ci lp->supply = devm_regulator_get(lp->dev, "power"); 4288c2ecf20Sopenharmony_ci if (IS_ERR(lp->supply)) { 4298c2ecf20Sopenharmony_ci if (PTR_ERR(lp->supply) == -EPROBE_DEFER) 4308c2ecf20Sopenharmony_ci return -EPROBE_DEFER; 4318c2ecf20Sopenharmony_ci lp->supply = NULL; 4328c2ecf20Sopenharmony_ci } 4338c2ecf20Sopenharmony_ci 4348c2ecf20Sopenharmony_ci lp->enable = devm_regulator_get_optional(lp->dev, "enable"); 4358c2ecf20Sopenharmony_ci if (IS_ERR(lp->enable)) { 4368c2ecf20Sopenharmony_ci ret = PTR_ERR(lp->enable); 4378c2ecf20Sopenharmony_ci if (ret == -ENODEV) { 4388c2ecf20Sopenharmony_ci lp->enable = NULL; 4398c2ecf20Sopenharmony_ci } else { 4408c2ecf20Sopenharmony_ci if (ret != -EPROBE_DEFER) 4418c2ecf20Sopenharmony_ci dev_err(lp->dev, "error getting enable regulator: %d\n", 4428c2ecf20Sopenharmony_ci ret); 4438c2ecf20Sopenharmony_ci return ret; 4448c2ecf20Sopenharmony_ci } 4458c2ecf20Sopenharmony_ci } 4468c2ecf20Sopenharmony_ci 4478c2ecf20Sopenharmony_ci if (lp->supply) { 4488c2ecf20Sopenharmony_ci ret = regulator_enable(lp->supply); 4498c2ecf20Sopenharmony_ci if (ret < 0) { 4508c2ecf20Sopenharmony_ci dev_err(&cl->dev, "failed to enable supply: %d\n", ret); 4518c2ecf20Sopenharmony_ci return ret; 4528c2ecf20Sopenharmony_ci } 4538c2ecf20Sopenharmony_ci } 4548c2ecf20Sopenharmony_ci 4558c2ecf20Sopenharmony_ci if (lp->enable) { 4568c2ecf20Sopenharmony_ci ret = regulator_enable(lp->enable); 4578c2ecf20Sopenharmony_ci if (ret < 0) { 4588c2ecf20Sopenharmony_ci dev_err(lp->dev, "failed to enable vddio: %d\n", ret); 4598c2ecf20Sopenharmony_ci goto disable_supply; 4608c2ecf20Sopenharmony_ci } 4618c2ecf20Sopenharmony_ci 4628c2ecf20Sopenharmony_ci /* 4638c2ecf20Sopenharmony_ci * LP8555 datasheet says t_RESPONSE (time between VDDIO and 4648c2ecf20Sopenharmony_ci * I2C) is 1ms. 4658c2ecf20Sopenharmony_ci */ 4668c2ecf20Sopenharmony_ci usleep_range(1000, 2000); 4678c2ecf20Sopenharmony_ci } 4688c2ecf20Sopenharmony_ci 4698c2ecf20Sopenharmony_ci i2c_set_clientdata(cl, lp); 4708c2ecf20Sopenharmony_ci 4718c2ecf20Sopenharmony_ci ret = lp855x_configure(lp); 4728c2ecf20Sopenharmony_ci if (ret) { 4738c2ecf20Sopenharmony_ci dev_err(lp->dev, "device config err: %d", ret); 4748c2ecf20Sopenharmony_ci goto disable_vddio; 4758c2ecf20Sopenharmony_ci } 4768c2ecf20Sopenharmony_ci 4778c2ecf20Sopenharmony_ci ret = lp855x_backlight_register(lp); 4788c2ecf20Sopenharmony_ci if (ret) { 4798c2ecf20Sopenharmony_ci dev_err(lp->dev, 4808c2ecf20Sopenharmony_ci "failed to register backlight. err: %d\n", ret); 4818c2ecf20Sopenharmony_ci goto disable_vddio; 4828c2ecf20Sopenharmony_ci } 4838c2ecf20Sopenharmony_ci 4848c2ecf20Sopenharmony_ci ret = sysfs_create_group(&lp->dev->kobj, &lp855x_attr_group); 4858c2ecf20Sopenharmony_ci if (ret) { 4868c2ecf20Sopenharmony_ci dev_err(lp->dev, "failed to register sysfs. err: %d\n", ret); 4878c2ecf20Sopenharmony_ci goto disable_vddio; 4888c2ecf20Sopenharmony_ci } 4898c2ecf20Sopenharmony_ci 4908c2ecf20Sopenharmony_ci backlight_update_status(lp->bl); 4918c2ecf20Sopenharmony_ci 4928c2ecf20Sopenharmony_ci return 0; 4938c2ecf20Sopenharmony_ci 4948c2ecf20Sopenharmony_cidisable_vddio: 4958c2ecf20Sopenharmony_ci if (lp->enable) 4968c2ecf20Sopenharmony_ci regulator_disable(lp->enable); 4978c2ecf20Sopenharmony_cidisable_supply: 4988c2ecf20Sopenharmony_ci if (lp->supply) 4998c2ecf20Sopenharmony_ci regulator_disable(lp->supply); 5008c2ecf20Sopenharmony_ci 5018c2ecf20Sopenharmony_ci return ret; 5028c2ecf20Sopenharmony_ci} 5038c2ecf20Sopenharmony_ci 5048c2ecf20Sopenharmony_cistatic int lp855x_remove(struct i2c_client *cl) 5058c2ecf20Sopenharmony_ci{ 5068c2ecf20Sopenharmony_ci struct lp855x *lp = i2c_get_clientdata(cl); 5078c2ecf20Sopenharmony_ci 5088c2ecf20Sopenharmony_ci lp->bl->props.brightness = 0; 5098c2ecf20Sopenharmony_ci backlight_update_status(lp->bl); 5108c2ecf20Sopenharmony_ci if (lp->enable) 5118c2ecf20Sopenharmony_ci regulator_disable(lp->enable); 5128c2ecf20Sopenharmony_ci if (lp->supply) 5138c2ecf20Sopenharmony_ci regulator_disable(lp->supply); 5148c2ecf20Sopenharmony_ci sysfs_remove_group(&lp->dev->kobj, &lp855x_attr_group); 5158c2ecf20Sopenharmony_ci 5168c2ecf20Sopenharmony_ci return 0; 5178c2ecf20Sopenharmony_ci} 5188c2ecf20Sopenharmony_ci 5198c2ecf20Sopenharmony_cistatic const struct of_device_id lp855x_dt_ids[] = { 5208c2ecf20Sopenharmony_ci { .compatible = "ti,lp8550", }, 5218c2ecf20Sopenharmony_ci { .compatible = "ti,lp8551", }, 5228c2ecf20Sopenharmony_ci { .compatible = "ti,lp8552", }, 5238c2ecf20Sopenharmony_ci { .compatible = "ti,lp8553", }, 5248c2ecf20Sopenharmony_ci { .compatible = "ti,lp8555", }, 5258c2ecf20Sopenharmony_ci { .compatible = "ti,lp8556", }, 5268c2ecf20Sopenharmony_ci { .compatible = "ti,lp8557", }, 5278c2ecf20Sopenharmony_ci { } 5288c2ecf20Sopenharmony_ci}; 5298c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(of, lp855x_dt_ids); 5308c2ecf20Sopenharmony_ci 5318c2ecf20Sopenharmony_cistatic const struct i2c_device_id lp855x_ids[] = { 5328c2ecf20Sopenharmony_ci {"lp8550", LP8550}, 5338c2ecf20Sopenharmony_ci {"lp8551", LP8551}, 5348c2ecf20Sopenharmony_ci {"lp8552", LP8552}, 5358c2ecf20Sopenharmony_ci {"lp8553", LP8553}, 5368c2ecf20Sopenharmony_ci {"lp8555", LP8555}, 5378c2ecf20Sopenharmony_ci {"lp8556", LP8556}, 5388c2ecf20Sopenharmony_ci {"lp8557", LP8557}, 5398c2ecf20Sopenharmony_ci { } 5408c2ecf20Sopenharmony_ci}; 5418c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(i2c, lp855x_ids); 5428c2ecf20Sopenharmony_ci 5438c2ecf20Sopenharmony_cistatic struct i2c_driver lp855x_driver = { 5448c2ecf20Sopenharmony_ci .driver = { 5458c2ecf20Sopenharmony_ci .name = "lp855x", 5468c2ecf20Sopenharmony_ci .of_match_table = of_match_ptr(lp855x_dt_ids), 5478c2ecf20Sopenharmony_ci }, 5488c2ecf20Sopenharmony_ci .probe = lp855x_probe, 5498c2ecf20Sopenharmony_ci .remove = lp855x_remove, 5508c2ecf20Sopenharmony_ci .id_table = lp855x_ids, 5518c2ecf20Sopenharmony_ci}; 5528c2ecf20Sopenharmony_ci 5538c2ecf20Sopenharmony_cimodule_i2c_driver(lp855x_driver); 5548c2ecf20Sopenharmony_ci 5558c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("Texas Instruments LP855x Backlight driver"); 5568c2ecf20Sopenharmony_ciMODULE_AUTHOR("Milo Kim <milo.kim@ti.com>"); 5578c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL"); 558