Commit | Line | Data |
---|---|---|
9351ab8b CH |
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(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 | ||
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, | |
184ae0e3 | 109 | .bypass_mask = RT4831_DSVMODE_MASK, |
9351ab8b CH |
110 | .bypass_val_on = DSV_MODE_BYPASS, |
111 | .bypass_val_off = DSV_MODE_NORMAL, | |
5c42903e | 112 | .owner = THIS_MODULE, |
9351ab8b CH |
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, | |
aefe5fc3 | 130 | .active_discharge_on = RT4831_POSADEN_MASK, |
5c42903e | 131 | .owner = THIS_MODULE, |
9351ab8b CH |
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, | |
aefe5fc3 | 149 | .active_discharge_on = RT4831_NEGADEN_MASK, |
5c42903e | 150 | .owner = THIS_MODULE, |
9351ab8b CH |
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(pdev->dev.parent, NULL); | |
e9e7fce0 | 162 | if (!regmap) { |
9351ab8b | 163 | dev_err(&pdev->dev, "Failed to init regmap\n"); |
e9e7fce0 | 164 | return -ENODEV; |
9351ab8b CH |
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 | ||
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", | |
46600ab1 | 197 | .probe_type = PROBE_PREFER_ASYNCHRONOUS, |
9351ab8b CH |
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_LICENSE("GPL v2"); |