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
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) //
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3) // MP8867/MP8869 regulator driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4) //
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5) // Copyright (C) 2020 Synaptics Incorporated
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6) //
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) // Author: Jisheng Zhang <jszhang@kernel.org>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include <linux/gpio/consumer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/i2c.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/of_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <linux/regmap.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include <linux/regulator/driver.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <linux/regulator/of_regulator.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #define MP886X_VSEL		0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #define  MP886X_V_BOOT		(1 << 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #define MP886X_SYSCNTLREG1	0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #define  MP886X_MODE		(1 << 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #define  MP886X_SLEW_SHIFT	3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #define  MP886X_SLEW_MASK	(0x7 << MP886X_SLEW_SHIFT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #define  MP886X_GO		(1 << 6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) #define  MP886X_EN		(1 << 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) #define MP8869_SYSCNTLREG2	0x02
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) struct mp886x_cfg_info {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 	const struct regulator_ops *rops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) 	const int slew_rates[8];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 	const int switch_freq[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 	const u8 fs_reg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 	const u8 fs_shift;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) struct mp886x_device_info {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 	struct device *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 	struct regulator_desc desc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 	struct regulator_init_data *regulator;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 	struct gpio_desc *en_gpio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	const struct mp886x_cfg_info *ci;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 	u32 r[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 	unsigned int sel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) static int mp886x_set_ramp(struct regulator_dev *rdev, int ramp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 	struct mp886x_device_info *di = rdev_get_drvdata(rdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 	const struct mp886x_cfg_info *ci = di->ci;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 	int reg = -1, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 	for (i = 0; i < ARRAY_SIZE(ci->slew_rates); i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 		if (ramp <= ci->slew_rates[i])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 			reg = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 		else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 	if (reg < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 		dev_err(di->dev, "unsupported ramp value %d\n", ramp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 		return -EINVAL;
^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) 	return regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 				  MP886X_SLEW_MASK, reg << MP886X_SLEW_SHIFT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) static void mp886x_set_switch_freq(struct mp886x_device_info *di,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 				   struct regmap *regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 				   u32 freq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	const struct mp886x_cfg_info *ci = di->ci;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 	for (i = 0; i < ARRAY_SIZE(ci->switch_freq); i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 		if (freq == ci->switch_freq[i]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 			regmap_update_bits(regmap, ci->fs_reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 				  0x3 << ci->fs_shift, i << ci->fs_shift);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 			return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 	dev_err(di->dev, "invalid frequency %d\n", freq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) static int mp886x_set_mode(struct regulator_dev *rdev, unsigned int mode)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 	switch (mode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 	case REGULATOR_MODE_FAST:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 		regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 				   MP886X_MODE, MP886X_MODE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	case REGULATOR_MODE_NORMAL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 		regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 				   MP886X_MODE, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) static unsigned int mp886x_get_mode(struct regulator_dev *rdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 	u32 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 	ret = regmap_read(rdev->regmap, MP886X_SYSCNTLREG1, &val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 	if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	if (val & MP886X_MODE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 		return REGULATOR_MODE_FAST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 		return REGULATOR_MODE_NORMAL;
^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) static int mp8869_set_voltage_sel(struct regulator_dev *rdev, unsigned int sel)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 	ret = regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 				 MP886X_GO, MP886X_GO);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 	if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 	sel <<= ffs(rdev->desc->vsel_mask) - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 	return regmap_update_bits(rdev->regmap, rdev->desc->vsel_reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 				  MP886X_V_BOOT | rdev->desc->vsel_mask, sel);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) static inline unsigned int mp8869_scale(unsigned int uv, u32 r1, u32 r2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 	u32 tmp = uv * r1 / r2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 	return uv + tmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) static int mp8869_get_voltage_sel(struct regulator_dev *rdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 	struct mp886x_device_info *di = rdev_get_drvdata(rdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 	int ret, uv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 	unsigned int val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 	bool fbloop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 	ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 	fbloop = val & MP886X_V_BOOT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 	if (fbloop) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 		uv = rdev->desc->min_uV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 		uv = mp8869_scale(uv, di->r[0], di->r[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 		return regulator_map_voltage_linear(rdev, uv, uv);
^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) 	val &= rdev->desc->vsel_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 	val >>= ffs(rdev->desc->vsel_mask) - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 	return val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) static const struct regulator_ops mp8869_regulator_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 	.set_voltage_sel = mp8869_set_voltage_sel,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 	.get_voltage_sel = mp8869_get_voltage_sel,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 	.set_voltage_time_sel = regulator_set_voltage_time_sel,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 	.map_voltage = regulator_map_voltage_linear,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 	.list_voltage = regulator_list_voltage_linear,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 	.enable = regulator_enable_regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 	.disable = regulator_disable_regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	.is_enabled = regulator_is_enabled_regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 	.set_mode = mp886x_set_mode,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 	.get_mode = mp886x_get_mode,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 	.set_ramp_delay = mp886x_set_ramp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) static const struct mp886x_cfg_info mp8869_ci = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 	.rops = &mp8869_regulator_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 	.slew_rates = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 		40000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 		30000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 		20000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 		10000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 		5000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 		2500,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 		1250,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 		625,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 	.switch_freq = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 		500000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 		750000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 		1000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 		1250000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 	.fs_reg = MP8869_SYSCNTLREG2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 	.fs_shift = 4,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) static int mp8867_set_voltage_sel(struct regulator_dev *rdev, unsigned int sel)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 	struct mp886x_device_info *di = rdev_get_drvdata(rdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 	int ret, delta;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 	ret = mp8869_set_voltage_sel(rdev, sel);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 	if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 	delta = di->sel - sel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 	if (abs(delta) <= 5)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 		ret = regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 					 MP886X_GO, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 	di->sel = sel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 
^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) static int mp8867_get_voltage_sel(struct regulator_dev *rdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 	struct mp886x_device_info *di = rdev_get_drvdata(rdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 	int ret, uv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 	unsigned int val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 	bool fbloop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 	ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 	fbloop = val & MP886X_V_BOOT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 	val &= rdev->desc->vsel_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 	val >>= ffs(rdev->desc->vsel_mask) - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 	if (fbloop) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 		uv = regulator_list_voltage_linear(rdev, val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 		uv = mp8869_scale(uv, di->r[0], di->r[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 		return regulator_map_voltage_linear(rdev, uv, uv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 	return val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) static const struct regulator_ops mp8867_regulator_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 	.set_voltage_sel = mp8867_set_voltage_sel,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 	.get_voltage_sel = mp8867_get_voltage_sel,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 	.set_voltage_time_sel = regulator_set_voltage_time_sel,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 	.map_voltage = regulator_map_voltage_linear,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 	.list_voltage = regulator_list_voltage_linear,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 	.enable = regulator_enable_regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 	.disable = regulator_disable_regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 	.is_enabled = regulator_is_enabled_regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 	.set_mode = mp886x_set_mode,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 	.get_mode = mp886x_get_mode,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 	.set_ramp_delay = mp886x_set_ramp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) static const struct mp886x_cfg_info mp8867_ci = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 	.rops = &mp8867_regulator_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 	.slew_rates = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 		64000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 		32000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 		16000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 		8000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 		4000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 		2000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 		1000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 		500,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 	.switch_freq = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 		500000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 		750000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 		1000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 		1500000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 	.fs_reg = MP886X_SYSCNTLREG1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 	.fs_shift = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) static int mp886x_regulator_register(struct mp886x_device_info *di,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 				     struct regulator_config *config)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 	struct regulator_desc *rdesc = &di->desc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 	struct regulator_dev *rdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 	rdesc->name = "mp886x-reg";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 	rdesc->supply_name = "vin";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 	rdesc->ops = di->ci->rops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 	rdesc->type = REGULATOR_VOLTAGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 	rdesc->n_voltages = 128;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 	rdesc->enable_reg = MP886X_SYSCNTLREG1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 	rdesc->enable_mask = MP886X_EN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 	rdesc->min_uV = 600000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 	rdesc->uV_step = 10000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 	rdesc->vsel_reg = MP886X_VSEL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) 	rdesc->vsel_mask = 0x3f;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 	rdesc->owner = THIS_MODULE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 	rdev = devm_regulator_register(di->dev, &di->desc, config);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 	if (IS_ERR(rdev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 		return PTR_ERR(rdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 	di->sel = rdesc->ops->get_voltage_sel(rdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) static const struct regmap_config mp886x_regmap_config = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 	.reg_bits = 8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 	.val_bits = 8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) static int mp886x_i2c_probe(struct i2c_client *client)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 	struct device *dev = &client->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 	struct device_node *np = dev->of_node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 	struct mp886x_device_info *di;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 	struct regulator_config config = { };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) 	struct regmap *regmap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) 	u32 freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 	di = devm_kzalloc(dev, sizeof(struct mp886x_device_info), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 	if (!di)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) 	di->regulator = of_get_regulator_init_data(dev, np, &di->desc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 	if (!di->regulator) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) 		dev_err(dev, "Platform data not found!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) 		return -EINVAL;
^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) 	ret = of_property_read_u32_array(np, "mps,fb-voltage-divider",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 					 di->r, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) 	di->en_gpio = devm_gpiod_get(dev, "enable", GPIOD_OUT_HIGH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) 	if (IS_ERR(di->en_gpio))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) 		return PTR_ERR(di->en_gpio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 	di->ci = of_device_get_match_data(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) 	di->dev = dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) 	regmap = devm_regmap_init_i2c(client, &mp886x_regmap_config);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 	if (IS_ERR(regmap)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) 		dev_err(dev, "Failed to allocate regmap!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) 		return PTR_ERR(regmap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) 	i2c_set_clientdata(client, di);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) 	config.dev = di->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) 	config.init_data = di->regulator;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) 	config.regmap = regmap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) 	config.driver_data = di;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) 	config.of_node = np;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) 	if (!of_property_read_u32(np, "mps,switch-frequency-hz", &freq))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) 		mp886x_set_switch_freq(di, regmap, freq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) 	ret = mp886x_regulator_register(di, &config);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) 	if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) 		dev_err(dev, "Failed to register regulator!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) static const struct of_device_id mp886x_dt_ids[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) 	{
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) 		.compatible = "mps,mp8867",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) 		.data = &mp8867_ci
^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) 		.compatible = "mps,mp8869",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) 		.data = &mp8869_ci
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) 	{ }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) MODULE_DEVICE_TABLE(of, mp886x_dt_ids);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) static const struct i2c_device_id mp886x_id[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) 	{ "mp886x", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) 	{ },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) MODULE_DEVICE_TABLE(i2c, mp886x_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) static struct i2c_driver mp886x_regulator_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) 	.driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) 		.name = "mp886x-regulator",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) 		.of_match_table = of_match_ptr(mp886x_dt_ids),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) 	.probe_new = mp886x_i2c_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) 	.id_table = mp886x_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) module_i2c_driver(mp886x_regulator_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) MODULE_AUTHOR("Jisheng Zhang <jszhang@kernel.org>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) MODULE_DESCRIPTION("MP886x regulator driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) MODULE_LICENSE("GPL v2");