]>
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, | |
109 | .bypass_val_on = DSV_MODE_BYPASS, | |
110 | .bypass_val_off = DSV_MODE_NORMAL, | |
5c42903e | 111 | .owner = THIS_MODULE, |
9351ab8b CH |
112 | }, |
113 | { | |
114 | .name = "DSVP", | |
115 | .ops = &rt4831_dsvpn_ops, | |
116 | .of_match = of_match_ptr("DSVP"), | |
117 | .regulators_node = of_match_ptr("regulators"), | |
118 | .type = REGULATOR_VOLTAGE, | |
119 | .id = DSV_OUT_VPOS, | |
120 | .n_voltages = VPN_N_VOLTAGES, | |
121 | .min_uV = VPN_MIN_UV, | |
122 | .uV_step = STEP_UV, | |
123 | .vsel_reg = RT4831_REG_VPOS, | |
124 | .vsel_mask = RT4831_VOLT_MASK, | |
125 | .enable_reg = RT4831_REG_DSVEN, | |
126 | .enable_mask = RT4831_POSEN_MASK, | |
127 | .active_discharge_reg = RT4831_REG_DSVEN, | |
128 | .active_discharge_mask = RT4831_POSADEN_MASK, | |
5c42903e | 129 | .owner = THIS_MODULE, |
9351ab8b CH |
130 | }, |
131 | { | |
132 | .name = "DSVN", | |
133 | .ops = &rt4831_dsvpn_ops, | |
134 | .of_match = of_match_ptr("DSVN"), | |
135 | .regulators_node = of_match_ptr("regulators"), | |
136 | .type = REGULATOR_VOLTAGE, | |
137 | .id = DSV_OUT_VNEG, | |
138 | .n_voltages = VPN_N_VOLTAGES, | |
139 | .min_uV = VPN_MIN_UV, | |
140 | .uV_step = STEP_UV, | |
141 | .vsel_reg = RT4831_REG_VNEG, | |
142 | .vsel_mask = RT4831_VOLT_MASK, | |
143 | .enable_reg = RT4831_REG_DSVEN, | |
144 | .enable_mask = RT4831_NEGEN_MASK, | |
145 | .active_discharge_reg = RT4831_REG_DSVEN, | |
146 | .active_discharge_mask = RT4831_NEGADEN_MASK, | |
5c42903e | 147 | .owner = THIS_MODULE, |
9351ab8b CH |
148 | } |
149 | }; | |
150 | ||
151 | static int rt4831_regulator_probe(struct platform_device *pdev) | |
152 | { | |
153 | struct regmap *regmap; | |
154 | struct regulator_dev *rdev; | |
155 | struct regulator_config config = {}; | |
156 | int i, ret; | |
157 | ||
158 | regmap = dev_get_regmap(pdev->dev.parent, NULL); | |
e9e7fce0 | 159 | if (!regmap) { |
9351ab8b | 160 | dev_err(&pdev->dev, "Failed to init regmap\n"); |
e9e7fce0 | 161 | return -ENODEV; |
9351ab8b CH |
162 | } |
163 | ||
164 | /* Configure DSV mode to normal by default */ | |
165 | ret = regmap_update_bits(regmap, RT4831_REG_DSVEN, RT4831_DSVMODE_MASK, DSV_MODE_NORMAL); | |
166 | if (ret) { | |
167 | dev_err(&pdev->dev, "Failed to configure dsv mode to normal\n"); | |
168 | return ret; | |
169 | } | |
170 | ||
171 | config.dev = pdev->dev.parent; | |
172 | config.regmap = regmap; | |
173 | ||
174 | for (i = 0; i < DSV_OUT_MAX; i++) { | |
175 | rdev = devm_regulator_register(&pdev->dev, rt4831_regulator_descs + i, &config); | |
176 | if (IS_ERR(rdev)) { | |
177 | dev_err(&pdev->dev, "Failed to register %d regulator\n", i); | |
178 | return PTR_ERR(rdev); | |
179 | } | |
180 | } | |
181 | ||
182 | return 0; | |
183 | } | |
184 | ||
185 | static const struct platform_device_id rt4831_regulator_match[] = { | |
186 | { "rt4831-regulator", 0 }, | |
187 | {} | |
188 | }; | |
189 | MODULE_DEVICE_TABLE(platform, rt4831_regulator_match); | |
190 | ||
191 | static struct platform_driver rt4831_regulator_driver = { | |
192 | .driver = { | |
193 | .name = "rt4831-regulator", | |
194 | }, | |
195 | .id_table = rt4831_regulator_match, | |
196 | .probe = rt4831_regulator_probe, | |
197 | }; | |
198 | module_platform_driver(rt4831_regulator_driver); | |
199 | ||
200 | MODULE_AUTHOR("ChiYuan Huang <cy_huang@richtek.com>"); | |
201 | MODULE_LICENSE("GPL v2"); |