Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * Copyright (C) 2011 ST-Ericsson SA.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  * Copyright (C) 2009 Motorola, Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  * Simple driver for National Semiconductor LM3530 Backlight driver chip
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  * Author: Shreshtha Kumar SAHU <shreshthakumar.sahu@stericsson.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9)  * based on leds-lm3530.c by Dan Murphy <D.Murphy@motorola.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/i2c.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <linux/leds.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include <linux/input.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #include <linux/led-lm3530.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #include <linux/regulator/consumer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #define LM3530_LED_DEV "lcd-backlight"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #define LM3530_NAME "lm3530-led"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) #define LM3530_GEN_CONFIG		0x10
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) #define LM3530_ALS_CONFIG		0x20
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) #define LM3530_BRT_RAMP_RATE		0x30
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) #define LM3530_ALS_IMP_SELECT		0x41
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) #define LM3530_BRT_CTRL_REG		0xA0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) #define LM3530_ALS_ZB0_REG		0x60
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) #define LM3530_ALS_ZB1_REG		0x61
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) #define LM3530_ALS_ZB2_REG		0x62
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) #define LM3530_ALS_ZB3_REG		0x63
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) #define LM3530_ALS_Z0T_REG		0x70
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) #define LM3530_ALS_Z1T_REG		0x71
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) #define LM3530_ALS_Z2T_REG		0x72
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) #define LM3530_ALS_Z3T_REG		0x73
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) #define LM3530_ALS_Z4T_REG		0x74
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) #define LM3530_REG_MAX			14
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) /* General Control Register */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) #define LM3530_EN_I2C_SHIFT		(0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) #define LM3530_RAMP_LAW_SHIFT		(1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) #define LM3530_MAX_CURR_SHIFT		(2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) #define LM3530_EN_PWM_SHIFT		(5)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) #define LM3530_PWM_POL_SHIFT		(6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) #define LM3530_EN_PWM_SIMPLE_SHIFT	(7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) #define LM3530_ENABLE_I2C		(1 << LM3530_EN_I2C_SHIFT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) #define LM3530_ENABLE_PWM		(1 << LM3530_EN_PWM_SHIFT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) #define LM3530_POL_LOW			(1 << LM3530_PWM_POL_SHIFT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) #define LM3530_ENABLE_PWM_SIMPLE	(1 << LM3530_EN_PWM_SIMPLE_SHIFT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) /* ALS Config Register Options */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) #define LM3530_ALS_AVG_TIME_SHIFT	(0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) #define LM3530_EN_ALS_SHIFT		(3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) #define LM3530_ALS_SEL_SHIFT		(5)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) #define LM3530_ENABLE_ALS		(3 << LM3530_EN_ALS_SHIFT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) /* Brightness Ramp Rate Register */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) #define LM3530_BRT_RAMP_FALL_SHIFT	(0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) #define LM3530_BRT_RAMP_RISE_SHIFT	(3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) /* ALS Resistor Select */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) #define LM3530_ALS1_IMP_SHIFT		(0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) #define LM3530_ALS2_IMP_SHIFT		(4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) /* Zone Boundary Register defaults */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) #define LM3530_ALS_ZB_MAX		(4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) #define LM3530_ALS_WINDOW_mV		(1000)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) #define LM3530_ALS_OFFSET_mV		(4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) /* Zone Target Register defaults */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) #define LM3530_DEF_ZT_0			(0x7F)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) #define LM3530_DEF_ZT_1			(0x66)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) #define LM3530_DEF_ZT_2			(0x4C)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) #define LM3530_DEF_ZT_3			(0x33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) #define LM3530_DEF_ZT_4			(0x19)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) /* 7 bits are used for the brightness : LM3530_BRT_CTRL_REG */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) #define MAX_BRIGHTNESS			(127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) struct lm3530_mode_map {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	const char *mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 	enum lm3530_mode mode_val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) static struct lm3530_mode_map mode_map[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 	{ "man", LM3530_BL_MODE_MANUAL },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 	{ "als", LM3530_BL_MODE_ALS },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	{ "pwm", LM3530_BL_MODE_PWM },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96)  * struct lm3530_data
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97)  * @led_dev: led class device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98)  * @client: i2c client
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99)  * @pdata: LM3530 platform data
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100)  * @mode: mode of operation - manual, ALS, PWM
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101)  * @regulator: regulator
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102)  * @brighness: previous brightness value
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103)  * @enable: regulator is enabled
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) struct lm3530_data {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 	struct led_classdev led_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 	struct i2c_client *client;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 	struct lm3530_platform_data *pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 	enum lm3530_mode mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	struct regulator *regulator;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 	enum led_brightness brightness;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 	bool enable;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116)  * struct lm3530_als_data
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117)  * @config  : value of ALS configuration register
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118)  * @imp_sel : value of ALS resistor select register
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119)  * @zone    : values of ALS ZB(Zone Boundary) registers
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) struct lm3530_als_data {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 	u8 config;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 	u8 imp_sel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 	u8 zones[LM3530_ALS_ZB_MAX];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) static const u8 lm3530_reg[LM3530_REG_MAX] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 	LM3530_GEN_CONFIG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 	LM3530_ALS_CONFIG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 	LM3530_BRT_RAMP_RATE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 	LM3530_ALS_IMP_SELECT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 	LM3530_BRT_CTRL_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 	LM3530_ALS_ZB0_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 	LM3530_ALS_ZB1_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 	LM3530_ALS_ZB2_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 	LM3530_ALS_ZB3_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 	LM3530_ALS_Z0T_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 	LM3530_ALS_Z1T_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 	LM3530_ALS_Z2T_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 	LM3530_ALS_Z3T_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 	LM3530_ALS_Z4T_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) static int lm3530_get_mode_from_str(const char *str)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 	for (i = 0; i < ARRAY_SIZE(mode_map); i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 		if (sysfs_streq(str, mode_map[i].mode))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 			return mode_map[i].mode_val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 	return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) static void lm3530_als_configure(struct lm3530_platform_data *pdata,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 				struct lm3530_als_data *als)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 	u32 als_vmin, als_vmax, als_vstep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 	if (pdata->als_vmax == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 		pdata->als_vmin = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 		pdata->als_vmax = LM3530_ALS_WINDOW_mV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 	als_vmin = pdata->als_vmin;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 	als_vmax = pdata->als_vmax;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	if ((als_vmax - als_vmin) > LM3530_ALS_WINDOW_mV)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 		pdata->als_vmax = als_vmax = als_vmin + LM3530_ALS_WINDOW_mV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 	/* n zone boundary makes n+1 zones */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 	als_vstep = (als_vmax - als_vmin) / (LM3530_ALS_ZB_MAX + 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 	for (i = 0; i < LM3530_ALS_ZB_MAX; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 		als->zones[i] = (((als_vmin + LM3530_ALS_OFFSET_mV) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 			als_vstep + (i * als_vstep)) * LED_FULL) / 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 	als->config =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 		(pdata->als_avrg_time << LM3530_ALS_AVG_TIME_SHIFT) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 		(LM3530_ENABLE_ALS) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 		(pdata->als_input_mode << LM3530_ALS_SEL_SHIFT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 	als->imp_sel =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 		(pdata->als1_resistor_sel << LM3530_ALS1_IMP_SHIFT) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 		(pdata->als2_resistor_sel << LM3530_ALS2_IMP_SHIFT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) static int lm3530_led_enable(struct lm3530_data *drvdata)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 	if (drvdata->enable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 	ret = regulator_enable(drvdata->regulator);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 		dev_err(drvdata->led_dev.dev, "Failed to enable vin:%d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 	drvdata->enable = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) static void lm3530_led_disable(struct lm3530_data *drvdata)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 	if (!drvdata->enable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 	ret = regulator_disable(drvdata->regulator);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 		dev_err(drvdata->led_dev.dev, "Failed to disable vin:%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 			ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 	drvdata->enable = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) static int lm3530_init_registers(struct lm3530_data *drvdata)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 	int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 	u8 gen_config;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 	u8 brt_ramp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 	u8 brightness;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 	u8 reg_val[LM3530_REG_MAX];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 	struct lm3530_platform_data *pdata = drvdata->pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 	struct i2c_client *client = drvdata->client;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 	struct lm3530_pwm_data *pwm = &pdata->pwm_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 	struct lm3530_als_data als;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 	memset(&als, 0, sizeof(struct lm3530_als_data));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 	gen_config = (pdata->brt_ramp_law << LM3530_RAMP_LAW_SHIFT) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 			((pdata->max_current & 7) << LM3530_MAX_CURR_SHIFT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 	switch (drvdata->mode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 	case LM3530_BL_MODE_MANUAL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 		gen_config |= LM3530_ENABLE_I2C;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 	case LM3530_BL_MODE_ALS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 		gen_config |= LM3530_ENABLE_I2C;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 		lm3530_als_configure(pdata, &als);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 	case LM3530_BL_MODE_PWM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 		gen_config |= LM3530_ENABLE_PWM | LM3530_ENABLE_PWM_SIMPLE |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 			      (pdata->pwm_pol_hi << LM3530_PWM_POL_SHIFT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 	brt_ramp = (pdata->brt_ramp_fall << LM3530_BRT_RAMP_FALL_SHIFT) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 			(pdata->brt_ramp_rise << LM3530_BRT_RAMP_RISE_SHIFT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 	if (drvdata->brightness)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 		brightness = drvdata->brightness;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 		brightness = drvdata->brightness = pdata->brt_val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 	if (brightness > drvdata->led_dev.max_brightness)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 		brightness = drvdata->led_dev.max_brightness;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 	reg_val[0] = gen_config;	/* LM3530_GEN_CONFIG */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 	reg_val[1] = als.config;	/* LM3530_ALS_CONFIG */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 	reg_val[2] = brt_ramp;		/* LM3530_BRT_RAMP_RATE */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 	reg_val[3] = als.imp_sel;	/* LM3530_ALS_IMP_SELECT */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 	reg_val[4] = brightness;	/* LM3530_BRT_CTRL_REG */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 	reg_val[5] = als.zones[0];	/* LM3530_ALS_ZB0_REG */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 	reg_val[6] = als.zones[1];	/* LM3530_ALS_ZB1_REG */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 	reg_val[7] = als.zones[2];	/* LM3530_ALS_ZB2_REG */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 	reg_val[8] = als.zones[3];	/* LM3530_ALS_ZB3_REG */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 	reg_val[9] = LM3530_DEF_ZT_0;	/* LM3530_ALS_Z0T_REG */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 	reg_val[10] = LM3530_DEF_ZT_1;	/* LM3530_ALS_Z1T_REG */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 	reg_val[11] = LM3530_DEF_ZT_2;	/* LM3530_ALS_Z2T_REG */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 	reg_val[12] = LM3530_DEF_ZT_3;	/* LM3530_ALS_Z3T_REG */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 	reg_val[13] = LM3530_DEF_ZT_4;	/* LM3530_ALS_Z4T_REG */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 	ret = lm3530_led_enable(drvdata);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 	for (i = 0; i < LM3530_REG_MAX; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 		/* do not update brightness register when pwm mode */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 		if (lm3530_reg[i] == LM3530_BRT_CTRL_REG &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 		    drvdata->mode == LM3530_BL_MODE_PWM) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 			if (pwm->pwm_set_intensity)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 				pwm->pwm_set_intensity(reg_val[i],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 					drvdata->led_dev.max_brightness);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) 			continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 		ret = i2c_smbus_write_byte_data(client,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 				lm3530_reg[i], reg_val[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 		if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) static void lm3530_brightness_set(struct led_classdev *led_cdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 				     enum led_brightness brt_val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 	int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 	struct lm3530_data *drvdata =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 	    container_of(led_cdev, struct lm3530_data, led_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 	struct lm3530_platform_data *pdata = drvdata->pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 	struct lm3530_pwm_data *pwm = &pdata->pwm_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 	u8 max_brightness = led_cdev->max_brightness;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) 	switch (drvdata->mode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) 	case LM3530_BL_MODE_MANUAL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 		if (!drvdata->enable) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 			err = lm3530_init_registers(drvdata);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 			if (err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 				dev_err(&drvdata->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) 					"Register Init failed: %d\n", err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) 		/* set the brightness in brightness control register*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) 		err = i2c_smbus_write_byte_data(drvdata->client,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 				LM3530_BRT_CTRL_REG, brt_val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) 		if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 			dev_err(&drvdata->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) 				"Unable to set brightness: %d\n", err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) 		else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) 			drvdata->brightness = brt_val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) 		if (brt_val == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 			lm3530_led_disable(drvdata);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) 	case LM3530_BL_MODE_ALS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 	case LM3530_BL_MODE_PWM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) 		if (pwm->pwm_set_intensity)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) 			pwm->pwm_set_intensity(brt_val, max_brightness);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) static ssize_t lm3530_mode_get(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) 		struct device_attribute *attr, char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) 	struct led_classdev *led_cdev = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) 	struct lm3530_data *drvdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) 	int i, len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) 	drvdata = container_of(led_cdev, struct lm3530_data, led_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) 	for (i = 0; i < ARRAY_SIZE(mode_map); i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) 		if (drvdata->mode == mode_map[i].mode_val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) 			len += sprintf(buf + len, "[%s] ", mode_map[i].mode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) 		else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) 			len += sprintf(buf + len, "%s ", mode_map[i].mode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) 	len += sprintf(buf + len, "\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) 	return len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) static ssize_t lm3530_mode_set(struct device *dev, struct device_attribute
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) 				   *attr, const char *buf, size_t size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) 	struct led_classdev *led_cdev = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) 	struct lm3530_data *drvdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) 	struct lm3530_pwm_data *pwm;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) 	u8 max_brightness;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) 	int mode, err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) 	drvdata = container_of(led_cdev, struct lm3530_data, led_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) 	pwm = &drvdata->pdata->pwm_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) 	max_brightness = led_cdev->max_brightness;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) 	mode = lm3530_get_mode_from_str(buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) 	if (mode < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) 		dev_err(dev, "Invalid mode\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) 		return mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) 	drvdata->mode = mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) 	/* set pwm to low if unnecessary */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) 	if (mode != LM3530_BL_MODE_PWM && pwm->pwm_set_intensity)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) 		pwm->pwm_set_intensity(0, max_brightness);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) 	err = lm3530_init_registers(drvdata);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) 	if (err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) 		dev_err(dev, "Setting %s Mode failed :%d\n", buf, err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) 		return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) 	return sizeof(drvdata->mode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) static DEVICE_ATTR(mode, 0644, lm3530_mode_get, lm3530_mode_set);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) static struct attribute *lm3530_attrs[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) 	&dev_attr_mode.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) 	NULL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) ATTRIBUTE_GROUPS(lm3530);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) static int lm3530_probe(struct i2c_client *client,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) 			   const struct i2c_device_id *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) 	struct lm3530_platform_data *pdata = dev_get_platdata(&client->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) 	struct lm3530_data *drvdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) 	int err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) 	if (pdata == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) 		dev_err(&client->dev, "platform data required\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) 	/* BL mode */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) 	if (pdata->mode > LM3530_BL_MODE_PWM) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) 		dev_err(&client->dev, "Illegal Mode request\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) 	if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) 		dev_err(&client->dev, "I2C_FUNC_I2C not supported\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) 		return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) 	drvdata = devm_kzalloc(&client->dev, sizeof(struct lm3530_data),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) 				GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) 	if (drvdata == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) 	drvdata->mode = pdata->mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) 	drvdata->client = client;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) 	drvdata->pdata = pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) 	drvdata->brightness = LED_OFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) 	drvdata->enable = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) 	drvdata->led_dev.name = LM3530_LED_DEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) 	drvdata->led_dev.brightness_set = lm3530_brightness_set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) 	drvdata->led_dev.max_brightness = MAX_BRIGHTNESS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) 	drvdata->led_dev.groups = lm3530_groups;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) 	i2c_set_clientdata(client, drvdata);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) 	drvdata->regulator = devm_regulator_get(&client->dev, "vin");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) 	if (IS_ERR(drvdata->regulator)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) 		dev_err(&client->dev, "regulator get failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) 		err = PTR_ERR(drvdata->regulator);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) 		drvdata->regulator = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) 		return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) 	if (drvdata->pdata->brt_val) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) 		err = lm3530_init_registers(drvdata);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) 		if (err < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) 			dev_err(&client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) 				"Register Init failed: %d\n", err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) 			return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) 	err = led_classdev_register(&client->dev, &drvdata->led_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) 	if (err < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) 		dev_err(&client->dev, "Register led class failed: %d\n", err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) 		return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) static int lm3530_remove(struct i2c_client *client)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) 	struct lm3530_data *drvdata = i2c_get_clientdata(client);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) 	lm3530_led_disable(drvdata);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) 	led_classdev_unregister(&drvdata->led_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) static const struct i2c_device_id lm3530_id[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) 	{LM3530_NAME, 0},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) 	{}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) MODULE_DEVICE_TABLE(i2c, lm3530_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) static struct i2c_driver lm3530_i2c_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) 	.probe = lm3530_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) 	.remove = lm3530_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) 	.id_table = lm3530_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) 	.driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) 		.name = LM3530_NAME,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) module_i2c_driver(lm3530_i2c_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) MODULE_DESCRIPTION("Back Light driver for LM3530");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) MODULE_LICENSE("GPL v2");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) MODULE_AUTHOR("Shreshtha Kumar SAHU <shreshthakumar.sahu@stericsson.com>");