ARK-OS/arkos/kernel/drivers/leds/leds-lp8864.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * TI LP8864/LP8866 4/6 Channel LED Driver
 *
 * Copyright (C) 2024 Siemens AG
 *
 * Based on LP8860 driver by Dan Murphy <dmurphy@ti.com>
 */

#include <linux/gpio/consumer.h>
#include <linux/i2c.h>
#include <linux/init.h>
#include <linux/leds.h>
#include <linux/module.h>
#include <linux/mutex.h>
#include <linux/of.h>
#include <linux/regmap.h>
#include <linux/regulator/consumer.h>
#include <linux/slab.h>

#define LP8864_BRT_CONTROL		0x00
#define LP8864_USER_CONFIG1		0x04
#define   LP8864_BRT_MODE_MASK		GENMASK(9, 8)
#define   LP8864_BRT_MODE_REG		BIT(9)		/* Brightness control by DISPLAY_BRT reg */
#define LP8864_SUPPLY_STATUS		0x0e
#define LP8864_BOOST_STATUS		0x10
#define LP8864_LED_STATUS		0x12
#define   LP8864_LED_STATUS_WR_MASK	GENMASK(14, 9)	/* Writeable bits in the LED_STATUS reg */

/* Textual meaning for status bits, starting from bit 1 */
static const char *const lp8864_supply_status_msg[] = {
	"Vin under-voltage fault",
	"Vin over-voltage fault",
	"Vdd under-voltage fault",
	"Vin over-current fault",
	"Missing charge pump fault",
	"Charge pump fault",
	"Missing boost sync fault",
	"CRC error fault ",
};

/* Textual meaning for status bits, starting from bit 1 */
static const char *const lp8864_boost_status_msg[] = {
	"Boost OVP low fault",
	"Boost OVP high fault",
	"Boost over-current fault",
	"Missing boost FSET resistor fault",
	"Missing MODE SEL resistor fault",
	"Missing LED resistor fault",
	"ISET resistor short to ground fault",
	"Thermal shutdown fault",
};

/* Textual meaning for every register bit */
static const char *const lp8864_led_status_msg[] = {
	"LED 1 fault",
	"LED 2 fault",
	"LED 3 fault",
	"LED 4 fault",
	"LED 5 fault",
	"LED 6 fault",
	"LED open fault",
	"LED internal short fault",
	"LED short to GND fault",
	NULL, NULL, NULL,
	"Invalid string configuration fault",
	NULL,
	"I2C time out fault",
};

/**
 * struct lp8864_led
 * @client: Pointer to the I2C client
 * @led_dev: led class device pointer
 * @regmap: Devices register map
 * @led_status_mask: Helps to report LED fault only once
 */
struct lp8864_led {
	struct i2c_client *client;
	struct led_classdev led_dev;
	struct regmap *regmap;
	u16 led_status_mask;
};

static int lp8864_fault_check(struct lp8864_led *led)
{
	int ret, i;
	unsigned int val;

	ret = regmap_read(led->regmap, LP8864_SUPPLY_STATUS, &val);
	if (ret)
		goto err;

	/* Odd bits are status bits, even bits are clear bits */
	for (i = 0; i < ARRAY_SIZE(lp8864_supply_status_msg); i++)
		if (val & BIT(i * 2 + 1))
			dev_warn(&led->client->dev, "%s\n", lp8864_supply_status_msg[i]);

	/*
	 * Clear bits have an index preceding the corresponding Status bits;
	 * both have to be written "1" simultaneously to clear the corresponding
	 * Status bit.
	 */
	if (val)
		ret = regmap_write(led->regmap, LP8864_SUPPLY_STATUS, val >> 1 | val);
	if (ret)
		goto err;

	ret = regmap_read(led->regmap, LP8864_BOOST_STATUS, &val);
	if (ret)
		goto err;

	/* Odd bits are status bits, even bits are clear bits */
	for (i = 0; i < ARRAY_SIZE(lp8864_boost_status_msg); i++)
		if (val & BIT(i * 2 + 1))
			dev_warn(&led->client->dev, "%s\n", lp8864_boost_status_msg[i]);

	if (val)
		ret = regmap_write(led->regmap, LP8864_BOOST_STATUS, val >> 1 | val);
	if (ret)
		goto err;

	ret = regmap_read(led->regmap, LP8864_LED_STATUS, &val);
	if (ret)
		goto err;

	/*
	 * Clear already reported faults that maintain their value until device
	 * power-down
	 */
	val &= ~led->led_status_mask;

	for (i = 0; i < ARRAY_SIZE(lp8864_led_status_msg); i++)
		if (lp8864_led_status_msg[i] && val & BIT(i))
			dev_warn(&led->client->dev, "%s\n", lp8864_led_status_msg[i]);

	/*
	 * Mark those which maintain their value until device power-down as
	 * "already reported"
	 */
	led->led_status_mask |= val & ~LP8864_LED_STATUS_WR_MASK;

	/*
	 * Only bits 14, 12, 10 have to be cleared here, but others are RO,
	 * we don't care what we write to them.
	 */
	if (val & LP8864_LED_STATUS_WR_MASK)
		ret = regmap_write(led->regmap, LP8864_LED_STATUS, val >> 1 | val);
	if (ret)
		goto err;

	return 0;

err:
	dev_err(&led->client->dev, "Failed to read/clear faults (%pe)\n", ERR_PTR(ret));

	return ret;
}

static int lp8864_brightness_set(struct led_classdev *led_cdev,
				 enum led_brightness brt_val)
{
	struct lp8864_led *led = container_of(led_cdev, struct lp8864_led, led_dev);
	/* Scale 0..LED_FULL into 16-bit HW brightness */
	unsigned int val = brt_val * 0xffff / LED_FULL;
	int ret;

	ret = lp8864_fault_check(led);
	if (ret)
		return ret;

	ret = regmap_write(led->regmap, LP8864_BRT_CONTROL, val);
	if (ret)
		dev_err(&led->client->dev, "Failed to write brightness value\n");

	return ret;
}

static enum led_brightness lp8864_brightness_get(struct led_classdev *led_cdev)
{
	struct lp8864_led *led = container_of(led_cdev, struct lp8864_led, led_dev);
	unsigned int val;
	int ret;

	ret = regmap_read(led->regmap, LP8864_BRT_CONTROL, &val);
	if (ret) {
		dev_err(&led->client->dev, "Failed to read brightness value\n");
		return ret;
	}

	/* Scale 16-bit HW brightness into 0..LED_FULL */
	return val * LED_FULL / 0xffff;
}

static const struct regmap_config lp8864_regmap_config = {
	.reg_bits		= 8,
	.val_bits		= 16,
	.val_format_endian	= REGMAP_ENDIAN_LITTLE,
};

static void lp8864_disable_gpio(void *data)
{
	struct gpio_desc *gpio = data;

	gpiod_set_value(gpio, 0);
}

static int lp8864_probe(struct i2c_client *client)
{
	int ret;
	struct lp8864_led *led;
	struct device_node *np = dev_of_node(&client->dev);
	struct device_node *child_node;
	struct led_init_data init_data = {};
	struct gpio_desc *enable_gpio;

	led = devm_kzalloc(&client->dev, sizeof(*led), GFP_KERNEL);
	if (!led)
		return -ENOMEM;

	child_node = of_get_next_available_child(np, NULL);
	if (!child_node) {
		dev_err(&client->dev, "No LED function defined\n");
		return -EINVAL;
	}

	ret = devm_regulator_get_enable_optional(&client->dev, "vled");
	if (ret && ret != -ENODEV)
		return dev_err_probe(&client->dev, ret, "Failed to enable vled regulator\n");

	enable_gpio = devm_gpiod_get_optional(&client->dev, "enable", GPIOD_OUT_HIGH);
	if (IS_ERR(enable_gpio))
		return dev_err_probe(&client->dev, PTR_ERR(enable_gpio),
				     "Failed to get enable GPIO\n");

	ret = devm_add_action_or_reset(&client->dev, lp8864_disable_gpio, enable_gpio);
	if (ret)
		return ret;

	led->client = client;
	led->led_dev.brightness_set_blocking = lp8864_brightness_set;
	led->led_dev.brightness_get = lp8864_brightness_get;

	led->regmap = devm_regmap_init_i2c(client, &lp8864_regmap_config);
	if (IS_ERR(led->regmap))
		return dev_err_probe(&client->dev, PTR_ERR(led->regmap),
				     "Failed to allocate regmap\n");

	/* Control brightness by DISPLAY_BRT register */
	ret = regmap_update_bits(led->regmap, LP8864_USER_CONFIG1, LP8864_BRT_MODE_MASK,
								   LP8864_BRT_MODE_REG);
	if (ret) {
		dev_err(&led->client->dev, "Failed to set brightness control mode\n");
		return ret;
	}

	ret = lp8864_fault_check(led);
	if (ret)
		return ret;

	init_data.fwnode = of_fwnode_handle(child_node);
	init_data.devicename = "lp8864";
	init_data.default_label = ":display_cluster";

	ret = devm_led_classdev_register_ext(&client->dev, &led->led_dev, &init_data);
	if (ret)
		dev_err(&client->dev, "Failed to register LED device (%pe)\n", ERR_PTR(ret));

	return ret;
}

static const struct i2c_device_id lp8864_id[] = {
	{ "lp8864" },
	{}
};
MODULE_DEVICE_TABLE(i2c, lp8864_id);

static const struct of_device_id of_lp8864_leds_match[] = {
	{ .compatible = "ti,lp8864" },
	{}
};
MODULE_DEVICE_TABLE(of, of_lp8864_leds_match);

static struct i2c_driver lp8864_driver = {
	.driver = {
		.name	= "lp8864",
		.of_match_table = of_lp8864_leds_match,
	},
	.probe		= lp8864_probe,
	.id_table	= lp8864_id,
};
module_i2c_driver(lp8864_driver);

MODULE_DESCRIPTION("Texas Instruments LP8864/LP8866 LED driver");
MODULE_AUTHOR("Alexander Sverdlin <alexander.sverdlin@siemens.com>");
MODULE_LICENSE("GPL");