162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci//
362306a36Sopenharmony_ci// Copyright (c) 2016 MediaTek Inc.
462306a36Sopenharmony_ci// Author: Chen Zhong <chen.zhong@mediatek.com>
562306a36Sopenharmony_ci
662306a36Sopenharmony_ci#include <linux/module.h>
762306a36Sopenharmony_ci#include <linux/of.h>
862306a36Sopenharmony_ci#include <linux/platform_device.h>
962306a36Sopenharmony_ci#include <linux/regmap.h>
1062306a36Sopenharmony_ci#include <linux/mfd/mt6397/core.h>
1162306a36Sopenharmony_ci#include <linux/mfd/mt6323/registers.h>
1262306a36Sopenharmony_ci#include <linux/regulator/driver.h>
1362306a36Sopenharmony_ci#include <linux/regulator/machine.h>
1462306a36Sopenharmony_ci#include <linux/regulator/mt6323-regulator.h>
1562306a36Sopenharmony_ci#include <linux/regulator/of_regulator.h>
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_ci#define MT6323_LDO_MODE_NORMAL	0
1862306a36Sopenharmony_ci#define MT6323_LDO_MODE_LP	1
1962306a36Sopenharmony_ci
2062306a36Sopenharmony_ci/*
2162306a36Sopenharmony_ci * MT6323 regulators' information
2262306a36Sopenharmony_ci *
2362306a36Sopenharmony_ci * @desc: standard fields of regulator description.
2462306a36Sopenharmony_ci * @qi: Mask for query enable signal status of regulators
2562306a36Sopenharmony_ci * @vselon_reg: Register sections for hardware control mode of bucks
2662306a36Sopenharmony_ci * @vselctrl_reg: Register for controlling the buck control mode.
2762306a36Sopenharmony_ci * @vselctrl_mask: Mask for query buck's voltage control mode.
2862306a36Sopenharmony_ci */
2962306a36Sopenharmony_cistruct mt6323_regulator_info {
3062306a36Sopenharmony_ci	struct regulator_desc desc;
3162306a36Sopenharmony_ci	u32 qi;
3262306a36Sopenharmony_ci	u32 vselon_reg;
3362306a36Sopenharmony_ci	u32 vselctrl_reg;
3462306a36Sopenharmony_ci	u32 vselctrl_mask;
3562306a36Sopenharmony_ci	u32 modeset_reg;
3662306a36Sopenharmony_ci	u32 modeset_mask;
3762306a36Sopenharmony_ci};
3862306a36Sopenharmony_ci
3962306a36Sopenharmony_ci#define MT6323_BUCK(match, vreg, min, max, step, volt_ranges, enreg,	\
4062306a36Sopenharmony_ci		vosel, vosel_mask, voselon, vosel_ctrl)			\
4162306a36Sopenharmony_ci[MT6323_ID_##vreg] = {							\
4262306a36Sopenharmony_ci	.desc = {							\
4362306a36Sopenharmony_ci		.name = #vreg,						\
4462306a36Sopenharmony_ci		.of_match = of_match_ptr(match),			\
4562306a36Sopenharmony_ci		.ops = &mt6323_volt_range_ops,				\
4662306a36Sopenharmony_ci		.type = REGULATOR_VOLTAGE,				\
4762306a36Sopenharmony_ci		.id = MT6323_ID_##vreg,					\
4862306a36Sopenharmony_ci		.owner = THIS_MODULE,					\
4962306a36Sopenharmony_ci		.n_voltages = (max - min)/step + 1,			\
5062306a36Sopenharmony_ci		.linear_ranges = volt_ranges,				\
5162306a36Sopenharmony_ci		.n_linear_ranges = ARRAY_SIZE(volt_ranges),		\
5262306a36Sopenharmony_ci		.vsel_reg = vosel,					\
5362306a36Sopenharmony_ci		.vsel_mask = vosel_mask,				\
5462306a36Sopenharmony_ci		.enable_reg = enreg,					\
5562306a36Sopenharmony_ci		.enable_mask = BIT(0),					\
5662306a36Sopenharmony_ci	},								\
5762306a36Sopenharmony_ci	.qi = BIT(13),							\
5862306a36Sopenharmony_ci	.vselon_reg = voselon,						\
5962306a36Sopenharmony_ci	.vselctrl_reg = vosel_ctrl,					\
6062306a36Sopenharmony_ci	.vselctrl_mask = BIT(1),					\
6162306a36Sopenharmony_ci}
6262306a36Sopenharmony_ci
6362306a36Sopenharmony_ci#define MT6323_LDO(match, vreg, ldo_volt_table, enreg, enbit, vosel,	\
6462306a36Sopenharmony_ci		vosel_mask, _modeset_reg, _modeset_mask)		\
6562306a36Sopenharmony_ci[MT6323_ID_##vreg] = {							\
6662306a36Sopenharmony_ci	.desc = {							\
6762306a36Sopenharmony_ci		.name = #vreg,						\
6862306a36Sopenharmony_ci		.of_match = of_match_ptr(match),			\
6962306a36Sopenharmony_ci		.ops = &mt6323_volt_table_ops,				\
7062306a36Sopenharmony_ci		.type = REGULATOR_VOLTAGE,				\
7162306a36Sopenharmony_ci		.id = MT6323_ID_##vreg,					\
7262306a36Sopenharmony_ci		.owner = THIS_MODULE,					\
7362306a36Sopenharmony_ci		.n_voltages = ARRAY_SIZE(ldo_volt_table),		\
7462306a36Sopenharmony_ci		.volt_table = ldo_volt_table,				\
7562306a36Sopenharmony_ci		.vsel_reg = vosel,					\
7662306a36Sopenharmony_ci		.vsel_mask = vosel_mask,				\
7762306a36Sopenharmony_ci		.enable_reg = enreg,					\
7862306a36Sopenharmony_ci		.enable_mask = BIT(enbit),				\
7962306a36Sopenharmony_ci	},								\
8062306a36Sopenharmony_ci	.qi = BIT(15),							\
8162306a36Sopenharmony_ci	.modeset_reg = _modeset_reg,					\
8262306a36Sopenharmony_ci	.modeset_mask = _modeset_mask,					\
8362306a36Sopenharmony_ci}
8462306a36Sopenharmony_ci
8562306a36Sopenharmony_ci#define MT6323_REG_FIXED(match, vreg, enreg, enbit, volt,		\
8662306a36Sopenharmony_ci		_modeset_reg, _modeset_mask)				\
8762306a36Sopenharmony_ci[MT6323_ID_##vreg] = {							\
8862306a36Sopenharmony_ci	.desc = {							\
8962306a36Sopenharmony_ci		.name = #vreg,						\
9062306a36Sopenharmony_ci		.of_match = of_match_ptr(match),			\
9162306a36Sopenharmony_ci		.ops = &mt6323_volt_fixed_ops,				\
9262306a36Sopenharmony_ci		.type = REGULATOR_VOLTAGE,				\
9362306a36Sopenharmony_ci		.id = MT6323_ID_##vreg,					\
9462306a36Sopenharmony_ci		.owner = THIS_MODULE,					\
9562306a36Sopenharmony_ci		.n_voltages = 1,					\
9662306a36Sopenharmony_ci		.enable_reg = enreg,					\
9762306a36Sopenharmony_ci		.enable_mask = BIT(enbit),				\
9862306a36Sopenharmony_ci		.min_uV = volt,						\
9962306a36Sopenharmony_ci	},								\
10062306a36Sopenharmony_ci	.qi = BIT(15),							\
10162306a36Sopenharmony_ci	.modeset_reg = _modeset_reg,					\
10262306a36Sopenharmony_ci	.modeset_mask = _modeset_mask,					\
10362306a36Sopenharmony_ci}
10462306a36Sopenharmony_ci
10562306a36Sopenharmony_cistatic const struct linear_range buck_volt_range1[] = {
10662306a36Sopenharmony_ci	REGULATOR_LINEAR_RANGE(700000, 0, 0x7f, 6250),
10762306a36Sopenharmony_ci};
10862306a36Sopenharmony_ci
10962306a36Sopenharmony_cistatic const struct linear_range buck_volt_range2[] = {
11062306a36Sopenharmony_ci	REGULATOR_LINEAR_RANGE(1400000, 0, 0x7f, 12500),
11162306a36Sopenharmony_ci};
11262306a36Sopenharmony_ci
11362306a36Sopenharmony_cistatic const struct linear_range buck_volt_range3[] = {
11462306a36Sopenharmony_ci	REGULATOR_LINEAR_RANGE(500000, 0, 0x3f, 50000),
11562306a36Sopenharmony_ci};
11662306a36Sopenharmony_ci
11762306a36Sopenharmony_cistatic const unsigned int ldo_volt_table1[] = {
11862306a36Sopenharmony_ci	3300000, 3400000, 3500000, 3600000,
11962306a36Sopenharmony_ci};
12062306a36Sopenharmony_ci
12162306a36Sopenharmony_cistatic const unsigned int ldo_volt_table2[] = {
12262306a36Sopenharmony_ci	1500000, 1800000, 2500000, 2800000,
12362306a36Sopenharmony_ci};
12462306a36Sopenharmony_ci
12562306a36Sopenharmony_cistatic const unsigned int ldo_volt_table3[] = {
12662306a36Sopenharmony_ci	1800000, 3300000,
12762306a36Sopenharmony_ci};
12862306a36Sopenharmony_ci
12962306a36Sopenharmony_cistatic const unsigned int ldo_volt_table4[] = {
13062306a36Sopenharmony_ci	3000000, 3300000,
13162306a36Sopenharmony_ci};
13262306a36Sopenharmony_ci
13362306a36Sopenharmony_cistatic const unsigned int ldo_volt_table5[] = {
13462306a36Sopenharmony_ci	1200000, 1300000, 1500000, 1800000, 2000000, 2800000, 3000000, 3300000,
13562306a36Sopenharmony_ci};
13662306a36Sopenharmony_ci
13762306a36Sopenharmony_cistatic const unsigned int ldo_volt_table6[] = {
13862306a36Sopenharmony_ci	1200000, 1300000, 1500000, 1800000, 2500000, 2800000, 3000000, 2000000,
13962306a36Sopenharmony_ci};
14062306a36Sopenharmony_ci
14162306a36Sopenharmony_cistatic const unsigned int ldo_volt_table7[] = {
14262306a36Sopenharmony_ci	1200000, 1300000, 1500000, 1800000,
14362306a36Sopenharmony_ci};
14462306a36Sopenharmony_ci
14562306a36Sopenharmony_cistatic const unsigned int ldo_volt_table8[] = {
14662306a36Sopenharmony_ci	1800000, 3000000,
14762306a36Sopenharmony_ci};
14862306a36Sopenharmony_ci
14962306a36Sopenharmony_cistatic const unsigned int ldo_volt_table9[] = {
15062306a36Sopenharmony_ci	1200000, 1350000, 1500000, 1800000,
15162306a36Sopenharmony_ci};
15262306a36Sopenharmony_ci
15362306a36Sopenharmony_cistatic const unsigned int ldo_volt_table10[] = {
15462306a36Sopenharmony_ci	1200000, 1300000, 1500000, 1800000,
15562306a36Sopenharmony_ci};
15662306a36Sopenharmony_ci
15762306a36Sopenharmony_cistatic int mt6323_get_status(struct regulator_dev *rdev)
15862306a36Sopenharmony_ci{
15962306a36Sopenharmony_ci	int ret;
16062306a36Sopenharmony_ci	u32 regval;
16162306a36Sopenharmony_ci	struct mt6323_regulator_info *info = rdev_get_drvdata(rdev);
16262306a36Sopenharmony_ci
16362306a36Sopenharmony_ci	ret = regmap_read(rdev->regmap, info->desc.enable_reg, &regval);
16462306a36Sopenharmony_ci	if (ret != 0) {
16562306a36Sopenharmony_ci		dev_err(&rdev->dev, "Failed to get enable reg: %d\n", ret);
16662306a36Sopenharmony_ci		return ret;
16762306a36Sopenharmony_ci	}
16862306a36Sopenharmony_ci
16962306a36Sopenharmony_ci	return (regval & info->qi) ? REGULATOR_STATUS_ON : REGULATOR_STATUS_OFF;
17062306a36Sopenharmony_ci}
17162306a36Sopenharmony_ci
17262306a36Sopenharmony_cistatic int mt6323_ldo_set_mode(struct regulator_dev *rdev, unsigned int mode)
17362306a36Sopenharmony_ci{
17462306a36Sopenharmony_ci	int ret, val = 0;
17562306a36Sopenharmony_ci	struct mt6323_regulator_info *info = rdev_get_drvdata(rdev);
17662306a36Sopenharmony_ci
17762306a36Sopenharmony_ci	if (!info->modeset_mask) {
17862306a36Sopenharmony_ci		dev_err(&rdev->dev, "regulator %s doesn't support set_mode\n",
17962306a36Sopenharmony_ci			info->desc.name);
18062306a36Sopenharmony_ci		return -EINVAL;
18162306a36Sopenharmony_ci	}
18262306a36Sopenharmony_ci
18362306a36Sopenharmony_ci	switch (mode) {
18462306a36Sopenharmony_ci	case REGULATOR_MODE_STANDBY:
18562306a36Sopenharmony_ci		val = MT6323_LDO_MODE_LP;
18662306a36Sopenharmony_ci		break;
18762306a36Sopenharmony_ci	case REGULATOR_MODE_NORMAL:
18862306a36Sopenharmony_ci		val = MT6323_LDO_MODE_NORMAL;
18962306a36Sopenharmony_ci		break;
19062306a36Sopenharmony_ci	default:
19162306a36Sopenharmony_ci		return -EINVAL;
19262306a36Sopenharmony_ci	}
19362306a36Sopenharmony_ci
19462306a36Sopenharmony_ci	val <<= ffs(info->modeset_mask) - 1;
19562306a36Sopenharmony_ci
19662306a36Sopenharmony_ci	ret = regmap_update_bits(rdev->regmap, info->modeset_reg,
19762306a36Sopenharmony_ci				  info->modeset_mask, val);
19862306a36Sopenharmony_ci
19962306a36Sopenharmony_ci	return ret;
20062306a36Sopenharmony_ci}
20162306a36Sopenharmony_ci
20262306a36Sopenharmony_cistatic unsigned int mt6323_ldo_get_mode(struct regulator_dev *rdev)
20362306a36Sopenharmony_ci{
20462306a36Sopenharmony_ci	unsigned int val;
20562306a36Sopenharmony_ci	unsigned int mode;
20662306a36Sopenharmony_ci	int ret;
20762306a36Sopenharmony_ci	struct mt6323_regulator_info *info = rdev_get_drvdata(rdev);
20862306a36Sopenharmony_ci
20962306a36Sopenharmony_ci	if (!info->modeset_mask) {
21062306a36Sopenharmony_ci		dev_err(&rdev->dev, "regulator %s doesn't support get_mode\n",
21162306a36Sopenharmony_ci			info->desc.name);
21262306a36Sopenharmony_ci		return -EINVAL;
21362306a36Sopenharmony_ci	}
21462306a36Sopenharmony_ci
21562306a36Sopenharmony_ci	ret = regmap_read(rdev->regmap, info->modeset_reg, &val);
21662306a36Sopenharmony_ci	if (ret < 0)
21762306a36Sopenharmony_ci		return ret;
21862306a36Sopenharmony_ci
21962306a36Sopenharmony_ci	val &= info->modeset_mask;
22062306a36Sopenharmony_ci	val >>= ffs(info->modeset_mask) - 1;
22162306a36Sopenharmony_ci
22262306a36Sopenharmony_ci	if (val & 0x1)
22362306a36Sopenharmony_ci		mode = REGULATOR_MODE_STANDBY;
22462306a36Sopenharmony_ci	else
22562306a36Sopenharmony_ci		mode = REGULATOR_MODE_NORMAL;
22662306a36Sopenharmony_ci
22762306a36Sopenharmony_ci	return mode;
22862306a36Sopenharmony_ci}
22962306a36Sopenharmony_ci
23062306a36Sopenharmony_cistatic const struct regulator_ops mt6323_volt_range_ops = {
23162306a36Sopenharmony_ci	.list_voltage = regulator_list_voltage_linear_range,
23262306a36Sopenharmony_ci	.map_voltage = regulator_map_voltage_linear_range,
23362306a36Sopenharmony_ci	.set_voltage_sel = regulator_set_voltage_sel_regmap,
23462306a36Sopenharmony_ci	.get_voltage_sel = regulator_get_voltage_sel_regmap,
23562306a36Sopenharmony_ci	.set_voltage_time_sel = regulator_set_voltage_time_sel,
23662306a36Sopenharmony_ci	.enable = regulator_enable_regmap,
23762306a36Sopenharmony_ci	.disable = regulator_disable_regmap,
23862306a36Sopenharmony_ci	.is_enabled = regulator_is_enabled_regmap,
23962306a36Sopenharmony_ci	.get_status = mt6323_get_status,
24062306a36Sopenharmony_ci};
24162306a36Sopenharmony_ci
24262306a36Sopenharmony_cistatic const struct regulator_ops mt6323_volt_table_ops = {
24362306a36Sopenharmony_ci	.list_voltage = regulator_list_voltage_table,
24462306a36Sopenharmony_ci	.map_voltage = regulator_map_voltage_iterate,
24562306a36Sopenharmony_ci	.set_voltage_sel = regulator_set_voltage_sel_regmap,
24662306a36Sopenharmony_ci	.get_voltage_sel = regulator_get_voltage_sel_regmap,
24762306a36Sopenharmony_ci	.set_voltage_time_sel = regulator_set_voltage_time_sel,
24862306a36Sopenharmony_ci	.enable = regulator_enable_regmap,
24962306a36Sopenharmony_ci	.disable = regulator_disable_regmap,
25062306a36Sopenharmony_ci	.is_enabled = regulator_is_enabled_regmap,
25162306a36Sopenharmony_ci	.get_status = mt6323_get_status,
25262306a36Sopenharmony_ci	.set_mode = mt6323_ldo_set_mode,
25362306a36Sopenharmony_ci	.get_mode = mt6323_ldo_get_mode,
25462306a36Sopenharmony_ci};
25562306a36Sopenharmony_ci
25662306a36Sopenharmony_cistatic const struct regulator_ops mt6323_volt_fixed_ops = {
25762306a36Sopenharmony_ci	.list_voltage = regulator_list_voltage_linear,
25862306a36Sopenharmony_ci	.enable = regulator_enable_regmap,
25962306a36Sopenharmony_ci	.disable = regulator_disable_regmap,
26062306a36Sopenharmony_ci	.is_enabled = regulator_is_enabled_regmap,
26162306a36Sopenharmony_ci	.get_status = mt6323_get_status,
26262306a36Sopenharmony_ci	.set_mode = mt6323_ldo_set_mode,
26362306a36Sopenharmony_ci	.get_mode = mt6323_ldo_get_mode,
26462306a36Sopenharmony_ci};
26562306a36Sopenharmony_ci
26662306a36Sopenharmony_ci/* The array is indexed by id(MT6323_ID_XXX) */
26762306a36Sopenharmony_cistatic struct mt6323_regulator_info mt6323_regulators[] = {
26862306a36Sopenharmony_ci	MT6323_BUCK("buck_vproc", VPROC, 700000, 1493750, 6250,
26962306a36Sopenharmony_ci		buck_volt_range1, MT6323_VPROC_CON7, MT6323_VPROC_CON9, 0x7f,
27062306a36Sopenharmony_ci		MT6323_VPROC_CON10, MT6323_VPROC_CON5),
27162306a36Sopenharmony_ci	MT6323_BUCK("buck_vsys", VSYS, 1400000, 2987500, 12500,
27262306a36Sopenharmony_ci		buck_volt_range2, MT6323_VSYS_CON7, MT6323_VSYS_CON9, 0x7f,
27362306a36Sopenharmony_ci		MT6323_VSYS_CON10, MT6323_VSYS_CON5),
27462306a36Sopenharmony_ci	MT6323_BUCK("buck_vpa", VPA, 500000, 3650000, 50000,
27562306a36Sopenharmony_ci		buck_volt_range3, MT6323_VPA_CON7, MT6323_VPA_CON9,
27662306a36Sopenharmony_ci		0x3f, MT6323_VPA_CON10, MT6323_VPA_CON5),
27762306a36Sopenharmony_ci	MT6323_REG_FIXED("ldo_vtcxo", VTCXO, MT6323_ANALDO_CON1, 10, 2800000,
27862306a36Sopenharmony_ci		MT6323_ANALDO_CON1, 0x2),
27962306a36Sopenharmony_ci	MT6323_REG_FIXED("ldo_vcn28", VCN28, MT6323_ANALDO_CON19, 12, 2800000,
28062306a36Sopenharmony_ci		MT6323_ANALDO_CON20, 0x2),
28162306a36Sopenharmony_ci	MT6323_LDO("ldo_vcn33_bt", VCN33_BT, ldo_volt_table1,
28262306a36Sopenharmony_ci		MT6323_ANALDO_CON16, 7, MT6323_ANALDO_CON16, 0xC,
28362306a36Sopenharmony_ci		MT6323_ANALDO_CON21, 0x2),
28462306a36Sopenharmony_ci	MT6323_LDO("ldo_vcn33_wifi", VCN33_WIFI, ldo_volt_table1,
28562306a36Sopenharmony_ci		MT6323_ANALDO_CON17, 12, MT6323_ANALDO_CON16, 0xC,
28662306a36Sopenharmony_ci		MT6323_ANALDO_CON21, 0x2),
28762306a36Sopenharmony_ci	MT6323_REG_FIXED("ldo_va", VA, MT6323_ANALDO_CON2, 14, 2800000,
28862306a36Sopenharmony_ci		MT6323_ANALDO_CON2, 0x2),
28962306a36Sopenharmony_ci	MT6323_LDO("ldo_vcama", VCAMA, ldo_volt_table2,
29062306a36Sopenharmony_ci		MT6323_ANALDO_CON4, 15, MT6323_ANALDO_CON10, 0x60, -1, 0),
29162306a36Sopenharmony_ci	MT6323_REG_FIXED("ldo_vio28", VIO28, MT6323_DIGLDO_CON0, 14, 2800000,
29262306a36Sopenharmony_ci		MT6323_DIGLDO_CON0, 0x2),
29362306a36Sopenharmony_ci	MT6323_REG_FIXED("ldo_vusb", VUSB, MT6323_DIGLDO_CON2, 14, 3300000,
29462306a36Sopenharmony_ci		MT6323_DIGLDO_CON2, 0x2),
29562306a36Sopenharmony_ci	MT6323_LDO("ldo_vmc", VMC, ldo_volt_table3,
29662306a36Sopenharmony_ci		MT6323_DIGLDO_CON3, 12, MT6323_DIGLDO_CON24, 0x10,
29762306a36Sopenharmony_ci		MT6323_DIGLDO_CON3, 0x2),
29862306a36Sopenharmony_ci	MT6323_LDO("ldo_vmch", VMCH, ldo_volt_table4,
29962306a36Sopenharmony_ci		MT6323_DIGLDO_CON5, 14, MT6323_DIGLDO_CON26, 0x80,
30062306a36Sopenharmony_ci		MT6323_DIGLDO_CON5, 0x2),
30162306a36Sopenharmony_ci	MT6323_LDO("ldo_vemc3v3", VEMC3V3, ldo_volt_table4,
30262306a36Sopenharmony_ci		MT6323_DIGLDO_CON6, 14, MT6323_DIGLDO_CON27, 0x80,
30362306a36Sopenharmony_ci		MT6323_DIGLDO_CON6, 0x2),
30462306a36Sopenharmony_ci	MT6323_LDO("ldo_vgp1", VGP1, ldo_volt_table5,
30562306a36Sopenharmony_ci		MT6323_DIGLDO_CON7, 15, MT6323_DIGLDO_CON28, 0xE0,
30662306a36Sopenharmony_ci		MT6323_DIGLDO_CON7, 0x2),
30762306a36Sopenharmony_ci	MT6323_LDO("ldo_vgp2", VGP2, ldo_volt_table6,
30862306a36Sopenharmony_ci		MT6323_DIGLDO_CON8, 15, MT6323_DIGLDO_CON29, 0xE0,
30962306a36Sopenharmony_ci		MT6323_DIGLDO_CON8, 0x2),
31062306a36Sopenharmony_ci	MT6323_LDO("ldo_vgp3", VGP3, ldo_volt_table7,
31162306a36Sopenharmony_ci		MT6323_DIGLDO_CON9, 15, MT6323_DIGLDO_CON30, 0x60,
31262306a36Sopenharmony_ci		MT6323_DIGLDO_CON9, 0x2),
31362306a36Sopenharmony_ci	MT6323_REG_FIXED("ldo_vcn18", VCN18, MT6323_DIGLDO_CON11, 14, 1800000,
31462306a36Sopenharmony_ci		MT6323_DIGLDO_CON11, 0x2),
31562306a36Sopenharmony_ci	MT6323_LDO("ldo_vsim1", VSIM1, ldo_volt_table8,
31662306a36Sopenharmony_ci		MT6323_DIGLDO_CON13, 15, MT6323_DIGLDO_CON34, 0x20,
31762306a36Sopenharmony_ci		MT6323_DIGLDO_CON13, 0x2),
31862306a36Sopenharmony_ci	MT6323_LDO("ldo_vsim2", VSIM2, ldo_volt_table8,
31962306a36Sopenharmony_ci		MT6323_DIGLDO_CON14, 15, MT6323_DIGLDO_CON35, 0x20,
32062306a36Sopenharmony_ci		MT6323_DIGLDO_CON14, 0x2),
32162306a36Sopenharmony_ci	MT6323_REG_FIXED("ldo_vrtc", VRTC, MT6323_DIGLDO_CON15, 8, 2800000,
32262306a36Sopenharmony_ci		-1, 0),
32362306a36Sopenharmony_ci	MT6323_LDO("ldo_vcamaf", VCAMAF, ldo_volt_table5,
32462306a36Sopenharmony_ci		MT6323_DIGLDO_CON31, 15, MT6323_DIGLDO_CON32, 0xE0,
32562306a36Sopenharmony_ci		MT6323_DIGLDO_CON31, 0x2),
32662306a36Sopenharmony_ci	MT6323_LDO("ldo_vibr", VIBR, ldo_volt_table5,
32762306a36Sopenharmony_ci		MT6323_DIGLDO_CON39, 15, MT6323_DIGLDO_CON40, 0xE0,
32862306a36Sopenharmony_ci		MT6323_DIGLDO_CON39, 0x2),
32962306a36Sopenharmony_ci	MT6323_REG_FIXED("ldo_vrf18", VRF18, MT6323_DIGLDO_CON45, 15, 1825000,
33062306a36Sopenharmony_ci		MT6323_DIGLDO_CON45, 0x2),
33162306a36Sopenharmony_ci	MT6323_LDO("ldo_vm", VM, ldo_volt_table9,
33262306a36Sopenharmony_ci		MT6323_DIGLDO_CON47, 14, MT6323_DIGLDO_CON48, 0x30,
33362306a36Sopenharmony_ci		MT6323_DIGLDO_CON47, 0x2),
33462306a36Sopenharmony_ci	MT6323_REG_FIXED("ldo_vio18", VIO18, MT6323_DIGLDO_CON49, 14, 1800000,
33562306a36Sopenharmony_ci		MT6323_DIGLDO_CON49, 0x2),
33662306a36Sopenharmony_ci	MT6323_LDO("ldo_vcamd", VCAMD, ldo_volt_table10,
33762306a36Sopenharmony_ci		MT6323_DIGLDO_CON51, 14, MT6323_DIGLDO_CON52, 0x60,
33862306a36Sopenharmony_ci		MT6323_DIGLDO_CON51, 0x2),
33962306a36Sopenharmony_ci	MT6323_REG_FIXED("ldo_vcamio", VCAMIO, MT6323_DIGLDO_CON53, 14, 1800000,
34062306a36Sopenharmony_ci		MT6323_DIGLDO_CON53, 0x2),
34162306a36Sopenharmony_ci};
34262306a36Sopenharmony_ci
34362306a36Sopenharmony_cistatic int mt6323_set_buck_vosel_reg(struct platform_device *pdev)
34462306a36Sopenharmony_ci{
34562306a36Sopenharmony_ci	struct mt6397_chip *mt6323 = dev_get_drvdata(pdev->dev.parent);
34662306a36Sopenharmony_ci	int i;
34762306a36Sopenharmony_ci	u32 regval;
34862306a36Sopenharmony_ci
34962306a36Sopenharmony_ci	for (i = 0; i < MT6323_MAX_REGULATOR; i++) {
35062306a36Sopenharmony_ci		if (mt6323_regulators[i].vselctrl_reg) {
35162306a36Sopenharmony_ci			if (regmap_read(mt6323->regmap,
35262306a36Sopenharmony_ci				mt6323_regulators[i].vselctrl_reg,
35362306a36Sopenharmony_ci				&regval) < 0) {
35462306a36Sopenharmony_ci				dev_err(&pdev->dev,
35562306a36Sopenharmony_ci					"Failed to read buck ctrl\n");
35662306a36Sopenharmony_ci				return -EIO;
35762306a36Sopenharmony_ci			}
35862306a36Sopenharmony_ci
35962306a36Sopenharmony_ci			if (regval & mt6323_regulators[i].vselctrl_mask) {
36062306a36Sopenharmony_ci				mt6323_regulators[i].desc.vsel_reg =
36162306a36Sopenharmony_ci				mt6323_regulators[i].vselon_reg;
36262306a36Sopenharmony_ci			}
36362306a36Sopenharmony_ci		}
36462306a36Sopenharmony_ci	}
36562306a36Sopenharmony_ci
36662306a36Sopenharmony_ci	return 0;
36762306a36Sopenharmony_ci}
36862306a36Sopenharmony_ci
36962306a36Sopenharmony_cistatic int mt6323_regulator_probe(struct platform_device *pdev)
37062306a36Sopenharmony_ci{
37162306a36Sopenharmony_ci	struct mt6397_chip *mt6323 = dev_get_drvdata(pdev->dev.parent);
37262306a36Sopenharmony_ci	struct regulator_config config = {};
37362306a36Sopenharmony_ci	struct regulator_dev *rdev;
37462306a36Sopenharmony_ci	int i;
37562306a36Sopenharmony_ci	u32 reg_value;
37662306a36Sopenharmony_ci
37762306a36Sopenharmony_ci	/* Query buck controller to select activated voltage register part */
37862306a36Sopenharmony_ci	if (mt6323_set_buck_vosel_reg(pdev))
37962306a36Sopenharmony_ci		return -EIO;
38062306a36Sopenharmony_ci
38162306a36Sopenharmony_ci	/* Read PMIC chip revision to update constraints and voltage table */
38262306a36Sopenharmony_ci	if (regmap_read(mt6323->regmap, MT6323_CID, &reg_value) < 0) {
38362306a36Sopenharmony_ci		dev_err(&pdev->dev, "Failed to read Chip ID\n");
38462306a36Sopenharmony_ci		return -EIO;
38562306a36Sopenharmony_ci	}
38662306a36Sopenharmony_ci	dev_info(&pdev->dev, "Chip ID = 0x%x\n", reg_value);
38762306a36Sopenharmony_ci
38862306a36Sopenharmony_ci	for (i = 0; i < MT6323_MAX_REGULATOR; i++) {
38962306a36Sopenharmony_ci		config.dev = &pdev->dev;
39062306a36Sopenharmony_ci		config.driver_data = &mt6323_regulators[i];
39162306a36Sopenharmony_ci		config.regmap = mt6323->regmap;
39262306a36Sopenharmony_ci		rdev = devm_regulator_register(&pdev->dev,
39362306a36Sopenharmony_ci				&mt6323_regulators[i].desc, &config);
39462306a36Sopenharmony_ci		if (IS_ERR(rdev)) {
39562306a36Sopenharmony_ci			dev_err(&pdev->dev, "failed to register %s\n",
39662306a36Sopenharmony_ci				mt6323_regulators[i].desc.name);
39762306a36Sopenharmony_ci			return PTR_ERR(rdev);
39862306a36Sopenharmony_ci		}
39962306a36Sopenharmony_ci	}
40062306a36Sopenharmony_ci	return 0;
40162306a36Sopenharmony_ci}
40262306a36Sopenharmony_ci
40362306a36Sopenharmony_cistatic const struct platform_device_id mt6323_platform_ids[] = {
40462306a36Sopenharmony_ci	{"mt6323-regulator", 0},
40562306a36Sopenharmony_ci	{ /* sentinel */ },
40662306a36Sopenharmony_ci};
40762306a36Sopenharmony_ciMODULE_DEVICE_TABLE(platform, mt6323_platform_ids);
40862306a36Sopenharmony_ci
40962306a36Sopenharmony_cistatic struct platform_driver mt6323_regulator_driver = {
41062306a36Sopenharmony_ci	.driver = {
41162306a36Sopenharmony_ci		.name = "mt6323-regulator",
41262306a36Sopenharmony_ci		.probe_type = PROBE_PREFER_ASYNCHRONOUS,
41362306a36Sopenharmony_ci	},
41462306a36Sopenharmony_ci	.probe = mt6323_regulator_probe,
41562306a36Sopenharmony_ci	.id_table = mt6323_platform_ids,
41662306a36Sopenharmony_ci};
41762306a36Sopenharmony_ci
41862306a36Sopenharmony_cimodule_platform_driver(mt6323_regulator_driver);
41962306a36Sopenharmony_ci
42062306a36Sopenharmony_ciMODULE_AUTHOR("Chen Zhong <chen.zhong@mediatek.com>");
42162306a36Sopenharmony_ciMODULE_DESCRIPTION("Regulator Driver for MediaTek MT6323 PMIC");
42262306a36Sopenharmony_ciMODULE_LICENSE("GPL v2");
423