1b1e6b706SShreshtha Kumar Sahu /* 2b1e6b706SShreshtha Kumar Sahu * Copyright (C) 2011 ST-Ericsson SA. 3b1e6b706SShreshtha Kumar Sahu * Copyright (C) 2009 Motorola, Inc. 4b1e6b706SShreshtha Kumar Sahu * 5b1e6b706SShreshtha Kumar Sahu * License Terms: GNU General Public License v2 6b1e6b706SShreshtha Kumar Sahu * 7b1e6b706SShreshtha Kumar Sahu * Simple driver for National Semiconductor LM3530 Backlight driver chip 8b1e6b706SShreshtha Kumar Sahu * 9b1e6b706SShreshtha Kumar Sahu * Author: Shreshtha Kumar SAHU <shreshthakumar.sahu@stericsson.com> 10b1e6b706SShreshtha Kumar Sahu * based on leds-lm3530.c by Dan Murphy <D.Murphy@motorola.com> 11b1e6b706SShreshtha Kumar Sahu */ 12b1e6b706SShreshtha Kumar Sahu 13b1e6b706SShreshtha Kumar Sahu #include <linux/i2c.h> 14b1e6b706SShreshtha Kumar Sahu #include <linux/leds.h> 15b1e6b706SShreshtha Kumar Sahu #include <linux/slab.h> 16b1e6b706SShreshtha Kumar Sahu #include <linux/platform_device.h> 17b1e6b706SShreshtha Kumar Sahu #include <linux/input.h> 18b1e6b706SShreshtha Kumar Sahu #include <linux/led-lm3530.h> 19b1e6b706SShreshtha Kumar Sahu #include <linux/types.h> 20b1e6b706SShreshtha Kumar Sahu 21b1e6b706SShreshtha Kumar Sahu #define LM3530_LED_DEV "lcd-backlight" 22b1e6b706SShreshtha Kumar Sahu #define LM3530_NAME "lm3530-led" 23b1e6b706SShreshtha Kumar Sahu 24b1e6b706SShreshtha Kumar Sahu #define LM3530_GEN_CONFIG 0x10 25b1e6b706SShreshtha Kumar Sahu #define LM3530_ALS_CONFIG 0x20 26b1e6b706SShreshtha Kumar Sahu #define LM3530_BRT_RAMP_RATE 0x30 27b1e6b706SShreshtha Kumar Sahu #define LM3530_ALS_ZONE_REG 0x40 28b1e6b706SShreshtha Kumar Sahu #define LM3530_ALS_IMP_SELECT 0x41 29b1e6b706SShreshtha Kumar Sahu #define LM3530_BRT_CTRL_REG 0xA0 30b1e6b706SShreshtha Kumar Sahu #define LM3530_ALS_ZB0_REG 0x60 31b1e6b706SShreshtha Kumar Sahu #define LM3530_ALS_ZB1_REG 0x61 32b1e6b706SShreshtha Kumar Sahu #define LM3530_ALS_ZB2_REG 0x62 33b1e6b706SShreshtha Kumar Sahu #define LM3530_ALS_ZB3_REG 0x63 34b1e6b706SShreshtha Kumar Sahu #define LM3530_ALS_Z0T_REG 0x70 35b1e6b706SShreshtha Kumar Sahu #define LM3530_ALS_Z1T_REG 0x71 36b1e6b706SShreshtha Kumar Sahu #define LM3530_ALS_Z2T_REG 0x72 37b1e6b706SShreshtha Kumar Sahu #define LM3530_ALS_Z3T_REG 0x73 38b1e6b706SShreshtha Kumar Sahu #define LM3530_ALS_Z4T_REG 0x74 39b1e6b706SShreshtha Kumar Sahu #define LM3530_REG_MAX 15 40b1e6b706SShreshtha Kumar Sahu 41b1e6b706SShreshtha Kumar Sahu /* General Control Register */ 42b1e6b706SShreshtha Kumar Sahu #define LM3530_EN_I2C_SHIFT (0) 43b1e6b706SShreshtha Kumar Sahu #define LM3530_RAMP_LAW_SHIFT (1) 44b1e6b706SShreshtha Kumar Sahu #define LM3530_MAX_CURR_SHIFT (2) 45b1e6b706SShreshtha Kumar Sahu #define LM3530_EN_PWM_SHIFT (5) 46b1e6b706SShreshtha Kumar Sahu #define LM3530_PWM_POL_SHIFT (6) 47b1e6b706SShreshtha Kumar Sahu #define LM3530_EN_PWM_SIMPLE_SHIFT (7) 48b1e6b706SShreshtha Kumar Sahu 49b1e6b706SShreshtha Kumar Sahu #define LM3530_ENABLE_I2C (1 << LM3530_EN_I2C_SHIFT) 50b1e6b706SShreshtha Kumar Sahu #define LM3530_ENABLE_PWM (1 << LM3530_EN_PWM_SHIFT) 51b1e6b706SShreshtha Kumar Sahu #define LM3530_POL_LOW (1 << LM3530_PWM_POL_SHIFT) 52b1e6b706SShreshtha Kumar Sahu #define LM3530_ENABLE_PWM_SIMPLE (1 << LM3530_EN_PWM_SIMPLE_SHIFT) 53b1e6b706SShreshtha Kumar Sahu 54b1e6b706SShreshtha Kumar Sahu /* ALS Config Register Options */ 55b1e6b706SShreshtha Kumar Sahu #define LM3530_ALS_AVG_TIME_SHIFT (0) 56b1e6b706SShreshtha Kumar Sahu #define LM3530_EN_ALS_SHIFT (3) 57b1e6b706SShreshtha Kumar Sahu #define LM3530_ALS_SEL_SHIFT (5) 58b1e6b706SShreshtha Kumar Sahu 59b1e6b706SShreshtha Kumar Sahu #define LM3530_ENABLE_ALS (3 << LM3530_EN_ALS_SHIFT) 60b1e6b706SShreshtha Kumar Sahu 61b1e6b706SShreshtha Kumar Sahu /* Brightness Ramp Rate Register */ 62b1e6b706SShreshtha Kumar Sahu #define LM3530_BRT_RAMP_FALL_SHIFT (0) 63b1e6b706SShreshtha Kumar Sahu #define LM3530_BRT_RAMP_RISE_SHIFT (3) 64b1e6b706SShreshtha Kumar Sahu 65b1e6b706SShreshtha Kumar Sahu /* ALS Resistor Select */ 66b1e6b706SShreshtha Kumar Sahu #define LM3530_ALS1_IMP_SHIFT (0) 67b1e6b706SShreshtha Kumar Sahu #define LM3530_ALS2_IMP_SHIFT (4) 68b1e6b706SShreshtha Kumar Sahu 69b1e6b706SShreshtha Kumar Sahu /* Zone Boundary Register defaults */ 70b1e6b706SShreshtha Kumar Sahu #define LM3530_DEF_ZB_0 (0x33) 71b1e6b706SShreshtha Kumar Sahu #define LM3530_DEF_ZB_1 (0x66) 72b1e6b706SShreshtha Kumar Sahu #define LM3530_DEF_ZB_2 (0x99) 73b1e6b706SShreshtha Kumar Sahu #define LM3530_DEF_ZB_3 (0xCC) 74b1e6b706SShreshtha Kumar Sahu 75b1e6b706SShreshtha Kumar Sahu /* Zone Target Register defaults */ 76b1e6b706SShreshtha Kumar Sahu #define LM3530_DEF_ZT_0 (0x19) 77b1e6b706SShreshtha Kumar Sahu #define LM3530_DEF_ZT_1 (0x33) 78b1e6b706SShreshtha Kumar Sahu #define LM3530_DEF_ZT_2 (0x4C) 79b1e6b706SShreshtha Kumar Sahu #define LM3530_DEF_ZT_3 (0x66) 80b1e6b706SShreshtha Kumar Sahu #define LM3530_DEF_ZT_4 (0x7F) 81b1e6b706SShreshtha Kumar Sahu 82b1e6b706SShreshtha Kumar Sahu struct lm3530_mode_map { 83b1e6b706SShreshtha Kumar Sahu const char *mode; 84b1e6b706SShreshtha Kumar Sahu enum lm3530_mode mode_val; 85b1e6b706SShreshtha Kumar Sahu }; 86b1e6b706SShreshtha Kumar Sahu 87b1e6b706SShreshtha Kumar Sahu static struct lm3530_mode_map mode_map[] = { 88b1e6b706SShreshtha Kumar Sahu { "man", LM3530_BL_MODE_MANUAL }, 89b1e6b706SShreshtha Kumar Sahu { "als", LM3530_BL_MODE_ALS }, 90b1e6b706SShreshtha Kumar Sahu { "pwm", LM3530_BL_MODE_PWM }, 91b1e6b706SShreshtha Kumar Sahu }; 92b1e6b706SShreshtha Kumar Sahu 93b1e6b706SShreshtha Kumar Sahu /** 94b1e6b706SShreshtha Kumar Sahu * struct lm3530_data 95b1e6b706SShreshtha Kumar Sahu * @led_dev: led class device 96b1e6b706SShreshtha Kumar Sahu * @client: i2c client 97b1e6b706SShreshtha Kumar Sahu * @pdata: LM3530 platform data 98b1e6b706SShreshtha Kumar Sahu * @mode: mode of operation - manual, ALS, PWM 99b1e6b706SShreshtha Kumar Sahu */ 100b1e6b706SShreshtha Kumar Sahu struct lm3530_data { 101b1e6b706SShreshtha Kumar Sahu struct led_classdev led_dev; 102b1e6b706SShreshtha Kumar Sahu struct i2c_client *client; 103b1e6b706SShreshtha Kumar Sahu struct lm3530_platform_data *pdata; 104b1e6b706SShreshtha Kumar Sahu enum lm3530_mode mode; 105b1e6b706SShreshtha Kumar Sahu }; 106b1e6b706SShreshtha Kumar Sahu 107b1e6b706SShreshtha Kumar Sahu static const u8 lm3530_reg[LM3530_REG_MAX] = { 108b1e6b706SShreshtha Kumar Sahu LM3530_GEN_CONFIG, 109b1e6b706SShreshtha Kumar Sahu LM3530_ALS_CONFIG, 110b1e6b706SShreshtha Kumar Sahu LM3530_BRT_RAMP_RATE, 111b1e6b706SShreshtha Kumar Sahu LM3530_ALS_ZONE_REG, 112b1e6b706SShreshtha Kumar Sahu LM3530_ALS_IMP_SELECT, 113b1e6b706SShreshtha Kumar Sahu LM3530_BRT_CTRL_REG, 114b1e6b706SShreshtha Kumar Sahu LM3530_ALS_ZB0_REG, 115b1e6b706SShreshtha Kumar Sahu LM3530_ALS_ZB1_REG, 116b1e6b706SShreshtha Kumar Sahu LM3530_ALS_ZB2_REG, 117b1e6b706SShreshtha Kumar Sahu LM3530_ALS_ZB3_REG, 118b1e6b706SShreshtha Kumar Sahu LM3530_ALS_Z0T_REG, 119b1e6b706SShreshtha Kumar Sahu LM3530_ALS_Z1T_REG, 120b1e6b706SShreshtha Kumar Sahu LM3530_ALS_Z2T_REG, 121b1e6b706SShreshtha Kumar Sahu LM3530_ALS_Z3T_REG, 122b1e6b706SShreshtha Kumar Sahu LM3530_ALS_Z4T_REG, 123b1e6b706SShreshtha Kumar Sahu }; 124b1e6b706SShreshtha Kumar Sahu 125b1e6b706SShreshtha Kumar Sahu static int lm3530_get_mode_from_str(const char *str) 126b1e6b706SShreshtha Kumar Sahu { 127b1e6b706SShreshtha Kumar Sahu int i; 128b1e6b706SShreshtha Kumar Sahu 129b1e6b706SShreshtha Kumar Sahu for (i = 0; i < ARRAY_SIZE(mode_map); i++) 130b1e6b706SShreshtha Kumar Sahu if (sysfs_streq(str, mode_map[i].mode)) 131b1e6b706SShreshtha Kumar Sahu return mode_map[i].mode_val; 132b1e6b706SShreshtha Kumar Sahu 133b1e6b706SShreshtha Kumar Sahu return -1; 134b1e6b706SShreshtha Kumar Sahu } 135b1e6b706SShreshtha Kumar Sahu 136b1e6b706SShreshtha Kumar Sahu static int lm3530_init_registers(struct lm3530_data *drvdata) 137b1e6b706SShreshtha Kumar Sahu { 138b1e6b706SShreshtha Kumar Sahu int ret = 0; 139b1e6b706SShreshtha Kumar Sahu int i; 140b1e6b706SShreshtha Kumar Sahu u8 gen_config; 141b1e6b706SShreshtha Kumar Sahu u8 als_config = 0; 142b1e6b706SShreshtha Kumar Sahu u8 brt_ramp; 143b1e6b706SShreshtha Kumar Sahu u8 als_imp_sel = 0; 144b1e6b706SShreshtha Kumar Sahu u8 brightness; 145b1e6b706SShreshtha Kumar Sahu u8 reg_val[LM3530_REG_MAX]; 146b1e6b706SShreshtha Kumar Sahu struct lm3530_platform_data *pltfm = drvdata->pdata; 147b1e6b706SShreshtha Kumar Sahu struct i2c_client *client = drvdata->client; 148b1e6b706SShreshtha Kumar Sahu 149b1e6b706SShreshtha Kumar Sahu gen_config = (pltfm->brt_ramp_law << LM3530_RAMP_LAW_SHIFT) | 150b1e6b706SShreshtha Kumar Sahu ((pltfm->max_current & 7) << LM3530_MAX_CURR_SHIFT); 151b1e6b706SShreshtha Kumar Sahu 152b1e6b706SShreshtha Kumar Sahu if (drvdata->mode == LM3530_BL_MODE_MANUAL || 153b1e6b706SShreshtha Kumar Sahu drvdata->mode == LM3530_BL_MODE_ALS) 154b1e6b706SShreshtha Kumar Sahu gen_config |= (LM3530_ENABLE_I2C); 155b1e6b706SShreshtha Kumar Sahu 156b1e6b706SShreshtha Kumar Sahu if (drvdata->mode == LM3530_BL_MODE_ALS) { 157b1e6b706SShreshtha Kumar Sahu als_config = 158b1e6b706SShreshtha Kumar Sahu (pltfm->als_avrg_time << LM3530_ALS_AVG_TIME_SHIFT) | 159b1e6b706SShreshtha Kumar Sahu (LM3530_ENABLE_ALS) | 160b1e6b706SShreshtha Kumar Sahu (pltfm->als_input_mode << LM3530_ALS_SEL_SHIFT); 161b1e6b706SShreshtha Kumar Sahu 162b1e6b706SShreshtha Kumar Sahu als_imp_sel = 163b1e6b706SShreshtha Kumar Sahu (pltfm->als1_resistor_sel << LM3530_ALS1_IMP_SHIFT) | 164b1e6b706SShreshtha Kumar Sahu (pltfm->als2_resistor_sel << LM3530_ALS2_IMP_SHIFT); 165b1e6b706SShreshtha Kumar Sahu } 166b1e6b706SShreshtha Kumar Sahu 167b1e6b706SShreshtha Kumar Sahu if (drvdata->mode == LM3530_BL_MODE_PWM) 168b1e6b706SShreshtha Kumar Sahu gen_config |= (LM3530_ENABLE_PWM) | 169b1e6b706SShreshtha Kumar Sahu (pltfm->pwm_pol_hi << LM3530_PWM_POL_SHIFT) | 170b1e6b706SShreshtha Kumar Sahu (LM3530_ENABLE_PWM_SIMPLE); 171b1e6b706SShreshtha Kumar Sahu 172b1e6b706SShreshtha Kumar Sahu brt_ramp = (pltfm->brt_ramp_fall << LM3530_BRT_RAMP_FALL_SHIFT) | 173b1e6b706SShreshtha Kumar Sahu (pltfm->brt_ramp_rise << LM3530_BRT_RAMP_RISE_SHIFT); 174b1e6b706SShreshtha Kumar Sahu 175b1e6b706SShreshtha Kumar Sahu brightness = pltfm->brt_val; 176b1e6b706SShreshtha Kumar Sahu 177b1e6b706SShreshtha Kumar Sahu reg_val[0] = gen_config; /* LM3530_GEN_CONFIG */ 178b1e6b706SShreshtha Kumar Sahu reg_val[1] = als_config; /* LM3530_ALS_CONFIG */ 179b1e6b706SShreshtha Kumar Sahu reg_val[2] = brt_ramp; /* LM3530_BRT_RAMP_RATE */ 180b1e6b706SShreshtha Kumar Sahu reg_val[3] = 0x00; /* LM3530_ALS_ZONE_REG */ 181b1e6b706SShreshtha Kumar Sahu reg_val[4] = als_imp_sel; /* LM3530_ALS_IMP_SELECT */ 182b1e6b706SShreshtha Kumar Sahu reg_val[5] = brightness; /* LM3530_BRT_CTRL_REG */ 183b1e6b706SShreshtha Kumar Sahu reg_val[6] = LM3530_DEF_ZB_0; /* LM3530_ALS_ZB0_REG */ 184b1e6b706SShreshtha Kumar Sahu reg_val[7] = LM3530_DEF_ZB_1; /* LM3530_ALS_ZB1_REG */ 185b1e6b706SShreshtha Kumar Sahu reg_val[8] = LM3530_DEF_ZB_2; /* LM3530_ALS_ZB2_REG */ 186b1e6b706SShreshtha Kumar Sahu reg_val[9] = LM3530_DEF_ZB_3; /* LM3530_ALS_ZB3_REG */ 187b1e6b706SShreshtha Kumar Sahu reg_val[10] = LM3530_DEF_ZT_0; /* LM3530_ALS_Z0T_REG */ 188b1e6b706SShreshtha Kumar Sahu reg_val[11] = LM3530_DEF_ZT_1; /* LM3530_ALS_Z1T_REG */ 189b1e6b706SShreshtha Kumar Sahu reg_val[12] = LM3530_DEF_ZT_2; /* LM3530_ALS_Z2T_REG */ 190b1e6b706SShreshtha Kumar Sahu reg_val[13] = LM3530_DEF_ZT_3; /* LM3530_ALS_Z3T_REG */ 191b1e6b706SShreshtha Kumar Sahu reg_val[14] = LM3530_DEF_ZT_4; /* LM3530_ALS_Z4T_REG */ 192b1e6b706SShreshtha Kumar Sahu 193b1e6b706SShreshtha Kumar Sahu for (i = 0; i < LM3530_REG_MAX; i++) { 194b1e6b706SShreshtha Kumar Sahu ret = i2c_smbus_write_byte_data(client, 195b1e6b706SShreshtha Kumar Sahu lm3530_reg[i], reg_val[i]); 196b1e6b706SShreshtha Kumar Sahu if (ret) 197b1e6b706SShreshtha Kumar Sahu break; 198b1e6b706SShreshtha Kumar Sahu } 199b1e6b706SShreshtha Kumar Sahu 200b1e6b706SShreshtha Kumar Sahu return ret; 201b1e6b706SShreshtha Kumar Sahu } 202b1e6b706SShreshtha Kumar Sahu 203b1e6b706SShreshtha Kumar Sahu static void lm3530_brightness_set(struct led_classdev *led_cdev, 204b1e6b706SShreshtha Kumar Sahu enum led_brightness brt_val) 205b1e6b706SShreshtha Kumar Sahu { 206b1e6b706SShreshtha Kumar Sahu int err; 207b1e6b706SShreshtha Kumar Sahu struct lm3530_data *drvdata = 208b1e6b706SShreshtha Kumar Sahu container_of(led_cdev, struct lm3530_data, led_dev); 209b1e6b706SShreshtha Kumar Sahu 210b1e6b706SShreshtha Kumar Sahu switch (drvdata->mode) { 211b1e6b706SShreshtha Kumar Sahu case LM3530_BL_MODE_MANUAL: 212b1e6b706SShreshtha Kumar Sahu 213b1e6b706SShreshtha Kumar Sahu /* set the brightness in brightness control register*/ 214b1e6b706SShreshtha Kumar Sahu err = i2c_smbus_write_byte_data(drvdata->client, 215b1e6b706SShreshtha Kumar Sahu LM3530_BRT_CTRL_REG, brt_val / 2); 216b1e6b706SShreshtha Kumar Sahu if (err) 217b1e6b706SShreshtha Kumar Sahu dev_err(&drvdata->client->dev, 218b1e6b706SShreshtha Kumar Sahu "Unable to set brightness: %d\n", err); 219b1e6b706SShreshtha Kumar Sahu break; 220b1e6b706SShreshtha Kumar Sahu case LM3530_BL_MODE_ALS: 221b1e6b706SShreshtha Kumar Sahu break; 222b1e6b706SShreshtha Kumar Sahu case LM3530_BL_MODE_PWM: 223b1e6b706SShreshtha Kumar Sahu break; 224b1e6b706SShreshtha Kumar Sahu default: 225b1e6b706SShreshtha Kumar Sahu break; 226b1e6b706SShreshtha Kumar Sahu } 227b1e6b706SShreshtha Kumar Sahu } 228b1e6b706SShreshtha Kumar Sahu 229b1e6b706SShreshtha Kumar Sahu 230b1e6b706SShreshtha Kumar Sahu static ssize_t lm3530_mode_set(struct device *dev, struct device_attribute 231b1e6b706SShreshtha Kumar Sahu *attr, const char *buf, size_t size) 232b1e6b706SShreshtha Kumar Sahu { 233b1e6b706SShreshtha Kumar Sahu int err; 234b1e6b706SShreshtha Kumar Sahu struct i2c_client *client = container_of( 235b1e6b706SShreshtha Kumar Sahu dev->parent, struct i2c_client, dev); 236b1e6b706SShreshtha Kumar Sahu struct lm3530_data *drvdata = i2c_get_clientdata(client); 237b1e6b706SShreshtha Kumar Sahu int mode; 238b1e6b706SShreshtha Kumar Sahu 239b1e6b706SShreshtha Kumar Sahu mode = lm3530_get_mode_from_str(buf); 240b1e6b706SShreshtha Kumar Sahu if (mode < 0) { 241b1e6b706SShreshtha Kumar Sahu dev_err(dev, "Invalid mode\n"); 242b1e6b706SShreshtha Kumar Sahu return -EINVAL; 243b1e6b706SShreshtha Kumar Sahu } 244b1e6b706SShreshtha Kumar Sahu 245b1e6b706SShreshtha Kumar Sahu if (mode == LM3530_BL_MODE_MANUAL) 246b1e6b706SShreshtha Kumar Sahu drvdata->mode = LM3530_BL_MODE_MANUAL; 247b1e6b706SShreshtha Kumar Sahu else if (mode == LM3530_BL_MODE_ALS) 248b1e6b706SShreshtha Kumar Sahu drvdata->mode = LM3530_BL_MODE_ALS; 249b1e6b706SShreshtha Kumar Sahu else if (mode == LM3530_BL_MODE_PWM) { 250b1e6b706SShreshtha Kumar Sahu dev_err(dev, "PWM mode not supported\n"); 251b1e6b706SShreshtha Kumar Sahu return -EINVAL; 252b1e6b706SShreshtha Kumar Sahu } 253b1e6b706SShreshtha Kumar Sahu 254b1e6b706SShreshtha Kumar Sahu err = lm3530_init_registers(drvdata); 255b1e6b706SShreshtha Kumar Sahu if (err) { 256b1e6b706SShreshtha Kumar Sahu dev_err(dev, "Setting %s Mode failed :%d\n", buf, err); 257b1e6b706SShreshtha Kumar Sahu return err; 258b1e6b706SShreshtha Kumar Sahu } 259b1e6b706SShreshtha Kumar Sahu 260b1e6b706SShreshtha Kumar Sahu return sizeof(drvdata->mode); 261b1e6b706SShreshtha Kumar Sahu } 262b1e6b706SShreshtha Kumar Sahu 263b1e6b706SShreshtha Kumar Sahu static DEVICE_ATTR(mode, 0644, NULL, lm3530_mode_set); 264b1e6b706SShreshtha Kumar Sahu 265b1e6b706SShreshtha Kumar Sahu static int __devinit lm3530_probe(struct i2c_client *client, 266b1e6b706SShreshtha Kumar Sahu const struct i2c_device_id *id) 267b1e6b706SShreshtha Kumar Sahu { 268b1e6b706SShreshtha Kumar Sahu struct lm3530_platform_data *pdata = client->dev.platform_data; 269b1e6b706SShreshtha Kumar Sahu struct lm3530_data *drvdata; 270b1e6b706SShreshtha Kumar Sahu int err = 0; 271b1e6b706SShreshtha Kumar Sahu 272b1e6b706SShreshtha Kumar Sahu if (pdata == NULL) { 273b1e6b706SShreshtha Kumar Sahu dev_err(&client->dev, "platform data required\n"); 274b1e6b706SShreshtha Kumar Sahu err = -ENODEV; 275b1e6b706SShreshtha Kumar Sahu goto err_out; 276b1e6b706SShreshtha Kumar Sahu } 277b1e6b706SShreshtha Kumar Sahu 278b1e6b706SShreshtha Kumar Sahu /* BL mode */ 279b1e6b706SShreshtha Kumar Sahu if (pdata->mode > LM3530_BL_MODE_PWM) { 280b1e6b706SShreshtha Kumar Sahu dev_err(&client->dev, "Illegal Mode request\n"); 281b1e6b706SShreshtha Kumar Sahu err = -EINVAL; 282b1e6b706SShreshtha Kumar Sahu goto err_out; 283b1e6b706SShreshtha Kumar Sahu } 284b1e6b706SShreshtha Kumar Sahu 285b1e6b706SShreshtha Kumar Sahu if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) { 286b1e6b706SShreshtha Kumar Sahu dev_err(&client->dev, "I2C_FUNC_I2C not supported\n"); 287b1e6b706SShreshtha Kumar Sahu err = -EIO; 288b1e6b706SShreshtha Kumar Sahu goto err_out; 289b1e6b706SShreshtha Kumar Sahu } 290b1e6b706SShreshtha Kumar Sahu 291b1e6b706SShreshtha Kumar Sahu drvdata = kzalloc(sizeof(struct lm3530_data), GFP_KERNEL); 292b1e6b706SShreshtha Kumar Sahu if (drvdata == NULL) { 293b1e6b706SShreshtha Kumar Sahu err = -ENOMEM; 294b1e6b706SShreshtha Kumar Sahu goto err_out; 295b1e6b706SShreshtha Kumar Sahu } 296b1e6b706SShreshtha Kumar Sahu 297b1e6b706SShreshtha Kumar Sahu drvdata->mode = pdata->mode; 298b1e6b706SShreshtha Kumar Sahu drvdata->client = client; 299b1e6b706SShreshtha Kumar Sahu drvdata->pdata = pdata; 300b1e6b706SShreshtha Kumar Sahu drvdata->led_dev.name = LM3530_LED_DEV; 301b1e6b706SShreshtha Kumar Sahu drvdata->led_dev.brightness_set = lm3530_brightness_set; 302b1e6b706SShreshtha Kumar Sahu 303b1e6b706SShreshtha Kumar Sahu i2c_set_clientdata(client, drvdata); 304b1e6b706SShreshtha Kumar Sahu 305b1e6b706SShreshtha Kumar Sahu err = lm3530_init_registers(drvdata); 306b1e6b706SShreshtha Kumar Sahu if (err < 0) { 307b1e6b706SShreshtha Kumar Sahu dev_err(&client->dev, "Register Init failed: %d\n", err); 308b1e6b706SShreshtha Kumar Sahu err = -ENODEV; 309b1e6b706SShreshtha Kumar Sahu goto err_reg_init; 310b1e6b706SShreshtha Kumar Sahu } 311b1e6b706SShreshtha Kumar Sahu 312b1e6b706SShreshtha Kumar Sahu err = led_classdev_register((struct device *) 313b1e6b706SShreshtha Kumar Sahu &client->dev, &drvdata->led_dev); 314b1e6b706SShreshtha Kumar Sahu if (err < 0) { 315b1e6b706SShreshtha Kumar Sahu dev_err(&client->dev, "Register led class failed: %d\n", err); 316b1e6b706SShreshtha Kumar Sahu err = -ENODEV; 317b1e6b706SShreshtha Kumar Sahu goto err_class_register; 318b1e6b706SShreshtha Kumar Sahu } 319b1e6b706SShreshtha Kumar Sahu 320b1e6b706SShreshtha Kumar Sahu err = device_create_file(drvdata->led_dev.dev, &dev_attr_mode); 321b1e6b706SShreshtha Kumar Sahu if (err < 0) { 322b1e6b706SShreshtha Kumar Sahu dev_err(&client->dev, "File device creation failed: %d\n", err); 323b1e6b706SShreshtha Kumar Sahu err = -ENODEV; 324b1e6b706SShreshtha Kumar Sahu goto err_create_file; 325b1e6b706SShreshtha Kumar Sahu } 326b1e6b706SShreshtha Kumar Sahu 327b1e6b706SShreshtha Kumar Sahu return 0; 328b1e6b706SShreshtha Kumar Sahu 329b1e6b706SShreshtha Kumar Sahu err_create_file: 330b1e6b706SShreshtha Kumar Sahu led_classdev_unregister(&drvdata->led_dev); 331b1e6b706SShreshtha Kumar Sahu err_class_register: 332b1e6b706SShreshtha Kumar Sahu err_reg_init: 333b1e6b706SShreshtha Kumar Sahu kfree(drvdata); 334b1e6b706SShreshtha Kumar Sahu err_out: 335b1e6b706SShreshtha Kumar Sahu return err; 336b1e6b706SShreshtha Kumar Sahu } 337b1e6b706SShreshtha Kumar Sahu 338b1e6b706SShreshtha Kumar Sahu static int __devexit lm3530_remove(struct i2c_client *client) 339b1e6b706SShreshtha Kumar Sahu { 340b1e6b706SShreshtha Kumar Sahu struct lm3530_data *drvdata = i2c_get_clientdata(client); 341b1e6b706SShreshtha Kumar Sahu 342b1e6b706SShreshtha Kumar Sahu device_remove_file(drvdata->led_dev.dev, &dev_attr_mode); 343b1e6b706SShreshtha Kumar Sahu led_classdev_unregister(&drvdata->led_dev); 344b1e6b706SShreshtha Kumar Sahu kfree(drvdata); 345b1e6b706SShreshtha Kumar Sahu return 0; 346b1e6b706SShreshtha Kumar Sahu } 347b1e6b706SShreshtha Kumar Sahu 348b1e6b706SShreshtha Kumar Sahu static const struct i2c_device_id lm3530_id[] = { 349b1e6b706SShreshtha Kumar Sahu {LM3530_NAME, 0}, 350b1e6b706SShreshtha Kumar Sahu {} 351b1e6b706SShreshtha Kumar Sahu }; 352*d5f33d45SAxel Lin MODULE_DEVICE_TABLE(i2c, lm3530_id); 353b1e6b706SShreshtha Kumar Sahu 354b1e6b706SShreshtha Kumar Sahu static struct i2c_driver lm3530_i2c_driver = { 355b1e6b706SShreshtha Kumar Sahu .probe = lm3530_probe, 356b1e6b706SShreshtha Kumar Sahu .remove = lm3530_remove, 357b1e6b706SShreshtha Kumar Sahu .id_table = lm3530_id, 358b1e6b706SShreshtha Kumar Sahu .driver = { 359b1e6b706SShreshtha Kumar Sahu .name = LM3530_NAME, 360b1e6b706SShreshtha Kumar Sahu .owner = THIS_MODULE, 361b1e6b706SShreshtha Kumar Sahu }, 362b1e6b706SShreshtha Kumar Sahu }; 363b1e6b706SShreshtha Kumar Sahu 364b1e6b706SShreshtha Kumar Sahu static int __init lm3530_init(void) 365b1e6b706SShreshtha Kumar Sahu { 366b1e6b706SShreshtha Kumar Sahu return i2c_add_driver(&lm3530_i2c_driver); 367b1e6b706SShreshtha Kumar Sahu } 368b1e6b706SShreshtha Kumar Sahu 369b1e6b706SShreshtha Kumar Sahu static void __exit lm3530_exit(void) 370b1e6b706SShreshtha Kumar Sahu { 371b1e6b706SShreshtha Kumar Sahu i2c_del_driver(&lm3530_i2c_driver); 372b1e6b706SShreshtha Kumar Sahu } 373b1e6b706SShreshtha Kumar Sahu 374b1e6b706SShreshtha Kumar Sahu module_init(lm3530_init); 375b1e6b706SShreshtha Kumar Sahu module_exit(lm3530_exit); 376b1e6b706SShreshtha Kumar Sahu 377b1e6b706SShreshtha Kumar Sahu MODULE_DESCRIPTION("Back Light driver for LM3530"); 378b1e6b706SShreshtha Kumar Sahu MODULE_LICENSE("GPL v2"); 379b1e6b706SShreshtha Kumar Sahu MODULE_AUTHOR("Shreshtha Kumar SAHU <shreshthakumar.sahu@stericsson.com>"); 380