207 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2 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 12enum {13 DSV_OUT_VLCM = 0,14 DSV_OUT_VPOS,15 DSV_OUT_VNEG,16 DSV_OUT_MAX17};18 19#define RT4831_REG_DSVEN 0x0920#define RT4831_REG_VLCM 0x0c21#define RT4831_REG_VPOS 0x0d22#define RT4831_REG_VNEG 0x0e23#define RT4831_REG_FLAGS 0x0f24 25#define RT4831_VOLT_MASK GENMASK(5, 0)26#define RT4831_DSVMODE_SHIFT 527#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 5000041#define VLCM_MIN_UV 400000042#define VLCM_MAX_UV 715000043#define VLCM_N_VOLTAGES ((VLCM_MAX_UV - VLCM_MIN_UV) / STEP_UV + 1)44#define VPN_MIN_UV 400000045#define VPN_MAX_UV 650000046#define VPN_N_VOLTAGES ((VPN_MAX_UV - VPN_MIN_UV) / STEP_UV + 1)47 48static 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(regmap, RT4831_REG_FLAGS, &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 75static 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 84static 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 95static 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 154static 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(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(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(&pdev->dev, rt4831_regulator_descs + i, &config);179 if (IS_ERR(rdev)) {180 dev_err(&pdev->dev, "Failed to register %d regulator\n", i);181 return PTR_ERR(rdev);182 }183 }184 185 return 0;186}187 188static const struct platform_device_id rt4831_regulator_match[] = {189 { "rt4831-regulator", 0 },190 {}191};192MODULE_DEVICE_TABLE(platform, rt4831_regulator_match);193 194static 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};202module_platform_driver(rt4831_regulator_driver);203 204MODULE_AUTHOR("ChiYuan Huang <cy_huang@richtek.com>");205MODULE_DESCRIPTION("Richtek RT4831 DSV Regulators driver");206MODULE_LICENSE("GPL v2");207