1 // SPDX-License-Identifier: GPL-2.0
2 //
3 // Copyright (c) 2021 MediaTek Inc.
4 
5 #include <linux/module.h>
6 #include <linux/of_device.h>
7 #include <linux/regmap.h>
8 #include <linux/regulator/driver.h>
9 #include <linux/regulator/machine.h>
10 #include <linux/regulator/mt6315-regulator.h>
11 #include <linux/regulator/of_regulator.h>
12 #include <linux/spmi.h>
13 
14 #define MT6315_BUCK_MODE_AUTO		0
15 #define MT6315_BUCK_MODE_FORCE_PWM	1
16 #define MT6315_BUCK_MODE_LP		2
17 
18 struct mt6315_regulator_info {
19 	struct regulator_desc desc;
20 	u32 status_reg;
21 	u32 lp_mode_mask;
22 	u32 lp_mode_shift;
23 };
24 
25 struct mt_regulator_init_data {
26 	u32 modeset_mask[MT6315_VBUCK_MAX];
27 };
28 
29 struct mt6315_chip {
30 	struct device *dev;
31 	struct regmap *regmap;
32 };
33 
34 #define MT_BUCK(_name, _bid, _vsel)				\
35 [_bid] = {							\
36 	.desc = {						\
37 		.name = _name,					\
38 		.of_match = of_match_ptr(_name),		\
39 		.regulators_node = "regulators",		\
40 		.ops = &mt6315_volt_range_ops,			\
41 		.type = REGULATOR_VOLTAGE,			\
42 		.id = _bid,					\
43 		.owner = THIS_MODULE,				\
44 		.n_voltages = 0xc0,				\
45 		.linear_ranges = mt_volt_range1,		\
46 		.n_linear_ranges = ARRAY_SIZE(mt_volt_range1),	\
47 		.vsel_reg = _vsel,				\
48 		.vsel_mask = 0xff,				\
49 		.enable_reg = MT6315_BUCK_TOP_CON0,		\
50 		.enable_mask = BIT(_bid),			\
51 		.of_map_mode = mt6315_map_mode,			\
52 	},							\
53 	.status_reg = _bid##_DBG4,				\
54 	.lp_mode_mask = BIT(_bid),				\
55 	.lp_mode_shift = _bid,					\
56 }
57 
58 static const struct linear_range mt_volt_range1[] = {
59 	REGULATOR_LINEAR_RANGE(0, 0, 0xbf, 6250),
60 };
61 
mt6315_map_mode(unsigned int mode)62 static unsigned int mt6315_map_mode(unsigned int mode)
63 {
64 	switch (mode) {
65 	case MT6315_BUCK_MODE_AUTO:
66 		return REGULATOR_MODE_NORMAL;
67 	case MT6315_BUCK_MODE_FORCE_PWM:
68 		return REGULATOR_MODE_FAST;
69 	case MT6315_BUCK_MODE_LP:
70 		return REGULATOR_MODE_IDLE;
71 	default:
72 		return REGULATOR_MODE_INVALID;
73 	}
74 }
75 
mt6315_regulator_get_mode(struct regulator_dev * rdev)76 static unsigned int mt6315_regulator_get_mode(struct regulator_dev *rdev)
77 {
78 	struct mt_regulator_init_data *init = rdev_get_drvdata(rdev);
79 	const struct mt6315_regulator_info *info;
80 	int ret, regval;
81 	u32 modeset_mask;
82 
83 	info = container_of(rdev->desc, struct mt6315_regulator_info, desc);
84 	modeset_mask = init->modeset_mask[rdev_get_id(rdev)];
85 	ret = regmap_read(rdev->regmap, MT6315_BUCK_TOP_4PHASE_ANA_CON42, &regval);
86 	if (ret != 0) {
87 		dev_err(&rdev->dev, "Failed to get mode: %d\n", ret);
88 		return ret;
89 	}
90 
91 	if ((regval & modeset_mask) == modeset_mask)
92 		return REGULATOR_MODE_FAST;
93 
94 	ret = regmap_read(rdev->regmap, MT6315_BUCK_TOP_CON1, &regval);
95 	if (ret != 0) {
96 		dev_err(&rdev->dev, "Failed to get lp mode: %d\n", ret);
97 		return ret;
98 	}
99 
100 	if (regval & info->lp_mode_mask)
101 		return REGULATOR_MODE_IDLE;
102 	else
103 		return REGULATOR_MODE_NORMAL;
104 }
105 
mt6315_regulator_set_mode(struct regulator_dev * rdev,u32 mode)106 static int mt6315_regulator_set_mode(struct regulator_dev *rdev,
107 				     u32 mode)
108 {
109 	struct mt_regulator_init_data *init = rdev_get_drvdata(rdev);
110 	const struct mt6315_regulator_info *info;
111 	int ret, val, curr_mode;
112 	u32 modeset_mask;
113 
114 	info = container_of(rdev->desc, struct mt6315_regulator_info, desc);
115 	modeset_mask = init->modeset_mask[rdev_get_id(rdev)];
116 	curr_mode = mt6315_regulator_get_mode(rdev);
117 	switch (mode) {
118 	case REGULATOR_MODE_FAST:
119 		ret = regmap_update_bits(rdev->regmap,
120 					 MT6315_BUCK_TOP_4PHASE_ANA_CON42,
121 					 modeset_mask,
122 					 modeset_mask);
123 		break;
124 	case REGULATOR_MODE_NORMAL:
125 		if (curr_mode == REGULATOR_MODE_FAST) {
126 			ret = regmap_update_bits(rdev->regmap,
127 						 MT6315_BUCK_TOP_4PHASE_ANA_CON42,
128 						 modeset_mask,
129 						 0);
130 		} else if (curr_mode == REGULATOR_MODE_IDLE) {
131 			ret = regmap_update_bits(rdev->regmap,
132 						 MT6315_BUCK_TOP_CON1,
133 						 info->lp_mode_mask,
134 						 0);
135 			usleep_range(100, 110);
136 		} else {
137 			ret = -EINVAL;
138 		}
139 		break;
140 	case REGULATOR_MODE_IDLE:
141 		val = MT6315_BUCK_MODE_LP >> 1;
142 		val <<= info->lp_mode_shift;
143 		ret = regmap_update_bits(rdev->regmap,
144 					 MT6315_BUCK_TOP_CON1,
145 					 info->lp_mode_mask,
146 					 val);
147 		break;
148 	default:
149 		ret = -EINVAL;
150 		dev_err(&rdev->dev, "Unsupported mode: %d\n", mode);
151 		break;
152 	}
153 
154 	if (ret != 0) {
155 		dev_err(&rdev->dev, "Failed to set mode: %d\n", ret);
156 		return ret;
157 	}
158 
159 	return 0;
160 }
161 
mt6315_get_status(struct regulator_dev * rdev)162 static int mt6315_get_status(struct regulator_dev *rdev)
163 {
164 	const struct mt6315_regulator_info *info;
165 	int ret;
166 	u32 regval;
167 
168 	info = container_of(rdev->desc, struct mt6315_regulator_info, desc);
169 	ret = regmap_read(rdev->regmap, info->status_reg, &regval);
170 	if (ret < 0) {
171 		dev_err(&rdev->dev, "Failed to get enable reg: %d\n", ret);
172 		return ret;
173 	}
174 
175 	return (regval & BIT(0)) ? REGULATOR_STATUS_ON : REGULATOR_STATUS_OFF;
176 }
177 
178 static const struct regulator_ops mt6315_volt_range_ops = {
179 	.list_voltage = regulator_list_voltage_linear_range,
180 	.map_voltage = regulator_map_voltage_linear_range,
181 	.set_voltage_sel = regulator_set_voltage_sel_regmap,
182 	.get_voltage_sel = regulator_get_voltage_sel_regmap,
183 	.set_voltage_time_sel = regulator_set_voltage_time_sel,
184 	.enable = regulator_enable_regmap,
185 	.disable = regulator_disable_regmap,
186 	.is_enabled = regulator_is_enabled_regmap,
187 	.get_status = mt6315_get_status,
188 	.set_mode = mt6315_regulator_set_mode,
189 	.get_mode = mt6315_regulator_get_mode,
190 };
191 
192 static const struct mt6315_regulator_info mt6315_regulators[MT6315_VBUCK_MAX] = {
193 	MT_BUCK("vbuck1", MT6315_VBUCK1, MT6315_BUCK_TOP_ELR0),
194 	MT_BUCK("vbuck2", MT6315_VBUCK2, MT6315_BUCK_TOP_ELR2),
195 	MT_BUCK("vbuck3", MT6315_VBUCK3, MT6315_BUCK_TOP_ELR4),
196 	MT_BUCK("vbuck4", MT6315_VBUCK4, MT6315_BUCK_TOP_ELR6),
197 };
198 
199 static const struct regmap_config mt6315_regmap_config = {
200 	.reg_bits	= 16,
201 	.val_bits	= 8,
202 	.max_register	= 0x16d0,
203 	.fast_io	= true,
204 };
205 
206 static const struct of_device_id mt6315_of_match[] = {
207 	{
208 		.compatible = "mediatek,mt6315-regulator",
209 	}, {
210 		/* sentinel */
211 	},
212 };
213 MODULE_DEVICE_TABLE(of, mt6315_of_match);
214 
mt6315_regulator_probe(struct spmi_device * pdev)215 static int mt6315_regulator_probe(struct spmi_device *pdev)
216 {
217 	struct device *dev = &pdev->dev;
218 	struct regmap *regmap;
219 	struct mt6315_chip *chip;
220 	struct mt_regulator_init_data *init_data;
221 	struct regulator_config config = {};
222 	struct regulator_dev *rdev;
223 	int i;
224 
225 	regmap = devm_regmap_init_spmi_ext(pdev, &mt6315_regmap_config);
226 	if (IS_ERR(regmap))
227 		return PTR_ERR(regmap);
228 
229 	chip = devm_kzalloc(dev, sizeof(struct mt6315_chip), GFP_KERNEL);
230 	if (!chip)
231 		return -ENOMEM;
232 
233 	init_data = devm_kzalloc(dev, sizeof(struct mt_regulator_init_data), GFP_KERNEL);
234 	if (!init_data)
235 		return -ENOMEM;
236 
237 	switch (pdev->usid) {
238 	case MT6315_PP:
239 		init_data->modeset_mask[MT6315_VBUCK1] = BIT(MT6315_VBUCK1) | BIT(MT6315_VBUCK2) |
240 							 BIT(MT6315_VBUCK4);
241 		break;
242 	case MT6315_SP:
243 	case MT6315_RP:
244 		init_data->modeset_mask[MT6315_VBUCK1] = BIT(MT6315_VBUCK1) | BIT(MT6315_VBUCK2);
245 		break;
246 	default:
247 		init_data->modeset_mask[MT6315_VBUCK1] = BIT(MT6315_VBUCK1);
248 		break;
249 	}
250 	for (i = MT6315_VBUCK2; i < MT6315_VBUCK_MAX; i++)
251 		init_data->modeset_mask[i] = BIT(i);
252 
253 	chip->dev = dev;
254 	chip->regmap = regmap;
255 	dev_set_drvdata(dev, chip);
256 
257 	config.dev = dev;
258 	config.regmap = regmap;
259 	for (i = MT6315_VBUCK1; i < MT6315_VBUCK_MAX; i++) {
260 		config.driver_data = init_data;
261 		rdev = devm_regulator_register(dev, &mt6315_regulators[i].desc, &config);
262 		if (IS_ERR(rdev)) {
263 			dev_err(dev, "Failed to register %s\n",
264 				mt6315_regulators[i].desc.name);
265 			return PTR_ERR(rdev);
266 		}
267 	}
268 
269 	return 0;
270 }
271 
mt6315_regulator_shutdown(struct spmi_device * pdev)272 static void mt6315_regulator_shutdown(struct spmi_device *pdev)
273 {
274 	struct mt6315_chip *chip = dev_get_drvdata(&pdev->dev);
275 	int ret = 0;
276 
277 	ret |= regmap_write(chip->regmap, MT6315_TOP_TMA_KEY_H, PROTECTION_KEY_H);
278 	ret |= regmap_write(chip->regmap, MT6315_TOP_TMA_KEY, PROTECTION_KEY);
279 	ret |= regmap_update_bits(chip->regmap, MT6315_TOP2_ELR7, 1, 1);
280 	ret |= regmap_write(chip->regmap, MT6315_TOP_TMA_KEY, 0);
281 	ret |= regmap_write(chip->regmap, MT6315_TOP_TMA_KEY_H, 0);
282 	if (ret < 0)
283 		dev_err(&pdev->dev, "[%#x] Failed to enable power off sequence. %d\n",
284 			   pdev->usid, ret);
285 }
286 
287 static struct spmi_driver mt6315_regulator_driver = {
288 	.driver		= {
289 		.name	= "mt6315-regulator",
290 		.of_match_table = mt6315_of_match,
291 	},
292 	.probe = mt6315_regulator_probe,
293 	.shutdown = mt6315_regulator_shutdown,
294 };
295 
296 module_spmi_driver(mt6315_regulator_driver);
297 
298 MODULE_AUTHOR("Hsin-Hsiung Wang <hsin-hsiung.wang@mediatek.com>");
299 MODULE_DESCRIPTION("Regulator Driver for MediaTek MT6315 PMIC");
300 MODULE_LICENSE("GPL");
301