| 1 | // SPDX-License-Identifier: GPL-2.0-only |
| 2 | |
| 3 | #include <linux/bitops.h> |
| 4 | #include <linux/kernel.h> |
| 5 | #include <linux/module.h> |
| 6 | #include <linux/of.h> |
| 7 | #include <linux/platform_device.h> |
| 8 | #include <linux/regmap.h> |
| 9 | #include <linux/regulator/consumer.h> |
| 10 | #include <linux/regulator/driver.h> |
| 11 | |
| 12 | enum { |
| 13 | DSV_OUT_VLCM = 0, |
| 14 | DSV_OUT_VPOS, |
| 15 | DSV_OUT_VNEG, |
| 16 | DSV_OUT_MAX |
| 17 | }; |
| 18 | |
| 19 | #define RT4831_REG_DSVEN 0x09 |
| 20 | #define RT4831_REG_VLCM 0x0c |
| 21 | #define RT4831_REG_VPOS 0x0d |
| 22 | #define RT4831_REG_VNEG 0x0e |
| 23 | #define RT4831_REG_FLAGS 0x0f |
| 24 | |
| 25 | #define RT4831_VOLT_MASK GENMASK(5, 0) |
| 26 | #define RT4831_DSVMODE_SHIFT 5 |
| 27 | #define RT4831_DSVMODE_MASK GENMASK(7, 5) |
| 28 | #define RT4831_POSADEN_MASK BIT(4) |
| 29 | #define RT4831_NEGADEN_MASK BIT(3) |
| 30 | #define RT4831_POSEN_MASK BIT(2) |
| 31 | #define RT4831_NEGEN_MASK BIT(1) |
| 32 | |
| 33 | #define RT4831_OTP_MASK BIT(6) |
| 34 | #define RT4831_LCMOVP_MASK BIT(5) |
| 35 | #define RT4831_VPOSSCP_MASK BIT(3) |
| 36 | #define RT4831_VNEGSCP_MASK BIT(2) |
| 37 | |
| 38 | #define DSV_MODE_NORMAL (0x4 << RT4831_DSVMODE_SHIFT) |
| 39 | #define DSV_MODE_BYPASS (0x6 << RT4831_DSVMODE_SHIFT) |
| 40 | #define STEP_UV 50000 |
| 41 | #define VLCM_MIN_UV 4000000 |
| 42 | #define VLCM_MAX_UV 7150000 |
| 43 | #define VLCM_N_VOLTAGES ((VLCM_MAX_UV - VLCM_MIN_UV) / STEP_UV + 1) |
| 44 | #define VPN_MIN_UV 4000000 |
| 45 | #define VPN_MAX_UV 6500000 |
| 46 | #define VPN_N_VOLTAGES ((VPN_MAX_UV - VPN_MIN_UV) / STEP_UV + 1) |
| 47 | |
| 48 | static int rt4831_get_error_flags(struct regulator_dev *rdev, unsigned int *flags) |
| 49 | { |
| 50 | struct regmap *regmap = rdev_get_regmap(rdev); |
| 51 | int rid = rdev_get_id(rdev); |
| 52 | unsigned int val, events = 0; |
| 53 | int ret; |
| 54 | |
| 55 | ret = regmap_read(map: regmap, RT4831_REG_FLAGS, val: &val); |
| 56 | if (ret) |
| 57 | return ret; |
| 58 | |
| 59 | if (val & RT4831_OTP_MASK) |
| 60 | events |= REGULATOR_ERROR_OVER_TEMP; |
| 61 | |
| 62 | if (rid == DSV_OUT_VLCM && (val & RT4831_LCMOVP_MASK)) |
| 63 | events |= REGULATOR_ERROR_OVER_CURRENT; |
| 64 | |
| 65 | if (rid == DSV_OUT_VPOS && (val & RT4831_VPOSSCP_MASK)) |
| 66 | events |= REGULATOR_ERROR_OVER_CURRENT; |
| 67 | |
| 68 | if (rid == DSV_OUT_VNEG && (val & RT4831_VNEGSCP_MASK)) |
| 69 | events |= REGULATOR_ERROR_OVER_CURRENT; |
| 70 | |
| 71 | *flags = events; |
| 72 | return 0; |
| 73 | } |
| 74 | |
| 75 | static const struct regulator_ops rt4831_dsvlcm_ops = { |
| 76 | .list_voltage = regulator_list_voltage_linear, |
| 77 | .set_voltage_sel = regulator_set_voltage_sel_regmap, |
| 78 | .get_voltage_sel = regulator_get_voltage_sel_regmap, |
| 79 | .set_bypass = regulator_set_bypass_regmap, |
| 80 | .get_bypass = regulator_get_bypass_regmap, |
| 81 | .get_error_flags = rt4831_get_error_flags, |
| 82 | }; |
| 83 | |
| 84 | static const struct regulator_ops rt4831_dsvpn_ops = { |
| 85 | .list_voltage = regulator_list_voltage_linear, |
| 86 | .set_voltage_sel = regulator_set_voltage_sel_regmap, |
| 87 | .get_voltage_sel = regulator_get_voltage_sel_regmap, |
| 88 | .enable = regulator_enable_regmap, |
| 89 | .disable = regulator_disable_regmap, |
| 90 | .is_enabled = regulator_is_enabled_regmap, |
| 91 | .set_active_discharge = regulator_set_active_discharge_regmap, |
| 92 | .get_error_flags = rt4831_get_error_flags, |
| 93 | }; |
| 94 | |
| 95 | static const struct regulator_desc rt4831_regulator_descs[] = { |
| 96 | { |
| 97 | .name = "DSVLCM" , |
| 98 | .ops = &rt4831_dsvlcm_ops, |
| 99 | .of_match = of_match_ptr("DSVLCM" ), |
| 100 | .regulators_node = of_match_ptr("regulators" ), |
| 101 | .type = REGULATOR_VOLTAGE, |
| 102 | .id = DSV_OUT_VLCM, |
| 103 | .n_voltages = VLCM_N_VOLTAGES, |
| 104 | .min_uV = VLCM_MIN_UV, |
| 105 | .uV_step = STEP_UV, |
| 106 | .vsel_reg = RT4831_REG_VLCM, |
| 107 | .vsel_mask = RT4831_VOLT_MASK, |
| 108 | .bypass_reg = RT4831_REG_DSVEN, |
| 109 | .bypass_mask = RT4831_DSVMODE_MASK, |
| 110 | .bypass_val_on = DSV_MODE_BYPASS, |
| 111 | .bypass_val_off = DSV_MODE_NORMAL, |
| 112 | .owner = THIS_MODULE, |
| 113 | }, |
| 114 | { |
| 115 | .name = "DSVP" , |
| 116 | .ops = &rt4831_dsvpn_ops, |
| 117 | .of_match = of_match_ptr("DSVP" ), |
| 118 | .regulators_node = of_match_ptr("regulators" ), |
| 119 | .type = REGULATOR_VOLTAGE, |
| 120 | .id = DSV_OUT_VPOS, |
| 121 | .n_voltages = VPN_N_VOLTAGES, |
| 122 | .min_uV = VPN_MIN_UV, |
| 123 | .uV_step = STEP_UV, |
| 124 | .vsel_reg = RT4831_REG_VPOS, |
| 125 | .vsel_mask = RT4831_VOLT_MASK, |
| 126 | .enable_reg = RT4831_REG_DSVEN, |
| 127 | .enable_mask = RT4831_POSEN_MASK, |
| 128 | .active_discharge_reg = RT4831_REG_DSVEN, |
| 129 | .active_discharge_mask = RT4831_POSADEN_MASK, |
| 130 | .active_discharge_on = RT4831_POSADEN_MASK, |
| 131 | .owner = THIS_MODULE, |
| 132 | }, |
| 133 | { |
| 134 | .name = "DSVN" , |
| 135 | .ops = &rt4831_dsvpn_ops, |
| 136 | .of_match = of_match_ptr("DSVN" ), |
| 137 | .regulators_node = of_match_ptr("regulators" ), |
| 138 | .type = REGULATOR_VOLTAGE, |
| 139 | .id = DSV_OUT_VNEG, |
| 140 | .n_voltages = VPN_N_VOLTAGES, |
| 141 | .min_uV = VPN_MIN_UV, |
| 142 | .uV_step = STEP_UV, |
| 143 | .vsel_reg = RT4831_REG_VNEG, |
| 144 | .vsel_mask = RT4831_VOLT_MASK, |
| 145 | .enable_reg = RT4831_REG_DSVEN, |
| 146 | .enable_mask = RT4831_NEGEN_MASK, |
| 147 | .active_discharge_reg = RT4831_REG_DSVEN, |
| 148 | .active_discharge_mask = RT4831_NEGADEN_MASK, |
| 149 | .active_discharge_on = RT4831_NEGADEN_MASK, |
| 150 | .owner = THIS_MODULE, |
| 151 | } |
| 152 | }; |
| 153 | |
| 154 | static int rt4831_regulator_probe(struct platform_device *pdev) |
| 155 | { |
| 156 | struct regmap *regmap; |
| 157 | struct regulator_dev *rdev; |
| 158 | struct regulator_config config = {}; |
| 159 | int i, ret; |
| 160 | |
| 161 | regmap = dev_get_regmap(dev: pdev->dev.parent, NULL); |
| 162 | if (!regmap) { |
| 163 | dev_err(&pdev->dev, "Failed to init regmap\n" ); |
| 164 | return -ENODEV; |
| 165 | } |
| 166 | |
| 167 | /* Configure DSV mode to normal by default */ |
| 168 | ret = regmap_update_bits(map: regmap, RT4831_REG_DSVEN, RT4831_DSVMODE_MASK, DSV_MODE_NORMAL); |
| 169 | if (ret) { |
| 170 | dev_err(&pdev->dev, "Failed to configure dsv mode to normal\n" ); |
| 171 | return ret; |
| 172 | } |
| 173 | |
| 174 | config.dev = pdev->dev.parent; |
| 175 | config.regmap = regmap; |
| 176 | |
| 177 | for (i = 0; i < DSV_OUT_MAX; i++) { |
| 178 | rdev = devm_regulator_register(dev: &pdev->dev, regulator_desc: rt4831_regulator_descs + i, config: &config); |
| 179 | if (IS_ERR(ptr: rdev)) { |
| 180 | dev_err(&pdev->dev, "Failed to register %d regulator\n" , i); |
| 181 | return PTR_ERR(ptr: rdev); |
| 182 | } |
| 183 | } |
| 184 | |
| 185 | return 0; |
| 186 | } |
| 187 | |
| 188 | static const struct platform_device_id rt4831_regulator_match[] = { |
| 189 | { "rt4831-regulator" , 0 }, |
| 190 | {} |
| 191 | }; |
| 192 | MODULE_DEVICE_TABLE(platform, rt4831_regulator_match); |
| 193 | |
| 194 | static struct platform_driver rt4831_regulator_driver = { |
| 195 | .driver = { |
| 196 | .name = "rt4831-regulator" , |
| 197 | .probe_type = PROBE_PREFER_ASYNCHRONOUS, |
| 198 | }, |
| 199 | .id_table = rt4831_regulator_match, |
| 200 | .probe = rt4831_regulator_probe, |
| 201 | }; |
| 202 | module_platform_driver(rt4831_regulator_driver); |
| 203 | |
| 204 | MODULE_AUTHOR("ChiYuan Huang <cy_huang@richtek.com>" ); |
| 205 | MODULE_DESCRIPTION("Richtek RT4831 DSV Regulators driver" ); |
| 206 | MODULE_LICENSE("GPL v2" ); |
| 207 | |