215 lines · 5.3 KB · C
RawDownload
// SPDX-License-Identifier: GPL-2.0-only/* * Copyright (C) 2023 Richtek Technology Corp. * * Author: ChiYuan Huang <cy_huang@richtek.com> */ #include <linux/i2c.h>#include <linux/kernel.h>#include <linux/module.h>#include <linux/property.h>#include <linux/regmap.h>#include <linux/regulator/driver.h>#include <linux/regulator/of_regulator.h> #define RT4803_AUTO_MODE	1#define RT4803_FPWM_MODE	2 #define RT4803_REG_CONFIG	0x01#define RT4803_REG_VSELL	0x02#define RT4803_REG_VSELH	0x03#define RT4803_REG_ILIM		0x04#define RT4803_REG_STAT		0x05 #define RT4803_MODE_MASK	GENMASK(1, 0)#define RT4803_VSEL_MASK	GENMASK(4, 0)#define RT4803_ILIM_MASK	GENMASK(3, 0)#define RT4803_TSD_MASK		BIT(7)#define RT4803_HOTDIE_MASK	BIT(6)#define RT4803_FAULT_MASK	BIT(1)#define RT4803_PGOOD_MASK	BIT(0) #define RT4803_VOUT_MINUV	2850000#define RT4803_VOUT_STEPUV	50000#define RT4803_VOUT_NUM		32 static int rt4803_set_mode(struct regulator_dev *rdev, unsigned int mode){	struct regmap *regmap = rdev_get_regmap(rdev);	unsigned int modeval; 	switch (mode) {	case REGULATOR_MODE_NORMAL:		modeval = RT4803_AUTO_MODE;		break;	case REGULATOR_MODE_FAST:		modeval = RT4803_FPWM_MODE;		break;	default:		return -EINVAL;	} 	modeval <<= ffs(RT4803_MODE_MASK) - 1; 	return regmap_update_bits(regmap, RT4803_REG_CONFIG, RT4803_MODE_MASK, modeval);} static unsigned int rt4803_get_mode(struct regulator_dev *rdev){	struct regmap *regmap = rdev_get_regmap(rdev);	unsigned int modeval;	int ret; 	ret = regmap_read(regmap, RT4803_REG_CONFIG, &modeval);	if (ret)		return REGULATOR_MODE_INVALID; 	modeval >>= ffs(RT4803_MODE_MASK) - 1; 	switch (modeval) {	case RT4803_AUTO_MODE:		return REGULATOR_MODE_NORMAL;	case RT4803_FPWM_MODE:		return REGULATOR_MODE_FAST;	default:		return REGULATOR_MODE_INVALID;	}} static int rt4803_get_error_flags(struct regulator_dev *rdev, unsigned int *flags){	struct regmap *regmap = rdev_get_regmap(rdev);	unsigned int state, events = 0;	int ret; 	ret = regmap_read(regmap, RT4803_REG_STAT, &state);	if (ret)		return ret; 	if (state & RT4803_PGOOD_MASK)		goto out_error_flag; 	if (state & RT4803_FAULT_MASK)		events |= REGULATOR_ERROR_FAIL; 	if (state & RT4803_HOTDIE_MASK)		events |= REGULATOR_ERROR_OVER_TEMP_WARN; 	if (state & RT4803_TSD_MASK)		events |= REGULATOR_ERROR_OVER_TEMP; out_error_flag:	*flags = events;	return 0;} static int rt4803_set_suspend_voltage(struct regulator_dev *rdev, int uV){	struct regmap *regmap = rdev_get_regmap(rdev);	unsigned int reg, vsel; 	if (rdev->desc->vsel_reg == RT4803_REG_VSELL)		reg = RT4803_REG_VSELH;	else		reg = RT4803_REG_VSELL; 	vsel = (uV - rdev->desc->min_uV) / rdev->desc->uV_step;	vsel <<= ffs(RT4803_VSEL_MASK) - 1; 	return regmap_update_bits(regmap, reg, RT4803_VSEL_MASK, vsel);} static const struct regulator_ops rt4803_regulator_ops = {	.list_voltage = regulator_list_voltage_linear,	.set_voltage_sel = regulator_set_voltage_sel_regmap,	.get_voltage_sel = regulator_get_voltage_sel_regmap,	.set_mode = rt4803_set_mode,	.get_mode = rt4803_get_mode,	.get_error_flags = rt4803_get_error_flags,	.set_suspend_voltage = rt4803_set_suspend_voltage,}; static unsigned int rt4803_of_map_mode(unsigned int mode){	switch (mode) {	case RT4803_AUTO_MODE:		return REGULATOR_MODE_NORMAL;	case RT4803_FPWM_MODE:		return REGULATOR_MODE_FAST;	default:		return REGULATOR_MODE_INVALID;	}} static const struct regmap_config rt4803_regmap_config = {	.reg_bits = 8,	.val_bits = 8,	.max_register = RT4803_REG_STAT,}; static int rt4803_probe(struct i2c_client *i2c){	struct device *dev = &i2c->dev;	struct regmap *regmap;	struct regulator_desc *desc;	struct regulator_config cfg = {};	struct regulator_dev *rdev;	bool vsel_act_high;	int ret; 	desc = devm_kzalloc(dev, sizeof(*desc), GFP_KERNEL);	if (!desc)		return -ENOMEM; 	regmap = devm_regmap_init_i2c(i2c, &rt4803_regmap_config);	if (IS_ERR(regmap))		return dev_err_probe(dev, PTR_ERR(regmap), "Failed to init regmap\n"); 	/* Always configure the input current limit to max 5A at initial */	ret = regmap_update_bits(regmap, RT4803_REG_ILIM, RT4803_ILIM_MASK, 0xff);	if (ret)		return dev_err_probe(dev, ret, "Failed to config ILIM to max\n"); 	vsel_act_high = device_property_read_bool(dev, "richtek,vsel-active-high"); 	desc->name = "rt4803-regulator";	desc->type = REGULATOR_VOLTAGE;	desc->owner = THIS_MODULE;	desc->ops = &rt4803_regulator_ops;	desc->min_uV = RT4803_VOUT_MINUV;	desc->uV_step = RT4803_VOUT_STEPUV;	desc->n_voltages = RT4803_VOUT_NUM;	desc->vsel_mask = RT4803_VSEL_MASK;	desc->of_map_mode = rt4803_of_map_mode;	if (vsel_act_high)		desc->vsel_reg = RT4803_REG_VSELH;	else		desc->vsel_reg = RT4803_REG_VSELL; 	cfg.dev = dev;	cfg.of_node = dev_of_node(dev);	cfg.init_data = of_get_regulator_init_data(dev, dev_of_node(dev), desc); 	rdev = devm_regulator_register(dev, desc, &cfg);	return PTR_ERR_OR_ZERO(rdev);} static const struct of_device_id rt4803_device_match_table[] = {	{ .compatible = "richtek,rt4803" },	{}};MODULE_DEVICE_TABLE(of, rt4803_device_match_table); static struct i2c_driver rt4803_driver = {	.driver = {		.name = "rt4803",		.of_match_table = rt4803_device_match_table,	},	.probe = rt4803_probe,};module_i2c_driver(rt4803_driver); MODULE_DESCRIPTION("Richtek RT4803 voltage regulator driver");MODULE_AUTHOR("ChiYuan Huang <cy_huang@richtek.com>");MODULE_LICENSE("GPL");