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, ®val); 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 ®val) < 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, ®_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