Linux Audio

Check our new training course

Loading...
v6.2
  1// SPDX-License-Identifier: GPL-2.0
  2//
  3// Copyright (c) 2014 MediaTek Inc.
  4// Author: Flora Fu <flora.fu@mediatek.com>
 
 
 
 
 
 
 
 
 
  5
  6#include <linux/module.h>
  7#include <linux/of.h>
  8#include <linux/platform_device.h>
  9#include <linux/regmap.h>
 10#include <linux/mfd/mt6397/core.h>
 11#include <linux/mfd/mt6397/registers.h>
 12#include <linux/regulator/driver.h>
 13#include <linux/regulator/machine.h>
 14#include <linux/regulator/mt6397-regulator.h>
 15#include <linux/regulator/of_regulator.h>
 16#include <dt-bindings/regulator/mediatek,mt6397-regulator.h>
 17
 18/*
 19 * MT6397 regulators' information
 20 *
 21 * @desc: standard fields of regulator description.
 22 * @qi: Mask for query enable signal status of regulators
 23 * @vselon_reg: Register sections for hardware control mode of bucks
 24 * @vselctrl_reg: Register for controlling the buck control mode.
 25 * @vselctrl_mask: Mask for query buck's voltage control mode.
 26 */
 27struct mt6397_regulator_info {
 28	struct regulator_desc desc;
 29	u32 qi;
 30	u32 vselon_reg;
 31	u32 vselctrl_reg;
 32	u32 vselctrl_mask;
 33	u32 modeset_reg;
 34	u32 modeset_mask;
 35};
 36
 37#define MT6397_BUCK(match, vreg, min, max, step, volt_ranges, enreg,	\
 38		vosel, vosel_mask, voselon, vosel_ctrl, _modeset_reg,	\
 39		_modeset_shift)					\
 40[MT6397_ID_##vreg] = {							\
 41	.desc = {							\
 42		.name = #vreg,						\
 43		.of_match = of_match_ptr(match),			\
 44		.ops = &mt6397_volt_range_ops,				\
 45		.type = REGULATOR_VOLTAGE,				\
 46		.id = MT6397_ID_##vreg,					\
 47		.owner = THIS_MODULE,					\
 48		.n_voltages = (max - min)/step + 1,			\
 49		.linear_ranges = volt_ranges,				\
 50		.n_linear_ranges = ARRAY_SIZE(volt_ranges),		\
 51		.vsel_reg = vosel,					\
 52		.vsel_mask = vosel_mask,				\
 53		.enable_reg = enreg,					\
 54		.enable_mask = BIT(0),					\
 55		.of_map_mode = mt6397_map_mode,				\
 56	},								\
 57	.qi = BIT(13),							\
 58	.vselon_reg = voselon,						\
 59	.vselctrl_reg = vosel_ctrl,					\
 60	.vselctrl_mask = BIT(1),					\
 61	.modeset_reg = _modeset_reg,					\
 62	.modeset_mask = BIT(_modeset_shift),				\
 63}
 64
 65#define MT6397_LDO(match, vreg, ldo_volt_table, enreg, enbit, vosel,	\
 66		vosel_mask)						\
 67[MT6397_ID_##vreg] = {							\
 68	.desc = {							\
 69		.name = #vreg,						\
 70		.of_match = of_match_ptr(match),			\
 71		.ops = &mt6397_volt_table_ops,				\
 72		.type = REGULATOR_VOLTAGE,				\
 73		.id = MT6397_ID_##vreg,					\
 74		.owner = THIS_MODULE,					\
 75		.n_voltages = ARRAY_SIZE(ldo_volt_table),		\
 76		.volt_table = ldo_volt_table,				\
 77		.vsel_reg = vosel,					\
 78		.vsel_mask = vosel_mask,				\
 79		.enable_reg = enreg,					\
 80		.enable_mask = BIT(enbit),				\
 81	},								\
 82	.qi = BIT(15),							\
 83}
 84
 85#define MT6397_REG_FIXED(match, vreg, enreg, enbit, volt)		\
 86[MT6397_ID_##vreg] = {							\
 87	.desc = {							\
 88		.name = #vreg,						\
 89		.of_match = of_match_ptr(match),			\
 90		.ops = &mt6397_volt_fixed_ops,				\
 91		.type = REGULATOR_VOLTAGE,				\
 92		.id = MT6397_ID_##vreg,					\
 93		.owner = THIS_MODULE,					\
 94		.n_voltages = 1,					\
 95		.enable_reg = enreg,					\
 96		.enable_mask = BIT(enbit),				\
 97		.min_uV = volt,						\
 98	},								\
 99	.qi = BIT(15),							\
100}
101
102static const struct linear_range buck_volt_range1[] = {
103	REGULATOR_LINEAR_RANGE(700000, 0, 0x7f, 6250),
104};
105
106static const struct linear_range buck_volt_range2[] = {
107	REGULATOR_LINEAR_RANGE(800000, 0, 0x7f, 6250),
108};
109
110static const struct linear_range buck_volt_range3[] = {
111	REGULATOR_LINEAR_RANGE(1500000, 0, 0x1f, 20000),
112};
113
114static const unsigned int ldo_volt_table1[] = {
115	1500000, 1800000, 2500000, 2800000,
116};
117
118static const unsigned int ldo_volt_table2[] = {
119	1800000, 3300000,
120};
121
122static const unsigned int ldo_volt_table3[] = {
123	3000000, 3300000,
124};
125
126static const unsigned int ldo_volt_table4[] = {
127	1220000, 1300000, 1500000, 1800000, 2500000, 2800000, 3000000, 3300000,
128};
129
130static const unsigned int ldo_volt_table5[] = {
131	1200000, 1300000, 1500000, 1800000, 2500000, 2800000, 3000000, 3300000,
132};
133
134static const unsigned int ldo_volt_table5_v2[] = {
135	1200000, 1000000, 1500000, 1800000, 2500000, 2800000, 3000000, 3300000,
136};
137
138static const unsigned int ldo_volt_table6[] = {
139	1200000, 1300000, 1500000, 1800000, 2500000, 2800000, 3000000, 2000000,
140};
141
142static const unsigned int ldo_volt_table7[] = {
143	1300000, 1500000, 1800000, 2000000, 2500000, 2800000, 3000000, 3300000,
144};
145
146static unsigned int mt6397_map_mode(unsigned int mode)
147{
148	switch (mode) {
149	case MT6397_BUCK_MODE_AUTO:
150		return REGULATOR_MODE_NORMAL;
151	case MT6397_BUCK_MODE_FORCE_PWM:
152		return REGULATOR_MODE_FAST;
153	default:
154		return REGULATOR_MODE_INVALID;
155	}
156}
157
158static int mt6397_regulator_set_mode(struct regulator_dev *rdev,
159				     unsigned int mode)
160{
161	struct mt6397_regulator_info *info = rdev_get_drvdata(rdev);
162	int ret, val;
163
164	switch (mode) {
165	case REGULATOR_MODE_FAST:
166		val = MT6397_BUCK_MODE_FORCE_PWM;
167		break;
168	case REGULATOR_MODE_NORMAL:
169		val = MT6397_BUCK_MODE_AUTO;
170		break;
171	default:
172		ret = -EINVAL;
173		goto err_mode;
174	}
175
176	dev_dbg(&rdev->dev, "mt6397 buck set_mode %#x, %#x, %#x\n",
177		info->modeset_reg, info->modeset_mask, val);
178
179	val <<= ffs(info->modeset_mask) - 1;
180
181	ret = regmap_update_bits(rdev->regmap, info->modeset_reg,
182				 info->modeset_mask, val);
183err_mode:
184	if (ret != 0) {
185		dev_err(&rdev->dev,
186			"Failed to set mt6397 buck mode: %d\n", ret);
187		return ret;
188	}
189
190	return 0;
191}
192
193static unsigned int mt6397_regulator_get_mode(struct regulator_dev *rdev)
194{
195	struct mt6397_regulator_info *info = rdev_get_drvdata(rdev);
196	int ret, regval;
197
198	ret = regmap_read(rdev->regmap, info->modeset_reg, &regval);
199	if (ret != 0) {
200		dev_err(&rdev->dev,
201			"Failed to get mt6397 buck mode: %d\n", ret);
202		return ret;
203	}
204
205	regval &= info->modeset_mask;
206	regval >>= ffs(info->modeset_mask) - 1;
207
208	switch (regval) {
209	case MT6397_BUCK_MODE_AUTO:
210		return REGULATOR_MODE_NORMAL;
211	case MT6397_BUCK_MODE_FORCE_PWM:
212		return REGULATOR_MODE_FAST;
213	default:
214		return -EINVAL;
215	}
216}
217
218static int mt6397_get_status(struct regulator_dev *rdev)
219{
220	int ret;
221	u32 regval;
222	struct mt6397_regulator_info *info = rdev_get_drvdata(rdev);
223
224	ret = regmap_read(rdev->regmap, info->desc.enable_reg, &regval);
225	if (ret != 0) {
226		dev_err(&rdev->dev, "Failed to get enable reg: %d\n", ret);
227		return ret;
228	}
229
230	return (regval & info->qi) ? REGULATOR_STATUS_ON : REGULATOR_STATUS_OFF;
231}
232
233static const struct regulator_ops mt6397_volt_range_ops = {
234	.list_voltage = regulator_list_voltage_linear_range,
235	.map_voltage = regulator_map_voltage_linear_range,
236	.set_voltage_sel = regulator_set_voltage_sel_regmap,
237	.get_voltage_sel = regulator_get_voltage_sel_regmap,
238	.set_voltage_time_sel = regulator_set_voltage_time_sel,
239	.enable = regulator_enable_regmap,
240	.disable = regulator_disable_regmap,
241	.is_enabled = regulator_is_enabled_regmap,
242	.get_status = mt6397_get_status,
243	.set_mode = mt6397_regulator_set_mode,
244	.get_mode = mt6397_regulator_get_mode,
245};
246
247static const struct regulator_ops mt6397_volt_table_ops = {
248	.list_voltage = regulator_list_voltage_table,
249	.map_voltage = regulator_map_voltage_iterate,
250	.set_voltage_sel = regulator_set_voltage_sel_regmap,
251	.get_voltage_sel = regulator_get_voltage_sel_regmap,
252	.set_voltage_time_sel = regulator_set_voltage_time_sel,
253	.enable = regulator_enable_regmap,
254	.disable = regulator_disable_regmap,
255	.is_enabled = regulator_is_enabled_regmap,
256	.get_status = mt6397_get_status,
257};
258
259static const struct regulator_ops mt6397_volt_fixed_ops = {
260	.list_voltage = regulator_list_voltage_linear,
261	.enable = regulator_enable_regmap,
262	.disable = regulator_disable_regmap,
263	.is_enabled = regulator_is_enabled_regmap,
264	.get_status = mt6397_get_status,
265};
266
267/* The array is indexed by id(MT6397_ID_XXX) */
268static struct mt6397_regulator_info mt6397_regulators[] = {
269	MT6397_BUCK("buck_vpca15", VPCA15, 700000, 1493750, 6250,
270		buck_volt_range1, MT6397_VCA15_CON7, MT6397_VCA15_CON9, 0x7f,
271		MT6397_VCA15_CON10, MT6397_VCA15_CON5, MT6397_VCA15_CON2, 11),
272	MT6397_BUCK("buck_vpca7", VPCA7, 700000, 1493750, 6250,
273		buck_volt_range1, MT6397_VPCA7_CON7, MT6397_VPCA7_CON9, 0x7f,
274		MT6397_VPCA7_CON10, MT6397_VPCA7_CON5, MT6397_VPCA7_CON2, 8),
275	MT6397_BUCK("buck_vsramca15", VSRAMCA15, 700000, 1493750, 6250,
276		buck_volt_range1, MT6397_VSRMCA15_CON7, MT6397_VSRMCA15_CON9,
277		0x7f, MT6397_VSRMCA15_CON10, MT6397_VSRMCA15_CON5,
278		MT6397_VSRMCA15_CON2, 8),
279	MT6397_BUCK("buck_vsramca7", VSRAMCA7, 700000, 1493750, 6250,
280		buck_volt_range1, MT6397_VSRMCA7_CON7, MT6397_VSRMCA7_CON9,
281		0x7f, MT6397_VSRMCA7_CON10, MT6397_VSRMCA7_CON5,
282		MT6397_VSRMCA7_CON2, 8),
283	MT6397_BUCK("buck_vcore", VCORE, 700000, 1493750, 6250,
284		buck_volt_range1, MT6397_VCORE_CON7, MT6397_VCORE_CON9, 0x7f,
285		MT6397_VCORE_CON10, MT6397_VCORE_CON5, MT6397_VCORE_CON2, 8),
286	MT6397_BUCK("buck_vgpu", VGPU, 700000, 1493750, 6250, buck_volt_range1,
287		MT6397_VGPU_CON7, MT6397_VGPU_CON9, 0x7f,
288		MT6397_VGPU_CON10, MT6397_VGPU_CON5, MT6397_VGPU_CON2, 8),
289	MT6397_BUCK("buck_vdrm", VDRM, 800000, 1593750, 6250, buck_volt_range2,
290		MT6397_VDRM_CON7, MT6397_VDRM_CON9, 0x7f,
291		MT6397_VDRM_CON10, MT6397_VDRM_CON5, MT6397_VDRM_CON2, 8),
292	MT6397_BUCK("buck_vio18", VIO18, 1500000, 2120000, 20000,
293		buck_volt_range3, MT6397_VIO18_CON7, MT6397_VIO18_CON9, 0x1f,
294		MT6397_VIO18_CON10, MT6397_VIO18_CON5, MT6397_VIO18_CON2, 8),
295	MT6397_REG_FIXED("ldo_vtcxo", VTCXO, MT6397_ANALDO_CON0, 10, 2800000),
296	MT6397_REG_FIXED("ldo_va28", VA28, MT6397_ANALDO_CON1, 14, 2800000),
297	MT6397_LDO("ldo_vcama", VCAMA, ldo_volt_table1,
298		MT6397_ANALDO_CON2, 15, MT6397_ANALDO_CON6, 0xC0),
299	MT6397_REG_FIXED("ldo_vio28", VIO28, MT6397_DIGLDO_CON0, 14, 2800000),
300	MT6397_REG_FIXED("ldo_vusb", VUSB, MT6397_DIGLDO_CON1, 14, 3300000),
301	MT6397_LDO("ldo_vmc", VMC, ldo_volt_table2,
302		MT6397_DIGLDO_CON2, 12, MT6397_DIGLDO_CON29, 0x10),
303	MT6397_LDO("ldo_vmch", VMCH, ldo_volt_table3,
304		MT6397_DIGLDO_CON3, 14, MT6397_DIGLDO_CON17, 0x80),
305	MT6397_LDO("ldo_vemc3v3", VEMC3V3, ldo_volt_table3,
306		MT6397_DIGLDO_CON4, 14, MT6397_DIGLDO_CON18, 0x10),
307	MT6397_LDO("ldo_vgp1", VGP1, ldo_volt_table4,
308		MT6397_DIGLDO_CON5, 15, MT6397_DIGLDO_CON19, 0xE0),
309	MT6397_LDO("ldo_vgp2", VGP2, ldo_volt_table5,
310		MT6397_DIGLDO_CON6, 15, MT6397_DIGLDO_CON20, 0xE0),
311	MT6397_LDO("ldo_vgp3", VGP3, ldo_volt_table5,
312		MT6397_DIGLDO_CON7, 15, MT6397_DIGLDO_CON21, 0xE0),
313	MT6397_LDO("ldo_vgp4", VGP4, ldo_volt_table5,
314		MT6397_DIGLDO_CON8, 15, MT6397_DIGLDO_CON22, 0xE0),
315	MT6397_LDO("ldo_vgp5", VGP5, ldo_volt_table6,
316		MT6397_DIGLDO_CON9, 15, MT6397_DIGLDO_CON23, 0xE0),
317	MT6397_LDO("ldo_vgp6", VGP6, ldo_volt_table5,
318		MT6397_DIGLDO_CON10, 15, MT6397_DIGLDO_CON33, 0xE0),
319	MT6397_LDO("ldo_vibr", VIBR, ldo_volt_table7,
320		MT6397_DIGLDO_CON24, 15, MT6397_DIGLDO_CON25, 0xE00),
321};
322
323static int mt6397_set_buck_vosel_reg(struct platform_device *pdev)
324{
325	struct mt6397_chip *mt6397 = dev_get_drvdata(pdev->dev.parent);
326	int i;
327	u32 regval;
328
329	for (i = 0; i < MT6397_MAX_REGULATOR; i++) {
330		if (mt6397_regulators[i].vselctrl_reg) {
331			if (regmap_read(mt6397->regmap,
332				mt6397_regulators[i].vselctrl_reg,
333				&regval) < 0) {
334				dev_err(&pdev->dev,
335					"Failed to read buck ctrl\n");
336				return -EIO;
337			}
338
339			if (regval & mt6397_regulators[i].vselctrl_mask) {
340				mt6397_regulators[i].desc.vsel_reg =
341				mt6397_regulators[i].vselon_reg;
342			}
343		}
344	}
345
346	return 0;
347}
348
349static int mt6397_regulator_probe(struct platform_device *pdev)
350{
351	struct mt6397_chip *mt6397 = dev_get_drvdata(pdev->dev.parent);
352	struct regulator_config config = {};
353	struct regulator_dev *rdev;
354	int i;
355	u32 reg_value, version;
356
357	/* Query buck controller to select activated voltage register part */
358	if (mt6397_set_buck_vosel_reg(pdev))
359		return -EIO;
360
361	/* Read PMIC chip revision to update constraints and voltage table */
362	if (regmap_read(mt6397->regmap, MT6397_CID, &reg_value) < 0) {
363		dev_err(&pdev->dev, "Failed to read Chip ID\n");
364		return -EIO;
365	}
366	dev_info(&pdev->dev, "Chip ID = 0x%x\n", reg_value);
367
368	version = (reg_value & 0xFF);
369	switch (version) {
370	case MT6397_REGULATOR_ID91:
371		mt6397_regulators[MT6397_ID_VGP2].desc.volt_table =
372		ldo_volt_table5_v2;
373		break;
374	default:
375		break;
376	}
377
378	for (i = 0; i < MT6397_MAX_REGULATOR; i++) {
379		config.dev = &pdev->dev;
380		config.driver_data = &mt6397_regulators[i];
381		config.regmap = mt6397->regmap;
382		rdev = devm_regulator_register(&pdev->dev,
383				&mt6397_regulators[i].desc, &config);
384		if (IS_ERR(rdev)) {
385			dev_err(&pdev->dev, "failed to register %s\n",
386				mt6397_regulators[i].desc.name);
387			return PTR_ERR(rdev);
388		}
389	}
390
391	return 0;
392}
393
394static const struct platform_device_id mt6397_platform_ids[] = {
395	{"mt6397-regulator", 0},
396	{ /* sentinel */ },
397};
398MODULE_DEVICE_TABLE(platform, mt6397_platform_ids);
399
400static const struct of_device_id mt6397_of_match[] = {
401	{ .compatible = "mediatek,mt6397-regulator", },
402	{ /* sentinel */ },
403};
404MODULE_DEVICE_TABLE(of, mt6397_of_match);
405
406static struct platform_driver mt6397_regulator_driver = {
407	.driver = {
408		.name = "mt6397-regulator",
409		.of_match_table = of_match_ptr(mt6397_of_match),
410	},
411	.probe = mt6397_regulator_probe,
412	.id_table = mt6397_platform_ids,
413};
414
415module_platform_driver(mt6397_regulator_driver);
416
417MODULE_AUTHOR("Flora Fu <flora.fu@mediatek.com>");
418MODULE_DESCRIPTION("Regulator Driver for MediaTek MT6397 PMIC");
419MODULE_LICENSE("GPL");
v4.6
  1/*
  2 * Copyright (c) 2014 MediaTek Inc.
  3 * Author: Flora Fu <flora.fu@mediatek.com>
  4 *
  5 * This program is free software; you can redistribute it and/or modify
  6 * it under the terms of the GNU General Public License version 2 as
  7 * published by the Free Software Foundation.
  8 *
  9 * This program is distributed in the hope that it will be useful,
 10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 12 * GNU General Public License for more details.
 13 */
 14
 15#include <linux/module.h>
 16#include <linux/of.h>
 17#include <linux/platform_device.h>
 18#include <linux/regmap.h>
 19#include <linux/mfd/mt6397/core.h>
 20#include <linux/mfd/mt6397/registers.h>
 21#include <linux/regulator/driver.h>
 22#include <linux/regulator/machine.h>
 23#include <linux/regulator/mt6397-regulator.h>
 24#include <linux/regulator/of_regulator.h>
 
 25
 26/*
 27 * MT6397 regulators' information
 28 *
 29 * @desc: standard fields of regulator description.
 30 * @qi: Mask for query enable signal status of regulators
 31 * @vselon_reg: Register sections for hardware control mode of bucks
 32 * @vselctrl_reg: Register for controlling the buck control mode.
 33 * @vselctrl_mask: Mask for query buck's voltage control mode.
 34 */
 35struct mt6397_regulator_info {
 36	struct regulator_desc desc;
 37	u32 qi;
 38	u32 vselon_reg;
 39	u32 vselctrl_reg;
 40	u32 vselctrl_mask;
 
 
 41};
 42
 43#define MT6397_BUCK(match, vreg, min, max, step, volt_ranges, enreg,	\
 44		vosel, vosel_mask, voselon, vosel_ctrl)			\
 
 45[MT6397_ID_##vreg] = {							\
 46	.desc = {							\
 47		.name = #vreg,						\
 48		.of_match = of_match_ptr(match),			\
 49		.ops = &mt6397_volt_range_ops,				\
 50		.type = REGULATOR_VOLTAGE,				\
 51		.id = MT6397_ID_##vreg,					\
 52		.owner = THIS_MODULE,					\
 53		.n_voltages = (max - min)/step + 1,			\
 54		.linear_ranges = volt_ranges,				\
 55		.n_linear_ranges = ARRAY_SIZE(volt_ranges),		\
 56		.vsel_reg = vosel,					\
 57		.vsel_mask = vosel_mask,				\
 58		.enable_reg = enreg,					\
 59		.enable_mask = BIT(0),					\
 
 60	},								\
 61	.qi = BIT(13),							\
 62	.vselon_reg = voselon,						\
 63	.vselctrl_reg = vosel_ctrl,					\
 64	.vselctrl_mask = BIT(1),					\
 
 
 65}
 66
 67#define MT6397_LDO(match, vreg, ldo_volt_table, enreg, enbit, vosel,	\
 68		vosel_mask)						\
 69[MT6397_ID_##vreg] = {							\
 70	.desc = {							\
 71		.name = #vreg,						\
 72		.of_match = of_match_ptr(match),			\
 73		.ops = &mt6397_volt_table_ops,				\
 74		.type = REGULATOR_VOLTAGE,				\
 75		.id = MT6397_ID_##vreg,					\
 76		.owner = THIS_MODULE,					\
 77		.n_voltages = ARRAY_SIZE(ldo_volt_table),		\
 78		.volt_table = ldo_volt_table,				\
 79		.vsel_reg = vosel,					\
 80		.vsel_mask = vosel_mask,				\
 81		.enable_reg = enreg,					\
 82		.enable_mask = BIT(enbit),				\
 83	},								\
 84	.qi = BIT(15),							\
 85}
 86
 87#define MT6397_REG_FIXED(match, vreg, enreg, enbit, volt)		\
 88[MT6397_ID_##vreg] = {							\
 89	.desc = {							\
 90		.name = #vreg,						\
 91		.of_match = of_match_ptr(match),			\
 92		.ops = &mt6397_volt_fixed_ops,				\
 93		.type = REGULATOR_VOLTAGE,				\
 94		.id = MT6397_ID_##vreg,					\
 95		.owner = THIS_MODULE,					\
 96		.n_voltages = 1,					\
 97		.enable_reg = enreg,					\
 98		.enable_mask = BIT(enbit),				\
 99		.min_uV = volt,						\
100	},								\
101	.qi = BIT(15),							\
102}
103
104static const struct regulator_linear_range buck_volt_range1[] = {
105	REGULATOR_LINEAR_RANGE(700000, 0, 0x7f, 6250),
106};
107
108static const struct regulator_linear_range buck_volt_range2[] = {
109	REGULATOR_LINEAR_RANGE(800000, 0, 0x7f, 6250),
110};
111
112static const struct regulator_linear_range buck_volt_range3[] = {
113	REGULATOR_LINEAR_RANGE(1500000, 0, 0x1f, 20000),
114};
115
116static const u32 ldo_volt_table1[] = {
117	1500000, 1800000, 2500000, 2800000,
118};
119
120static const u32 ldo_volt_table2[] = {
121	1800000, 3300000,
122};
123
124static const u32 ldo_volt_table3[] = {
125	3000000, 3300000,
126};
127
128static const u32 ldo_volt_table4[] = {
129	1220000, 1300000, 1500000, 1800000, 2500000, 2800000, 3000000, 3300000,
130};
131
132static const u32 ldo_volt_table5[] = {
133	1200000, 1300000, 1500000, 1800000, 2500000, 2800000, 3000000, 3300000,
134};
135
136static const u32 ldo_volt_table5_v2[] = {
137	1200000, 1000000, 1500000, 1800000, 2500000, 2800000, 3000000, 3300000,
138};
139
140static const u32 ldo_volt_table6[] = {
141	1200000, 1300000, 1500000, 1800000, 2500000, 2800000, 3000000, 2000000,
142};
143
144static const u32 ldo_volt_table7[] = {
145	1300000, 1500000, 1800000, 2000000, 2500000, 2800000, 3000000, 3300000,
146};
147
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
148static int mt6397_get_status(struct regulator_dev *rdev)
149{
150	int ret;
151	u32 regval;
152	struct mt6397_regulator_info *info = rdev_get_drvdata(rdev);
153
154	ret = regmap_read(rdev->regmap, info->desc.enable_reg, &regval);
155	if (ret != 0) {
156		dev_err(&rdev->dev, "Failed to get enable reg: %d\n", ret);
157		return ret;
158	}
159
160	return (regval & info->qi) ? REGULATOR_STATUS_ON : REGULATOR_STATUS_OFF;
161}
162
163static struct regulator_ops mt6397_volt_range_ops = {
164	.list_voltage = regulator_list_voltage_linear_range,
165	.map_voltage = regulator_map_voltage_linear_range,
166	.set_voltage_sel = regulator_set_voltage_sel_regmap,
167	.get_voltage_sel = regulator_get_voltage_sel_regmap,
168	.set_voltage_time_sel = regulator_set_voltage_time_sel,
169	.enable = regulator_enable_regmap,
170	.disable = regulator_disable_regmap,
171	.is_enabled = regulator_is_enabled_regmap,
172	.get_status = mt6397_get_status,
 
 
173};
174
175static struct regulator_ops mt6397_volt_table_ops = {
176	.list_voltage = regulator_list_voltage_table,
177	.map_voltage = regulator_map_voltage_iterate,
178	.set_voltage_sel = regulator_set_voltage_sel_regmap,
179	.get_voltage_sel = regulator_get_voltage_sel_regmap,
180	.set_voltage_time_sel = regulator_set_voltage_time_sel,
181	.enable = regulator_enable_regmap,
182	.disable = regulator_disable_regmap,
183	.is_enabled = regulator_is_enabled_regmap,
184	.get_status = mt6397_get_status,
185};
186
187static struct regulator_ops mt6397_volt_fixed_ops = {
188	.list_voltage = regulator_list_voltage_linear,
189	.enable = regulator_enable_regmap,
190	.disable = regulator_disable_regmap,
191	.is_enabled = regulator_is_enabled_regmap,
192	.get_status = mt6397_get_status,
193};
194
195/* The array is indexed by id(MT6397_ID_XXX) */
196static struct mt6397_regulator_info mt6397_regulators[] = {
197	MT6397_BUCK("buck_vpca15", VPCA15, 700000, 1493750, 6250,
198		buck_volt_range1, MT6397_VCA15_CON7, MT6397_VCA15_CON9, 0x7f,
199		MT6397_VCA15_CON10, MT6397_VCA15_CON5),
200	MT6397_BUCK("buck_vpca7", VPCA7, 700000, 1493750, 6250,
201		buck_volt_range1, MT6397_VPCA7_CON7, MT6397_VPCA7_CON9, 0x7f,
202		MT6397_VPCA7_CON10, MT6397_VPCA7_CON5),
203	MT6397_BUCK("buck_vsramca15", VSRAMCA15, 700000, 1493750, 6250,
204		buck_volt_range1, MT6397_VSRMCA15_CON7, MT6397_VSRMCA15_CON9,
205		0x7f, MT6397_VSRMCA15_CON10, MT6397_VSRMCA15_CON5),
 
206	MT6397_BUCK("buck_vsramca7", VSRAMCA7, 700000, 1493750, 6250,
207		buck_volt_range1, MT6397_VSRMCA7_CON7, MT6397_VSRMCA7_CON9,
208		0x7f, MT6397_VSRMCA7_CON10, MT6397_VSRMCA7_CON5),
 
209	MT6397_BUCK("buck_vcore", VCORE, 700000, 1493750, 6250,
210		buck_volt_range1, MT6397_VCORE_CON7, MT6397_VCORE_CON9, 0x7f,
211		MT6397_VCORE_CON10, MT6397_VCORE_CON5),
212	MT6397_BUCK("buck_vgpu", VGPU, 700000, 1493750, 6250, buck_volt_range1,
213		MT6397_VGPU_CON7, MT6397_VGPU_CON9, 0x7f,
214		MT6397_VGPU_CON10, MT6397_VGPU_CON5),
215	MT6397_BUCK("buck_vdrm", VDRM, 800000, 1593750, 6250, buck_volt_range2,
216		MT6397_VDRM_CON7, MT6397_VDRM_CON9, 0x7f,
217		MT6397_VDRM_CON10, MT6397_VDRM_CON5),
218	MT6397_BUCK("buck_vio18", VIO18, 1500000, 2120000, 20000,
219		buck_volt_range3, MT6397_VIO18_CON7, MT6397_VIO18_CON9, 0x1f,
220		MT6397_VIO18_CON10, MT6397_VIO18_CON5),
221	MT6397_REG_FIXED("ldo_vtcxo", VTCXO, MT6397_ANALDO_CON0, 10, 2800000),
222	MT6397_REG_FIXED("ldo_va28", VA28, MT6397_ANALDO_CON1, 14, 2800000),
223	MT6397_LDO("ldo_vcama", VCAMA, ldo_volt_table1,
224		MT6397_ANALDO_CON2, 15, MT6397_ANALDO_CON6, 0xC0),
225	MT6397_REG_FIXED("ldo_vio28", VIO28, MT6397_DIGLDO_CON0, 14, 2800000),
226	MT6397_REG_FIXED("ldo_vusb", VUSB, MT6397_DIGLDO_CON1, 14, 3300000),
227	MT6397_LDO("ldo_vmc", VMC, ldo_volt_table2,
228		MT6397_DIGLDO_CON2, 12, MT6397_DIGLDO_CON29, 0x10),
229	MT6397_LDO("ldo_vmch", VMCH, ldo_volt_table3,
230		MT6397_DIGLDO_CON3, 14, MT6397_DIGLDO_CON17, 0x80),
231	MT6397_LDO("ldo_vemc3v3", VEMC3V3, ldo_volt_table3,
232		MT6397_DIGLDO_CON4, 14, MT6397_DIGLDO_CON18, 0x10),
233	MT6397_LDO("ldo_vgp1", VGP1, ldo_volt_table4,
234		MT6397_DIGLDO_CON5, 15, MT6397_DIGLDO_CON19, 0xE0),
235	MT6397_LDO("ldo_vgp2", VGP2, ldo_volt_table5,
236		MT6397_DIGLDO_CON6, 15, MT6397_DIGLDO_CON20, 0xE0),
237	MT6397_LDO("ldo_vgp3", VGP3, ldo_volt_table5,
238		MT6397_DIGLDO_CON7, 15, MT6397_DIGLDO_CON21, 0xE0),
239	MT6397_LDO("ldo_vgp4", VGP4, ldo_volt_table5,
240		MT6397_DIGLDO_CON8, 15, MT6397_DIGLDO_CON22, 0xE0),
241	MT6397_LDO("ldo_vgp5", VGP5, ldo_volt_table6,
242		MT6397_DIGLDO_CON9, 15, MT6397_DIGLDO_CON23, 0xE0),
243	MT6397_LDO("ldo_vgp6", VGP6, ldo_volt_table5,
244		MT6397_DIGLDO_CON10, 15, MT6397_DIGLDO_CON33, 0xE0),
245	MT6397_LDO("ldo_vibr", VIBR, ldo_volt_table7,
246		MT6397_DIGLDO_CON24, 15, MT6397_DIGLDO_CON25, 0xE00),
247};
248
249static int mt6397_set_buck_vosel_reg(struct platform_device *pdev)
250{
251	struct mt6397_chip *mt6397 = dev_get_drvdata(pdev->dev.parent);
252	int i;
253	u32 regval;
254
255	for (i = 0; i < MT6397_MAX_REGULATOR; i++) {
256		if (mt6397_regulators[i].vselctrl_reg) {
257			if (regmap_read(mt6397->regmap,
258				mt6397_regulators[i].vselctrl_reg,
259				&regval) < 0) {
260				dev_err(&pdev->dev,
261					"Failed to read buck ctrl\n");
262				return -EIO;
263			}
264
265			if (regval & mt6397_regulators[i].vselctrl_mask) {
266				mt6397_regulators[i].desc.vsel_reg =
267				mt6397_regulators[i].vselon_reg;
268			}
269		}
270	}
271
272	return 0;
273}
274
275static int mt6397_regulator_probe(struct platform_device *pdev)
276{
277	struct mt6397_chip *mt6397 = dev_get_drvdata(pdev->dev.parent);
278	struct regulator_config config = {};
279	struct regulator_dev *rdev;
280	int i;
281	u32 reg_value, version;
282
283	/* Query buck controller to select activated voltage register part */
284	if (mt6397_set_buck_vosel_reg(pdev))
285		return -EIO;
286
287	/* Read PMIC chip revision to update constraints and voltage table */
288	if (regmap_read(mt6397->regmap, MT6397_CID, &reg_value) < 0) {
289		dev_err(&pdev->dev, "Failed to read Chip ID\n");
290		return -EIO;
291	}
292	dev_info(&pdev->dev, "Chip ID = 0x%x\n", reg_value);
293
294	version = (reg_value & 0xFF);
295	switch (version) {
296	case MT6397_REGULATOR_ID91:
297		mt6397_regulators[MT6397_ID_VGP2].desc.volt_table =
298		ldo_volt_table5_v2;
299		break;
300	default:
301		break;
302	}
303
304	for (i = 0; i < MT6397_MAX_REGULATOR; i++) {
305		config.dev = &pdev->dev;
306		config.driver_data = &mt6397_regulators[i];
307		config.regmap = mt6397->regmap;
308		rdev = devm_regulator_register(&pdev->dev,
309				&mt6397_regulators[i].desc, &config);
310		if (IS_ERR(rdev)) {
311			dev_err(&pdev->dev, "failed to register %s\n",
312				mt6397_regulators[i].desc.name);
313			return PTR_ERR(rdev);
314		}
315	}
316
317	return 0;
318}
319
320static const struct platform_device_id mt6397_platform_ids[] = {
321	{"mt6397-regulator", 0},
322	{ /* sentinel */ },
323};
324MODULE_DEVICE_TABLE(platform, mt6397_platform_ids);
325
326static const struct of_device_id mt6397_of_match[] = {
327	{ .compatible = "mediatek,mt6397-regulator", },
328	{ /* sentinel */ },
329};
330MODULE_DEVICE_TABLE(of, mt6397_of_match);
331
332static struct platform_driver mt6397_regulator_driver = {
333	.driver = {
334		.name = "mt6397-regulator",
335		.of_match_table = of_match_ptr(mt6397_of_match),
336	},
337	.probe = mt6397_regulator_probe,
338	.id_table = mt6397_platform_ids,
339};
340
341module_platform_driver(mt6397_regulator_driver);
342
343MODULE_AUTHOR("Flora Fu <flora.fu@mediatek.com>");
344MODULE_DESCRIPTION("Regulator Driver for MediaTek MT6397 PMIC");
345MODULE_LICENSE("GPL");