Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0+
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) // Driver for Awinic AW2013 3-channel LED driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4) #include <linux/i2c.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5) #include <linux/leds.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) #include <linux/regulator/consumer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) #include <linux/mutex.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/regmap.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #define AW2013_MAX_LEDS 3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) /* Reset and ID register */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #define AW2013_RSTR 0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #define AW2013_RSTR_RESET 0x55
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #define AW2013_RSTR_CHIP_ID 0x33
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) /* Global control register */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #define AW2013_GCR 0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #define AW2013_GCR_ENABLE BIT(0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) /* LED channel enable register */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) #define AW2013_LCTR 0x30
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) #define AW2013_LCTR_LE(x) BIT((x))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) /* LED channel control registers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) #define AW2013_LCFG(x) (0x31 + (x))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) #define AW2013_LCFG_IMAX_MASK (BIT(0) | BIT(1)) // Should be 0-3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) #define AW2013_LCFG_MD BIT(4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) #define AW2013_LCFG_FI BIT(5)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) #define AW2013_LCFG_FO BIT(6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) /* LED channel PWM registers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) #define AW2013_REG_PWM(x) (0x34 + (x))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) /* LED channel timing registers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) #define AW2013_LEDT0(x) (0x37 + (x) * 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) #define AW2013_LEDT0_T1(x) ((x) << 4) // Should be 0-7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) #define AW2013_LEDT0_T2(x) (x) // Should be 0-5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) #define AW2013_LEDT1(x) (0x38 + (x) * 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) #define AW2013_LEDT1_T3(x) ((x) << 4) // Should be 0-7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) #define AW2013_LEDT1_T4(x) (x) // Should be 0-7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) #define AW2013_LEDT2(x) (0x39 + (x) * 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) #define AW2013_LEDT2_T0(x) ((x) << 4) // Should be 0-8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) #define AW2013_LEDT2_REPEAT(x) (x) // Should be 0-15
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) #define AW2013_REG_MAX 0x77
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) #define AW2013_TIME_STEP 130 /* ms */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) struct aw2013;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) struct aw2013_led {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 	struct aw2013 *chip;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 	struct led_classdev cdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 	u32 num;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 	unsigned int imax;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) struct aw2013 {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 	struct mutex mutex; /* held when writing to registers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 	struct regulator *vcc_regulator;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	struct i2c_client *client;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	struct aw2013_led leds[AW2013_MAX_LEDS];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 	struct regmap *regmap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 	int num_leds;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	bool enabled;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) static int aw2013_chip_init(struct aw2013 *chip)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	int i, ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 	ret = regmap_write(chip->regmap, AW2013_GCR, AW2013_GCR_ENABLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 		dev_err(&chip->client->dev, "Failed to enable the chip: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 			ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	for (i = 0; i < chip->num_leds; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 		ret = regmap_update_bits(chip->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 					 AW2013_LCFG(chip->leds[i].num),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 					 AW2013_LCFG_IMAX_MASK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 					 chip->leds[i].imax);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 		if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 			dev_err(&chip->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 				"Failed to set maximum current for led %d: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 				chip->leds[i].num, ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 			return ret;
^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) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) static void aw2013_chip_disable(struct aw2013 *chip)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 	if (!chip->enabled)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 	regmap_write(chip->regmap, AW2013_GCR, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 	ret = regulator_disable(chip->vcc_regulator);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 		dev_err(&chip->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 			"Failed to disable regulator: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 		return;
^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) 	chip->enabled = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) static int aw2013_chip_enable(struct aw2013 *chip)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 	if (chip->enabled)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 	ret = regulator_enable(chip->vcc_regulator);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 		dev_err(&chip->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 			"Failed to enable regulator: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 	chip->enabled = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 	ret = aw2013_chip_init(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 		aw2013_chip_disable(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) static bool aw2013_chip_in_use(struct aw2013 *chip)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 	for (i = 0; i < chip->num_leds; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 		if (chip->leds[i].cdev.brightness)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 			return true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 	return false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) static int aw2013_brightness_set(struct led_classdev *cdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 				 enum led_brightness brightness)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 	struct aw2013_led *led = container_of(cdev, struct aw2013_led, cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 	int ret, num;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 	mutex_lock(&led->chip->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 	if (aw2013_chip_in_use(led->chip)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 		ret = aw2013_chip_enable(led->chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 		if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 			goto error;
^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) 	num = led->num;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 	ret = regmap_write(led->chip->regmap, AW2013_REG_PWM(num), brightness);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 		goto error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 	if (brightness) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 		ret = regmap_update_bits(led->chip->regmap, AW2013_LCTR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 					 AW2013_LCTR_LE(num), 0xFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 		ret = regmap_update_bits(led->chip->regmap, AW2013_LCTR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 					 AW2013_LCTR_LE(num), 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 		if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 			goto error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 		ret = regmap_update_bits(led->chip->regmap, AW2013_LCFG(num),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 					 AW2013_LCFG_MD, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 		goto error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 	if (!aw2013_chip_in_use(led->chip))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 		aw2013_chip_disable(led->chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 	mutex_unlock(&led->chip->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) static int aw2013_blink_set(struct led_classdev *cdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 			    unsigned long *delay_on, unsigned long *delay_off)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 	struct aw2013_led *led = container_of(cdev, struct aw2013_led, cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 	int ret, num = led->num;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 	unsigned long off = 0, on = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 	/* If no blink specified, default to 1 Hz. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 	if (!*delay_off && !*delay_on) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 		*delay_off = 500;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 		*delay_on = 500;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 	if (!led->cdev.brightness) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 		led->cdev.brightness = LED_FULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 		ret = aw2013_brightness_set(&led->cdev, led->cdev.brightness);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 		if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 			return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 	/* Never on - just set to off */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 	if (!*delay_on) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 		led->cdev.brightness = LED_OFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 		return aw2013_brightness_set(&led->cdev, LED_OFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 	mutex_lock(&led->chip->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 	/* Never off - brightness is already set, disable blinking */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 	if (!*delay_off) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 		ret = regmap_update_bits(led->chip->regmap, AW2013_LCFG(num),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 					 AW2013_LCFG_MD, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 	/* Convert into values the HW will understand. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 	off = min(5, ilog2((*delay_off - 1) / AW2013_TIME_STEP) + 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 	on = min(7, ilog2((*delay_on - 1) / AW2013_TIME_STEP) + 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 	*delay_off = BIT(off) * AW2013_TIME_STEP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 	*delay_on = BIT(on) * AW2013_TIME_STEP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 	/* Set timings */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 	ret = regmap_write(led->chip->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 			   AW2013_LEDT0(num), AW2013_LEDT0_T2(on));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 	ret = regmap_write(led->chip->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 			   AW2013_LEDT1(num), AW2013_LEDT1_T4(off));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 	/* Finally, enable the LED */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 	ret = regmap_update_bits(led->chip->regmap, AW2013_LCFG(num),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 				 AW2013_LCFG_MD, 0xFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 	ret = regmap_update_bits(led->chip->regmap, AW2013_LCTR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 				 AW2013_LCTR_LE(num), 0xFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 	mutex_unlock(&led->chip->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) static int aw2013_probe_dt(struct aw2013 *chip)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 	struct device_node *np = dev_of_node(&chip->client->dev), *child;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 	int count, ret = 0, i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 	struct aw2013_led *led;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 	count = of_get_available_child_count(np);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 	if (!count || count > AW2013_MAX_LEDS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 	regmap_write(chip->regmap, AW2013_RSTR, AW2013_RSTR_RESET);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 	for_each_available_child_of_node(np, child) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 		struct led_init_data init_data = {};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 		u32 source;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 		u32 imax;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 		ret = of_property_read_u32(child, "reg", &source);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 		if (ret != 0 || source >= AW2013_MAX_LEDS) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 			dev_err(&chip->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 				"Couldn't read LED address: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 			count--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 			continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 		led = &chip->leds[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 		led->num = source;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 		led->chip = chip;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 		init_data.fwnode = of_fwnode_handle(child);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) 		if (!of_property_read_u32(child, "led-max-microamp", &imax)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 			led->imax = min_t(u32, imax / 5000, 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 		} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 			led->imax = 1; // 5mA
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 			dev_info(&chip->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 				 "DT property led-max-microamp is missing\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 		led->cdev.brightness_set_blocking = aw2013_brightness_set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 		led->cdev.blink_set = aw2013_blink_set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 		ret = devm_led_classdev_register_ext(&chip->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 						     &led->cdev, &init_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 		if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 			of_node_put(child);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 			return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 		i++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) 	if (!count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 	chip->num_leds = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) static const struct regmap_config aw2013_regmap_config = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 	.reg_bits = 8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) 	.val_bits = 8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) 	.max_register = AW2013_REG_MAX,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) static int aw2013_probe(struct i2c_client *client)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) 	struct aw2013 *chip;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) 	unsigned int chipid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) 	chip = devm_kzalloc(&client->dev, sizeof(*chip), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) 	if (!chip)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) 	mutex_init(&chip->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) 	mutex_lock(&chip->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 	chip->client = client;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) 	i2c_set_clientdata(client, chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) 	chip->regmap = devm_regmap_init_i2c(client, &aw2013_regmap_config);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) 	if (IS_ERR(chip->regmap)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) 		ret = PTR_ERR(chip->regmap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) 		dev_err(&client->dev, "Failed to allocate register map: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) 			ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) 		goto error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) 	chip->vcc_regulator = devm_regulator_get(&client->dev, "vcc");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) 	ret = PTR_ERR_OR_ZERO(chip->vcc_regulator);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) 		if (ret != -EPROBE_DEFER)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) 			dev_err(&client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) 				"Failed to request regulator: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) 		goto error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) 	ret = regulator_enable(chip->vcc_regulator);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) 		dev_err(&client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) 			"Failed to enable regulator: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) 		goto error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) 	ret = regmap_read(chip->regmap, AW2013_RSTR, &chipid);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) 		dev_err(&client->dev, "Failed to read chip ID: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) 			ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) 		goto error_reg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) 	if (chipid != AW2013_RSTR_CHIP_ID) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) 		dev_err(&client->dev, "Chip reported wrong ID: %x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) 			chipid);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) 		ret = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) 		goto error_reg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) 	ret = aw2013_probe_dt(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) 	if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) 		goto error_reg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) 	ret = regulator_disable(chip->vcc_regulator);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) 		dev_err(&client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) 			"Failed to disable regulator: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) 		goto error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) 	mutex_unlock(&chip->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) error_reg:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) 	regulator_disable(chip->vcc_regulator);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) 	mutex_destroy(&chip->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) static int aw2013_remove(struct i2c_client *client)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) 	struct aw2013 *chip = i2c_get_clientdata(client);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) 	aw2013_chip_disable(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) 	mutex_destroy(&chip->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) static const struct of_device_id aw2013_match_table[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) 	{ .compatible = "awinic,aw2013", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) 	{ /* sentinel */ },
^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) MODULE_DEVICE_TABLE(of, aw2013_match_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) static struct i2c_driver aw2013_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) 	.driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) 		.name = "leds-aw2013",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) 		.of_match_table = of_match_ptr(aw2013_match_table),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) 	.probe_new = aw2013_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) 	.remove = aw2013_remove,
^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) module_i2c_driver(aw2013_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) MODULE_AUTHOR("Nikita Travkin <nikitos.tr@gmail.com>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) MODULE_DESCRIPTION("AW2013 LED driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) MODULE_LICENSE("GPL v2");