162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0+
262306a36Sopenharmony_ci// Driver for Awinic AW2013 3-channel LED driver
362306a36Sopenharmony_ci
462306a36Sopenharmony_ci#include <linux/i2c.h>
562306a36Sopenharmony_ci#include <linux/leds.h>
662306a36Sopenharmony_ci#include <linux/module.h>
762306a36Sopenharmony_ci#include <linux/regulator/consumer.h>
862306a36Sopenharmony_ci#include <linux/mutex.h>
962306a36Sopenharmony_ci#include <linux/of.h>
1062306a36Sopenharmony_ci#include <linux/regmap.h>
1162306a36Sopenharmony_ci
1262306a36Sopenharmony_ci#define AW2013_MAX_LEDS 3
1362306a36Sopenharmony_ci
1462306a36Sopenharmony_ci/* Reset and ID register */
1562306a36Sopenharmony_ci#define AW2013_RSTR 0x00
1662306a36Sopenharmony_ci#define AW2013_RSTR_RESET 0x55
1762306a36Sopenharmony_ci#define AW2013_RSTR_CHIP_ID 0x33
1862306a36Sopenharmony_ci
1962306a36Sopenharmony_ci/* Global control register */
2062306a36Sopenharmony_ci#define AW2013_GCR 0x01
2162306a36Sopenharmony_ci#define AW2013_GCR_ENABLE BIT(0)
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_ci/* LED channel enable register */
2462306a36Sopenharmony_ci#define AW2013_LCTR 0x30
2562306a36Sopenharmony_ci#define AW2013_LCTR_LE(x) BIT((x))
2662306a36Sopenharmony_ci
2762306a36Sopenharmony_ci/* LED channel control registers */
2862306a36Sopenharmony_ci#define AW2013_LCFG(x) (0x31 + (x))
2962306a36Sopenharmony_ci#define AW2013_LCFG_IMAX_MASK (BIT(0) | BIT(1)) // Should be 0-3
3062306a36Sopenharmony_ci#define AW2013_LCFG_MD BIT(4)
3162306a36Sopenharmony_ci#define AW2013_LCFG_FI BIT(5)
3262306a36Sopenharmony_ci#define AW2013_LCFG_FO BIT(6)
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_ci/* LED channel PWM registers */
3562306a36Sopenharmony_ci#define AW2013_REG_PWM(x) (0x34 + (x))
3662306a36Sopenharmony_ci
3762306a36Sopenharmony_ci/* LED channel timing registers */
3862306a36Sopenharmony_ci#define AW2013_LEDT0(x) (0x37 + (x) * 3)
3962306a36Sopenharmony_ci#define AW2013_LEDT0_T1(x) ((x) << 4) // Should be 0-7
4062306a36Sopenharmony_ci#define AW2013_LEDT0_T2(x) (x) // Should be 0-5
4162306a36Sopenharmony_ci
4262306a36Sopenharmony_ci#define AW2013_LEDT1(x) (0x38 + (x) * 3)
4362306a36Sopenharmony_ci#define AW2013_LEDT1_T3(x) ((x) << 4) // Should be 0-7
4462306a36Sopenharmony_ci#define AW2013_LEDT1_T4(x) (x) // Should be 0-7
4562306a36Sopenharmony_ci
4662306a36Sopenharmony_ci#define AW2013_LEDT2(x) (0x39 + (x) * 3)
4762306a36Sopenharmony_ci#define AW2013_LEDT2_T0(x) ((x) << 4) // Should be 0-8
4862306a36Sopenharmony_ci#define AW2013_LEDT2_REPEAT(x) (x) // Should be 0-15
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_ci#define AW2013_REG_MAX 0x77
5162306a36Sopenharmony_ci
5262306a36Sopenharmony_ci#define AW2013_TIME_STEP 130 /* ms */
5362306a36Sopenharmony_ci
5462306a36Sopenharmony_cistruct aw2013;
5562306a36Sopenharmony_ci
5662306a36Sopenharmony_cistruct aw2013_led {
5762306a36Sopenharmony_ci	struct aw2013 *chip;
5862306a36Sopenharmony_ci	struct led_classdev cdev;
5962306a36Sopenharmony_ci	u32 num;
6062306a36Sopenharmony_ci	unsigned int imax;
6162306a36Sopenharmony_ci};
6262306a36Sopenharmony_ci
6362306a36Sopenharmony_cistruct aw2013 {
6462306a36Sopenharmony_ci	struct mutex mutex; /* held when writing to registers */
6562306a36Sopenharmony_ci	struct regulator_bulk_data regulators[2];
6662306a36Sopenharmony_ci	struct i2c_client *client;
6762306a36Sopenharmony_ci	struct aw2013_led leds[AW2013_MAX_LEDS];
6862306a36Sopenharmony_ci	struct regmap *regmap;
6962306a36Sopenharmony_ci	int num_leds;
7062306a36Sopenharmony_ci	bool enabled;
7162306a36Sopenharmony_ci};
7262306a36Sopenharmony_ci
7362306a36Sopenharmony_cistatic int aw2013_chip_init(struct aw2013 *chip)
7462306a36Sopenharmony_ci{
7562306a36Sopenharmony_ci	int i, ret;
7662306a36Sopenharmony_ci
7762306a36Sopenharmony_ci	ret = regmap_write(chip->regmap, AW2013_GCR, AW2013_GCR_ENABLE);
7862306a36Sopenharmony_ci	if (ret) {
7962306a36Sopenharmony_ci		dev_err(&chip->client->dev, "Failed to enable the chip: %d\n",
8062306a36Sopenharmony_ci			ret);
8162306a36Sopenharmony_ci		return ret;
8262306a36Sopenharmony_ci	}
8362306a36Sopenharmony_ci
8462306a36Sopenharmony_ci	for (i = 0; i < chip->num_leds; i++) {
8562306a36Sopenharmony_ci		ret = regmap_update_bits(chip->regmap,
8662306a36Sopenharmony_ci					 AW2013_LCFG(chip->leds[i].num),
8762306a36Sopenharmony_ci					 AW2013_LCFG_IMAX_MASK,
8862306a36Sopenharmony_ci					 chip->leds[i].imax);
8962306a36Sopenharmony_ci		if (ret) {
9062306a36Sopenharmony_ci			dev_err(&chip->client->dev,
9162306a36Sopenharmony_ci				"Failed to set maximum current for led %d: %d\n",
9262306a36Sopenharmony_ci				chip->leds[i].num, ret);
9362306a36Sopenharmony_ci			return ret;
9462306a36Sopenharmony_ci		}
9562306a36Sopenharmony_ci	}
9662306a36Sopenharmony_ci
9762306a36Sopenharmony_ci	return ret;
9862306a36Sopenharmony_ci}
9962306a36Sopenharmony_ci
10062306a36Sopenharmony_cistatic void aw2013_chip_disable(struct aw2013 *chip)
10162306a36Sopenharmony_ci{
10262306a36Sopenharmony_ci	int ret;
10362306a36Sopenharmony_ci
10462306a36Sopenharmony_ci	if (!chip->enabled)
10562306a36Sopenharmony_ci		return;
10662306a36Sopenharmony_ci
10762306a36Sopenharmony_ci	regmap_write(chip->regmap, AW2013_GCR, 0);
10862306a36Sopenharmony_ci
10962306a36Sopenharmony_ci	ret = regulator_bulk_disable(ARRAY_SIZE(chip->regulators),
11062306a36Sopenharmony_ci				     chip->regulators);
11162306a36Sopenharmony_ci	if (ret) {
11262306a36Sopenharmony_ci		dev_err(&chip->client->dev,
11362306a36Sopenharmony_ci			"Failed to disable regulators: %d\n", ret);
11462306a36Sopenharmony_ci		return;
11562306a36Sopenharmony_ci	}
11662306a36Sopenharmony_ci
11762306a36Sopenharmony_ci	chip->enabled = false;
11862306a36Sopenharmony_ci}
11962306a36Sopenharmony_ci
12062306a36Sopenharmony_cistatic int aw2013_chip_enable(struct aw2013 *chip)
12162306a36Sopenharmony_ci{
12262306a36Sopenharmony_ci	int ret;
12362306a36Sopenharmony_ci
12462306a36Sopenharmony_ci	if (chip->enabled)
12562306a36Sopenharmony_ci		return 0;
12662306a36Sopenharmony_ci
12762306a36Sopenharmony_ci	ret = regulator_bulk_enable(ARRAY_SIZE(chip->regulators),
12862306a36Sopenharmony_ci				    chip->regulators);
12962306a36Sopenharmony_ci	if (ret) {
13062306a36Sopenharmony_ci		dev_err(&chip->client->dev,
13162306a36Sopenharmony_ci			"Failed to enable regulators: %d\n", ret);
13262306a36Sopenharmony_ci		return ret;
13362306a36Sopenharmony_ci	}
13462306a36Sopenharmony_ci	chip->enabled = true;
13562306a36Sopenharmony_ci
13662306a36Sopenharmony_ci	ret = aw2013_chip_init(chip);
13762306a36Sopenharmony_ci	if (ret)
13862306a36Sopenharmony_ci		aw2013_chip_disable(chip);
13962306a36Sopenharmony_ci
14062306a36Sopenharmony_ci	return ret;
14162306a36Sopenharmony_ci}
14262306a36Sopenharmony_ci
14362306a36Sopenharmony_cistatic bool aw2013_chip_in_use(struct aw2013 *chip)
14462306a36Sopenharmony_ci{
14562306a36Sopenharmony_ci	int i;
14662306a36Sopenharmony_ci
14762306a36Sopenharmony_ci	for (i = 0; i < chip->num_leds; i++)
14862306a36Sopenharmony_ci		if (chip->leds[i].cdev.brightness)
14962306a36Sopenharmony_ci			return true;
15062306a36Sopenharmony_ci
15162306a36Sopenharmony_ci	return false;
15262306a36Sopenharmony_ci}
15362306a36Sopenharmony_ci
15462306a36Sopenharmony_cistatic int aw2013_brightness_set(struct led_classdev *cdev,
15562306a36Sopenharmony_ci				 enum led_brightness brightness)
15662306a36Sopenharmony_ci{
15762306a36Sopenharmony_ci	struct aw2013_led *led = container_of(cdev, struct aw2013_led, cdev);
15862306a36Sopenharmony_ci	int ret, num;
15962306a36Sopenharmony_ci
16062306a36Sopenharmony_ci	mutex_lock(&led->chip->mutex);
16162306a36Sopenharmony_ci
16262306a36Sopenharmony_ci	if (aw2013_chip_in_use(led->chip)) {
16362306a36Sopenharmony_ci		ret = aw2013_chip_enable(led->chip);
16462306a36Sopenharmony_ci		if (ret)
16562306a36Sopenharmony_ci			goto error;
16662306a36Sopenharmony_ci	}
16762306a36Sopenharmony_ci
16862306a36Sopenharmony_ci	num = led->num;
16962306a36Sopenharmony_ci
17062306a36Sopenharmony_ci	ret = regmap_write(led->chip->regmap, AW2013_REG_PWM(num), brightness);
17162306a36Sopenharmony_ci	if (ret)
17262306a36Sopenharmony_ci		goto error;
17362306a36Sopenharmony_ci
17462306a36Sopenharmony_ci	if (brightness) {
17562306a36Sopenharmony_ci		ret = regmap_update_bits(led->chip->regmap, AW2013_LCTR,
17662306a36Sopenharmony_ci					 AW2013_LCTR_LE(num), 0xFF);
17762306a36Sopenharmony_ci	} else {
17862306a36Sopenharmony_ci		ret = regmap_update_bits(led->chip->regmap, AW2013_LCTR,
17962306a36Sopenharmony_ci					 AW2013_LCTR_LE(num), 0);
18062306a36Sopenharmony_ci		if (ret)
18162306a36Sopenharmony_ci			goto error;
18262306a36Sopenharmony_ci		ret = regmap_update_bits(led->chip->regmap, AW2013_LCFG(num),
18362306a36Sopenharmony_ci					 AW2013_LCFG_MD, 0);
18462306a36Sopenharmony_ci	}
18562306a36Sopenharmony_ci	if (ret)
18662306a36Sopenharmony_ci		goto error;
18762306a36Sopenharmony_ci
18862306a36Sopenharmony_ci	if (!aw2013_chip_in_use(led->chip))
18962306a36Sopenharmony_ci		aw2013_chip_disable(led->chip);
19062306a36Sopenharmony_ci
19162306a36Sopenharmony_cierror:
19262306a36Sopenharmony_ci	mutex_unlock(&led->chip->mutex);
19362306a36Sopenharmony_ci
19462306a36Sopenharmony_ci	return ret;
19562306a36Sopenharmony_ci}
19662306a36Sopenharmony_ci
19762306a36Sopenharmony_cistatic int aw2013_blink_set(struct led_classdev *cdev,
19862306a36Sopenharmony_ci			    unsigned long *delay_on, unsigned long *delay_off)
19962306a36Sopenharmony_ci{
20062306a36Sopenharmony_ci	struct aw2013_led *led = container_of(cdev, struct aw2013_led, cdev);
20162306a36Sopenharmony_ci	int ret, num = led->num;
20262306a36Sopenharmony_ci	unsigned long off = 0, on = 0;
20362306a36Sopenharmony_ci
20462306a36Sopenharmony_ci	/* If no blink specified, default to 1 Hz. */
20562306a36Sopenharmony_ci	if (!*delay_off && !*delay_on) {
20662306a36Sopenharmony_ci		*delay_off = 500;
20762306a36Sopenharmony_ci		*delay_on = 500;
20862306a36Sopenharmony_ci	}
20962306a36Sopenharmony_ci
21062306a36Sopenharmony_ci	if (!led->cdev.brightness) {
21162306a36Sopenharmony_ci		led->cdev.brightness = LED_FULL;
21262306a36Sopenharmony_ci		ret = aw2013_brightness_set(&led->cdev, led->cdev.brightness);
21362306a36Sopenharmony_ci		if (ret)
21462306a36Sopenharmony_ci			return ret;
21562306a36Sopenharmony_ci	}
21662306a36Sopenharmony_ci
21762306a36Sopenharmony_ci	/* Never on - just set to off */
21862306a36Sopenharmony_ci	if (!*delay_on) {
21962306a36Sopenharmony_ci		led->cdev.brightness = LED_OFF;
22062306a36Sopenharmony_ci		return aw2013_brightness_set(&led->cdev, LED_OFF);
22162306a36Sopenharmony_ci	}
22262306a36Sopenharmony_ci
22362306a36Sopenharmony_ci	mutex_lock(&led->chip->mutex);
22462306a36Sopenharmony_ci
22562306a36Sopenharmony_ci	/* Never off - brightness is already set, disable blinking */
22662306a36Sopenharmony_ci	if (!*delay_off) {
22762306a36Sopenharmony_ci		ret = regmap_update_bits(led->chip->regmap, AW2013_LCFG(num),
22862306a36Sopenharmony_ci					 AW2013_LCFG_MD, 0);
22962306a36Sopenharmony_ci		goto out;
23062306a36Sopenharmony_ci	}
23162306a36Sopenharmony_ci
23262306a36Sopenharmony_ci	/* Convert into values the HW will understand. */
23362306a36Sopenharmony_ci	off = min(5, ilog2((*delay_off - 1) / AW2013_TIME_STEP) + 1);
23462306a36Sopenharmony_ci	on = min(7, ilog2((*delay_on - 1) / AW2013_TIME_STEP) + 1);
23562306a36Sopenharmony_ci
23662306a36Sopenharmony_ci	*delay_off = BIT(off) * AW2013_TIME_STEP;
23762306a36Sopenharmony_ci	*delay_on = BIT(on) * AW2013_TIME_STEP;
23862306a36Sopenharmony_ci
23962306a36Sopenharmony_ci	/* Set timings */
24062306a36Sopenharmony_ci	ret = regmap_write(led->chip->regmap,
24162306a36Sopenharmony_ci			   AW2013_LEDT0(num), AW2013_LEDT0_T2(on));
24262306a36Sopenharmony_ci	if (ret)
24362306a36Sopenharmony_ci		goto out;
24462306a36Sopenharmony_ci	ret = regmap_write(led->chip->regmap,
24562306a36Sopenharmony_ci			   AW2013_LEDT1(num), AW2013_LEDT1_T4(off));
24662306a36Sopenharmony_ci	if (ret)
24762306a36Sopenharmony_ci		goto out;
24862306a36Sopenharmony_ci
24962306a36Sopenharmony_ci	/* Finally, enable the LED */
25062306a36Sopenharmony_ci	ret = regmap_update_bits(led->chip->regmap, AW2013_LCFG(num),
25162306a36Sopenharmony_ci				 AW2013_LCFG_MD, 0xFF);
25262306a36Sopenharmony_ci	if (ret)
25362306a36Sopenharmony_ci		goto out;
25462306a36Sopenharmony_ci
25562306a36Sopenharmony_ci	ret = regmap_update_bits(led->chip->regmap, AW2013_LCTR,
25662306a36Sopenharmony_ci				 AW2013_LCTR_LE(num), 0xFF);
25762306a36Sopenharmony_ci
25862306a36Sopenharmony_ciout:
25962306a36Sopenharmony_ci	mutex_unlock(&led->chip->mutex);
26062306a36Sopenharmony_ci
26162306a36Sopenharmony_ci	return ret;
26262306a36Sopenharmony_ci}
26362306a36Sopenharmony_ci
26462306a36Sopenharmony_cistatic int aw2013_probe_dt(struct aw2013 *chip)
26562306a36Sopenharmony_ci{
26662306a36Sopenharmony_ci	struct device_node *np = dev_of_node(&chip->client->dev), *child;
26762306a36Sopenharmony_ci	int count, ret = 0, i = 0;
26862306a36Sopenharmony_ci	struct aw2013_led *led;
26962306a36Sopenharmony_ci
27062306a36Sopenharmony_ci	count = of_get_available_child_count(np);
27162306a36Sopenharmony_ci	if (!count || count > AW2013_MAX_LEDS)
27262306a36Sopenharmony_ci		return -EINVAL;
27362306a36Sopenharmony_ci
27462306a36Sopenharmony_ci	regmap_write(chip->regmap, AW2013_RSTR, AW2013_RSTR_RESET);
27562306a36Sopenharmony_ci
27662306a36Sopenharmony_ci	for_each_available_child_of_node(np, child) {
27762306a36Sopenharmony_ci		struct led_init_data init_data = {};
27862306a36Sopenharmony_ci		u32 source;
27962306a36Sopenharmony_ci		u32 imax;
28062306a36Sopenharmony_ci
28162306a36Sopenharmony_ci		ret = of_property_read_u32(child, "reg", &source);
28262306a36Sopenharmony_ci		if (ret != 0 || source >= AW2013_MAX_LEDS) {
28362306a36Sopenharmony_ci			dev_err(&chip->client->dev,
28462306a36Sopenharmony_ci				"Couldn't read LED address: %d\n", ret);
28562306a36Sopenharmony_ci			count--;
28662306a36Sopenharmony_ci			continue;
28762306a36Sopenharmony_ci		}
28862306a36Sopenharmony_ci
28962306a36Sopenharmony_ci		led = &chip->leds[i];
29062306a36Sopenharmony_ci		led->num = source;
29162306a36Sopenharmony_ci		led->chip = chip;
29262306a36Sopenharmony_ci		init_data.fwnode = of_fwnode_handle(child);
29362306a36Sopenharmony_ci
29462306a36Sopenharmony_ci		if (!of_property_read_u32(child, "led-max-microamp", &imax)) {
29562306a36Sopenharmony_ci			led->imax = min_t(u32, imax / 5000, 3);
29662306a36Sopenharmony_ci		} else {
29762306a36Sopenharmony_ci			led->imax = 1; // 5mA
29862306a36Sopenharmony_ci			dev_info(&chip->client->dev,
29962306a36Sopenharmony_ci				 "DT property led-max-microamp is missing\n");
30062306a36Sopenharmony_ci		}
30162306a36Sopenharmony_ci
30262306a36Sopenharmony_ci		led->cdev.brightness_set_blocking = aw2013_brightness_set;
30362306a36Sopenharmony_ci		led->cdev.blink_set = aw2013_blink_set;
30462306a36Sopenharmony_ci
30562306a36Sopenharmony_ci		ret = devm_led_classdev_register_ext(&chip->client->dev,
30662306a36Sopenharmony_ci						     &led->cdev, &init_data);
30762306a36Sopenharmony_ci		if (ret < 0) {
30862306a36Sopenharmony_ci			of_node_put(child);
30962306a36Sopenharmony_ci			return ret;
31062306a36Sopenharmony_ci		}
31162306a36Sopenharmony_ci
31262306a36Sopenharmony_ci		i++;
31362306a36Sopenharmony_ci	}
31462306a36Sopenharmony_ci
31562306a36Sopenharmony_ci	if (!count)
31662306a36Sopenharmony_ci		return -EINVAL;
31762306a36Sopenharmony_ci
31862306a36Sopenharmony_ci	chip->num_leds = i;
31962306a36Sopenharmony_ci
32062306a36Sopenharmony_ci	return 0;
32162306a36Sopenharmony_ci}
32262306a36Sopenharmony_ci
32362306a36Sopenharmony_cistatic const struct regmap_config aw2013_regmap_config = {
32462306a36Sopenharmony_ci	.reg_bits = 8,
32562306a36Sopenharmony_ci	.val_bits = 8,
32662306a36Sopenharmony_ci	.max_register = AW2013_REG_MAX,
32762306a36Sopenharmony_ci};
32862306a36Sopenharmony_ci
32962306a36Sopenharmony_cistatic int aw2013_probe(struct i2c_client *client)
33062306a36Sopenharmony_ci{
33162306a36Sopenharmony_ci	struct aw2013 *chip;
33262306a36Sopenharmony_ci	int ret;
33362306a36Sopenharmony_ci	unsigned int chipid;
33462306a36Sopenharmony_ci
33562306a36Sopenharmony_ci	chip = devm_kzalloc(&client->dev, sizeof(*chip), GFP_KERNEL);
33662306a36Sopenharmony_ci	if (!chip)
33762306a36Sopenharmony_ci		return -ENOMEM;
33862306a36Sopenharmony_ci
33962306a36Sopenharmony_ci	mutex_init(&chip->mutex);
34062306a36Sopenharmony_ci	mutex_lock(&chip->mutex);
34162306a36Sopenharmony_ci
34262306a36Sopenharmony_ci	chip->client = client;
34362306a36Sopenharmony_ci	i2c_set_clientdata(client, chip);
34462306a36Sopenharmony_ci
34562306a36Sopenharmony_ci	chip->regmap = devm_regmap_init_i2c(client, &aw2013_regmap_config);
34662306a36Sopenharmony_ci	if (IS_ERR(chip->regmap)) {
34762306a36Sopenharmony_ci		ret = PTR_ERR(chip->regmap);
34862306a36Sopenharmony_ci		dev_err(&client->dev, "Failed to allocate register map: %d\n",
34962306a36Sopenharmony_ci			ret);
35062306a36Sopenharmony_ci		goto error;
35162306a36Sopenharmony_ci	}
35262306a36Sopenharmony_ci
35362306a36Sopenharmony_ci	chip->regulators[0].supply = "vcc";
35462306a36Sopenharmony_ci	chip->regulators[1].supply = "vio";
35562306a36Sopenharmony_ci	ret = devm_regulator_bulk_get(&client->dev,
35662306a36Sopenharmony_ci				      ARRAY_SIZE(chip->regulators),
35762306a36Sopenharmony_ci				      chip->regulators);
35862306a36Sopenharmony_ci	if (ret < 0) {
35962306a36Sopenharmony_ci		if (ret != -EPROBE_DEFER)
36062306a36Sopenharmony_ci			dev_err(&client->dev,
36162306a36Sopenharmony_ci				"Failed to request regulators: %d\n", ret);
36262306a36Sopenharmony_ci		goto error;
36362306a36Sopenharmony_ci	}
36462306a36Sopenharmony_ci
36562306a36Sopenharmony_ci	ret = regulator_bulk_enable(ARRAY_SIZE(chip->regulators),
36662306a36Sopenharmony_ci				    chip->regulators);
36762306a36Sopenharmony_ci	if (ret) {
36862306a36Sopenharmony_ci		dev_err(&client->dev,
36962306a36Sopenharmony_ci			"Failed to enable regulators: %d\n", ret);
37062306a36Sopenharmony_ci		goto error;
37162306a36Sopenharmony_ci	}
37262306a36Sopenharmony_ci
37362306a36Sopenharmony_ci	ret = regmap_read(chip->regmap, AW2013_RSTR, &chipid);
37462306a36Sopenharmony_ci	if (ret) {
37562306a36Sopenharmony_ci		dev_err(&client->dev, "Failed to read chip ID: %d\n",
37662306a36Sopenharmony_ci			ret);
37762306a36Sopenharmony_ci		goto error_reg;
37862306a36Sopenharmony_ci	}
37962306a36Sopenharmony_ci
38062306a36Sopenharmony_ci	if (chipid != AW2013_RSTR_CHIP_ID) {
38162306a36Sopenharmony_ci		dev_err(&client->dev, "Chip reported wrong ID: %x\n",
38262306a36Sopenharmony_ci			chipid);
38362306a36Sopenharmony_ci		ret = -ENODEV;
38462306a36Sopenharmony_ci		goto error_reg;
38562306a36Sopenharmony_ci	}
38662306a36Sopenharmony_ci
38762306a36Sopenharmony_ci	ret = aw2013_probe_dt(chip);
38862306a36Sopenharmony_ci	if (ret < 0)
38962306a36Sopenharmony_ci		goto error_reg;
39062306a36Sopenharmony_ci
39162306a36Sopenharmony_ci	ret = regulator_bulk_disable(ARRAY_SIZE(chip->regulators),
39262306a36Sopenharmony_ci				     chip->regulators);
39362306a36Sopenharmony_ci	if (ret) {
39462306a36Sopenharmony_ci		dev_err(&client->dev,
39562306a36Sopenharmony_ci			"Failed to disable regulators: %d\n", ret);
39662306a36Sopenharmony_ci		goto error;
39762306a36Sopenharmony_ci	}
39862306a36Sopenharmony_ci
39962306a36Sopenharmony_ci	mutex_unlock(&chip->mutex);
40062306a36Sopenharmony_ci
40162306a36Sopenharmony_ci	return 0;
40262306a36Sopenharmony_ci
40362306a36Sopenharmony_cierror_reg:
40462306a36Sopenharmony_ci	regulator_bulk_disable(ARRAY_SIZE(chip->regulators),
40562306a36Sopenharmony_ci			       chip->regulators);
40662306a36Sopenharmony_ci
40762306a36Sopenharmony_cierror:
40862306a36Sopenharmony_ci	mutex_unlock(&chip->mutex);
40962306a36Sopenharmony_ci	mutex_destroy(&chip->mutex);
41062306a36Sopenharmony_ci	return ret;
41162306a36Sopenharmony_ci}
41262306a36Sopenharmony_ci
41362306a36Sopenharmony_cistatic void aw2013_remove(struct i2c_client *client)
41462306a36Sopenharmony_ci{
41562306a36Sopenharmony_ci	struct aw2013 *chip = i2c_get_clientdata(client);
41662306a36Sopenharmony_ci
41762306a36Sopenharmony_ci	aw2013_chip_disable(chip);
41862306a36Sopenharmony_ci
41962306a36Sopenharmony_ci	mutex_destroy(&chip->mutex);
42062306a36Sopenharmony_ci}
42162306a36Sopenharmony_ci
42262306a36Sopenharmony_cistatic const struct of_device_id aw2013_match_table[] = {
42362306a36Sopenharmony_ci	{ .compatible = "awinic,aw2013", },
42462306a36Sopenharmony_ci	{ /* sentinel */ },
42562306a36Sopenharmony_ci};
42662306a36Sopenharmony_ci
42762306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, aw2013_match_table);
42862306a36Sopenharmony_ci
42962306a36Sopenharmony_cistatic struct i2c_driver aw2013_driver = {
43062306a36Sopenharmony_ci	.driver = {
43162306a36Sopenharmony_ci		.name = "leds-aw2013",
43262306a36Sopenharmony_ci		.of_match_table = aw2013_match_table,
43362306a36Sopenharmony_ci	},
43462306a36Sopenharmony_ci	.probe = aw2013_probe,
43562306a36Sopenharmony_ci	.remove = aw2013_remove,
43662306a36Sopenharmony_ci};
43762306a36Sopenharmony_ci
43862306a36Sopenharmony_cimodule_i2c_driver(aw2013_driver);
43962306a36Sopenharmony_ci
44062306a36Sopenharmony_ciMODULE_AUTHOR("Nikita Travkin <nikitos.tr@gmail.com>");
44162306a36Sopenharmony_ciMODULE_DESCRIPTION("AW2013 LED driver");
44262306a36Sopenharmony_ciMODULE_LICENSE("GPL v2");
443