Back to home page

OSCL-LXR

 
 

    


0001 // SPDX-License-Identifier: GPL-2.0-only
0002 
0003 #include <linux/bitops.h>
0004 #include <linux/kernel.h>
0005 #include <linux/module.h>
0006 #include <linux/of.h>
0007 #include <linux/platform_device.h>
0008 #include <linux/regmap.h>
0009 #include <linux/regulator/consumer.h>
0010 #include <linux/regulator/driver.h>
0011 
0012 enum {
0013     DSV_OUT_VLCM = 0,
0014     DSV_OUT_VPOS,
0015     DSV_OUT_VNEG,
0016     DSV_OUT_MAX
0017 };
0018 
0019 #define RT4831_REG_DSVEN    0x09
0020 #define RT4831_REG_VLCM     0x0c
0021 #define RT4831_REG_VPOS     0x0d
0022 #define RT4831_REG_VNEG     0x0e
0023 #define RT4831_REG_FLAGS    0x0f
0024 
0025 #define RT4831_VOLT_MASK    GENMASK(5, 0)
0026 #define RT4831_DSVMODE_SHIFT    5
0027 #define RT4831_DSVMODE_MASK GENMASK(7, 5)
0028 #define RT4831_POSADEN_MASK BIT(4)
0029 #define RT4831_NEGADEN_MASK BIT(3)
0030 #define RT4831_POSEN_MASK   BIT(2)
0031 #define RT4831_NEGEN_MASK   BIT(1)
0032 
0033 #define RT4831_OTP_MASK     BIT(6)
0034 #define RT4831_LCMOVP_MASK  BIT(5)
0035 #define RT4831_VPOSSCP_MASK BIT(3)
0036 #define RT4831_VNEGSCP_MASK BIT(2)
0037 
0038 #define DSV_MODE_NORMAL     (0x4 << RT4831_DSVMODE_SHIFT)
0039 #define DSV_MODE_BYPASS     (0x6 << RT4831_DSVMODE_SHIFT)
0040 #define STEP_UV         50000
0041 #define VLCM_MIN_UV     4000000
0042 #define VLCM_MAX_UV     7150000
0043 #define VLCM_N_VOLTAGES     ((VLCM_MAX_UV - VLCM_MIN_UV) / STEP_UV + 1)
0044 #define VPN_MIN_UV      4000000
0045 #define VPN_MAX_UV      6500000
0046 #define VPN_N_VOLTAGES      ((VPN_MAX_UV - VPN_MIN_UV) / STEP_UV + 1)
0047 
0048 static int rt4831_get_error_flags(struct regulator_dev *rdev, unsigned int *flags)
0049 {
0050     struct regmap *regmap = rdev_get_regmap(rdev);
0051     int rid = rdev_get_id(rdev);
0052     unsigned int val, events = 0;
0053     int ret;
0054 
0055     ret = regmap_read(regmap, RT4831_REG_FLAGS, &val);
0056     if (ret)
0057         return ret;
0058 
0059     if (val & RT4831_OTP_MASK)
0060         events |= REGULATOR_ERROR_OVER_TEMP;
0061 
0062     if (rid == DSV_OUT_VLCM && (val & RT4831_LCMOVP_MASK))
0063         events |= REGULATOR_ERROR_OVER_CURRENT;
0064 
0065     if (rid == DSV_OUT_VPOS && (val & RT4831_VPOSSCP_MASK))
0066         events |= REGULATOR_ERROR_OVER_CURRENT;
0067 
0068     if (rid == DSV_OUT_VNEG && (val & RT4831_VNEGSCP_MASK))
0069         events |= REGULATOR_ERROR_OVER_CURRENT;
0070 
0071     *flags = events;
0072     return 0;
0073 }
0074 
0075 static const struct regulator_ops rt4831_dsvlcm_ops = {
0076     .list_voltage = regulator_list_voltage_linear,
0077     .set_voltage_sel = regulator_set_voltage_sel_regmap,
0078     .get_voltage_sel = regulator_get_voltage_sel_regmap,
0079     .set_bypass = regulator_set_bypass_regmap,
0080     .get_bypass = regulator_get_bypass_regmap,
0081     .get_error_flags = rt4831_get_error_flags,
0082 };
0083 
0084 static const struct regulator_ops rt4831_dsvpn_ops = {
0085     .list_voltage = regulator_list_voltage_linear,
0086     .set_voltage_sel = regulator_set_voltage_sel_regmap,
0087     .get_voltage_sel = regulator_get_voltage_sel_regmap,
0088     .enable = regulator_enable_regmap,
0089     .disable = regulator_disable_regmap,
0090     .is_enabled = regulator_is_enabled_regmap,
0091     .set_active_discharge = regulator_set_active_discharge_regmap,
0092     .get_error_flags = rt4831_get_error_flags,
0093 };
0094 
0095 static const struct regulator_desc rt4831_regulator_descs[] = {
0096     {
0097         .name = "DSVLCM",
0098         .ops = &rt4831_dsvlcm_ops,
0099         .of_match = of_match_ptr("DSVLCM"),
0100         .regulators_node = of_match_ptr("regulators"),
0101         .type = REGULATOR_VOLTAGE,
0102         .id = DSV_OUT_VLCM,
0103         .n_voltages = VLCM_N_VOLTAGES,
0104         .min_uV = VLCM_MIN_UV,
0105         .uV_step = STEP_UV,
0106         .vsel_reg = RT4831_REG_VLCM,
0107         .vsel_mask = RT4831_VOLT_MASK,
0108         .bypass_reg = RT4831_REG_DSVEN,
0109         .bypass_mask = RT4831_DSVMODE_MASK,
0110         .bypass_val_on = DSV_MODE_BYPASS,
0111         .bypass_val_off = DSV_MODE_NORMAL,
0112         .owner = THIS_MODULE,
0113     },
0114     {
0115         .name = "DSVP",
0116         .ops = &rt4831_dsvpn_ops,
0117         .of_match = of_match_ptr("DSVP"),
0118         .regulators_node = of_match_ptr("regulators"),
0119         .type = REGULATOR_VOLTAGE,
0120         .id = DSV_OUT_VPOS,
0121         .n_voltages = VPN_N_VOLTAGES,
0122         .min_uV = VPN_MIN_UV,
0123         .uV_step = STEP_UV,
0124         .vsel_reg = RT4831_REG_VPOS,
0125         .vsel_mask = RT4831_VOLT_MASK,
0126         .enable_reg = RT4831_REG_DSVEN,
0127         .enable_mask = RT4831_POSEN_MASK,
0128         .active_discharge_reg = RT4831_REG_DSVEN,
0129         .active_discharge_mask = RT4831_POSADEN_MASK,
0130         .active_discharge_on = RT4831_POSADEN_MASK,
0131         .owner = THIS_MODULE,
0132     },
0133     {
0134         .name = "DSVN",
0135         .ops = &rt4831_dsvpn_ops,
0136         .of_match = of_match_ptr("DSVN"),
0137         .regulators_node = of_match_ptr("regulators"),
0138         .type = REGULATOR_VOLTAGE,
0139         .id = DSV_OUT_VNEG,
0140         .n_voltages = VPN_N_VOLTAGES,
0141         .min_uV = VPN_MIN_UV,
0142         .uV_step = STEP_UV,
0143         .vsel_reg = RT4831_REG_VNEG,
0144         .vsel_mask = RT4831_VOLT_MASK,
0145         .enable_reg = RT4831_REG_DSVEN,
0146         .enable_mask = RT4831_NEGEN_MASK,
0147         .active_discharge_reg = RT4831_REG_DSVEN,
0148         .active_discharge_mask = RT4831_NEGADEN_MASK,
0149         .active_discharge_on = RT4831_NEGADEN_MASK,
0150         .owner = THIS_MODULE,
0151     }
0152 };
0153 
0154 static int rt4831_regulator_probe(struct platform_device *pdev)
0155 {
0156     struct regmap *regmap;
0157     struct regulator_dev *rdev;
0158     struct regulator_config config = {};
0159     int i, ret;
0160 
0161     regmap = dev_get_regmap(pdev->dev.parent, NULL);
0162     if (!regmap) {
0163         dev_err(&pdev->dev, "Failed to init regmap\n");
0164         return -ENODEV;
0165     }
0166 
0167     /* Configure DSV mode to normal by default */
0168     ret = regmap_update_bits(regmap, RT4831_REG_DSVEN, RT4831_DSVMODE_MASK, DSV_MODE_NORMAL);
0169     if (ret) {
0170         dev_err(&pdev->dev, "Failed to configure dsv mode to normal\n");
0171         return ret;
0172     }
0173 
0174     config.dev = pdev->dev.parent;
0175     config.regmap = regmap;
0176 
0177     for (i = 0; i < DSV_OUT_MAX; i++) {
0178         rdev = devm_regulator_register(&pdev->dev, rt4831_regulator_descs + i, &config);
0179         if (IS_ERR(rdev)) {
0180             dev_err(&pdev->dev, "Failed to register %d regulator\n", i);
0181             return PTR_ERR(rdev);
0182         }
0183     }
0184 
0185     return 0;
0186 }
0187 
0188 static const struct platform_device_id rt4831_regulator_match[] = {
0189     { "rt4831-regulator", 0 },
0190     {}
0191 };
0192 MODULE_DEVICE_TABLE(platform, rt4831_regulator_match);
0193 
0194 static struct platform_driver rt4831_regulator_driver = {
0195     .driver = {
0196         .name = "rt4831-regulator",
0197     },
0198     .id_table = rt4831_regulator_match,
0199     .probe = rt4831_regulator_probe,
0200 };
0201 module_platform_driver(rt4831_regulator_driver);
0202 
0203 MODULE_AUTHOR("ChiYuan Huang <cy_huang@richtek.com>");
0204 MODULE_LICENSE("GPL v2");