1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25#include <linux/module.h>
26#include <linux/init.h>
27#include <linux/slab.h>
28#include <linux/err.h>
29#include <linux/platform_device.h>
30#include <linux/regulator/driver.h>
31#include <linux/regulator/machine.h>
32#include <linux/gpio.h>
33#include <linux/mfd/rc5t583.h>
34
35struct rc5t583_regulator_info {
36 int deepsleep_id;
37
38
39 uint8_t reg_disc_reg;
40 uint8_t disc_bit;
41 uint8_t deepsleep_reg;
42
43
44 int enable_uv_per_us;
45
46
47 struct regulator_desc desc;
48};
49
50struct rc5t583_regulator {
51 struct rc5t583_regulator_info *reg_info;
52
53
54 struct device *dev;
55 struct rc5t583 *mfd;
56 struct regulator_dev *rdev;
57};
58
59static int rc5t583_regulator_enable_time(struct regulator_dev *rdev)
60{
61 struct rc5t583_regulator *reg = rdev_get_drvdata(rdev);
62 int vsel = regulator_get_voltage_sel_regmap(rdev);
63 int curr_uV = regulator_list_voltage_linear(rdev, vsel);
64
65 return DIV_ROUND_UP(curr_uV, reg->reg_info->enable_uv_per_us);
66}
67
68static struct regulator_ops rc5t583_ops = {
69 .is_enabled = regulator_is_enabled_regmap,
70 .enable = regulator_enable_regmap,
71 .disable = regulator_disable_regmap,
72 .enable_time = rc5t583_regulator_enable_time,
73 .get_voltage_sel = regulator_get_voltage_sel_regmap,
74 .set_voltage_sel = regulator_set_voltage_sel_regmap,
75 .list_voltage = regulator_list_voltage_linear,
76 .map_voltage = regulator_map_voltage_linear,
77 .set_voltage_time_sel = regulator_set_voltage_time_sel,
78};
79
80#define RC5T583_REG(_id, _en_reg, _en_bit, _disc_reg, _disc_bit, \
81 _vout_mask, _min_mv, _max_mv, _step_uV, _enable_mv) \
82{ \
83 .reg_disc_reg = RC5T583_REG_##_disc_reg, \
84 .disc_bit = _disc_bit, \
85 .deepsleep_reg = RC5T583_REG_##_id##DAC_DS, \
86 .enable_uv_per_us = _enable_mv * 1000, \
87 .deepsleep_id = RC5T583_DS_##_id, \
88 .desc = { \
89 .name = "rc5t583-regulator-"#_id, \
90 .id = RC5T583_REGULATOR_##_id, \
91 .n_voltages = (_max_mv - _min_mv) * 1000 / _step_uV + 1, \
92 .ops = &rc5t583_ops, \
93 .type = REGULATOR_VOLTAGE, \
94 .owner = THIS_MODULE, \
95 .vsel_reg = RC5T583_REG_##_id##DAC, \
96 .vsel_mask = _vout_mask, \
97 .enable_reg = RC5T583_REG_##_en_reg, \
98 .enable_mask = BIT(_en_bit), \
99 .min_uV = _min_mv * 1000, \
100 .uV_step = _step_uV, \
101 .ramp_delay = 40 * 1000, \
102 }, \
103}
104
105static struct rc5t583_regulator_info rc5t583_reg_info[RC5T583_REGULATOR_MAX] = {
106 RC5T583_REG(DC0, DC0CTL, 0, DC0CTL, 1, 0x7F, 700, 1500, 12500, 4),
107 RC5T583_REG(DC1, DC1CTL, 0, DC1CTL, 1, 0x7F, 700, 1500, 12500, 14),
108 RC5T583_REG(DC2, DC2CTL, 0, DC2CTL, 1, 0x7F, 900, 2400, 12500, 14),
109 RC5T583_REG(DC3, DC3CTL, 0, DC3CTL, 1, 0x7F, 900, 2400, 12500, 14),
110 RC5T583_REG(LDO0, LDOEN2, 0, LDODIS2, 0, 0x7F, 900, 3400, 25000, 160),
111 RC5T583_REG(LDO1, LDOEN2, 1, LDODIS2, 1, 0x7F, 900, 3400, 25000, 160),
112 RC5T583_REG(LDO2, LDOEN2, 2, LDODIS2, 2, 0x7F, 900, 3400, 25000, 160),
113 RC5T583_REG(LDO3, LDOEN2, 3, LDODIS2, 3, 0x7F, 900, 3400, 25000, 160),
114 RC5T583_REG(LDO4, LDOEN2, 4, LDODIS2, 4, 0x3F, 750, 1500, 12500, 133),
115 RC5T583_REG(LDO5, LDOEN2, 5, LDODIS2, 5, 0x7F, 900, 3400, 25000, 267),
116 RC5T583_REG(LDO6, LDOEN2, 6, LDODIS2, 6, 0x7F, 900, 3400, 25000, 133),
117 RC5T583_REG(LDO7, LDOEN2, 7, LDODIS2, 7, 0x7F, 900, 3400, 25000, 233),
118 RC5T583_REG(LDO8, LDOEN1, 0, LDODIS1, 0, 0x7F, 900, 3400, 25000, 233),
119 RC5T583_REG(LDO9, LDOEN1, 1, LDODIS1, 1, 0x7F, 900, 3400, 25000, 133),
120};
121
122static int rc5t583_regulator_probe(struct platform_device *pdev)
123{
124 struct rc5t583 *rc5t583 = dev_get_drvdata(pdev->dev.parent);
125 struct rc5t583_platform_data *pdata = dev_get_platdata(rc5t583->dev);
126 struct regulator_init_data *reg_data;
127 struct regulator_config config = { };
128 struct rc5t583_regulator *reg = NULL;
129 struct rc5t583_regulator *regs;
130 struct regulator_dev *rdev;
131 struct rc5t583_regulator_info *ri;
132 int ret;
133 int id;
134
135 if (!pdata) {
136 dev_err(&pdev->dev, "No platform data, exiting...\n");
137 return -ENODEV;
138 }
139
140 regs = devm_kzalloc(&pdev->dev, RC5T583_REGULATOR_MAX *
141 sizeof(struct rc5t583_regulator), GFP_KERNEL);
142 if (!regs) {
143 dev_err(&pdev->dev, "Memory allocation failed exiting..\n");
144 return -ENOMEM;
145 }
146
147
148 for (id = 0; id < RC5T583_REGULATOR_MAX; ++id) {
149 reg_data = pdata->reg_init_data[id];
150
151
152 if (!reg_data)
153 continue;
154
155 reg = ®s[id];
156 ri = &rc5t583_reg_info[id];
157 reg->reg_info = ri;
158 reg->mfd = rc5t583;
159 reg->dev = &pdev->dev;
160
161 if (ri->deepsleep_id == RC5T583_DS_NONE)
162 goto skip_ext_pwr_config;
163
164 ret = rc5t583_ext_power_req_config(rc5t583->dev,
165 ri->deepsleep_id,
166 pdata->regulator_ext_pwr_control[id],
167 pdata->regulator_deepsleep_slot[id]);
168
169
170
171
172 if (ret < 0)
173 dev_warn(&pdev->dev,
174 "Failed to configure ext control %d\n", id);
175
176skip_ext_pwr_config:
177 config.dev = &pdev->dev;
178 config.init_data = reg_data;
179 config.driver_data = reg;
180 config.regmap = rc5t583->regmap;
181
182 rdev = regulator_register(&ri->desc, &config);
183 if (IS_ERR(rdev)) {
184 dev_err(&pdev->dev, "Failed to register regulator %s\n",
185 ri->desc.name);
186 ret = PTR_ERR(rdev);
187 goto clean_exit;
188 }
189 reg->rdev = rdev;
190 }
191 platform_set_drvdata(pdev, regs);
192 return 0;
193
194clean_exit:
195 while (--id >= 0)
196 regulator_unregister(regs[id].rdev);
197
198 return ret;
199}
200
201static int rc5t583_regulator_remove(struct platform_device *pdev)
202{
203 struct rc5t583_regulator *regs = platform_get_drvdata(pdev);
204 int id;
205
206 for (id = 0; id < RC5T583_REGULATOR_MAX; ++id)
207 regulator_unregister(regs[id].rdev);
208 return 0;
209}
210
211static struct platform_driver rc5t583_regulator_driver = {
212 .driver = {
213 .name = "rc5t583-regulator",
214 .owner = THIS_MODULE,
215 },
216 .probe = rc5t583_regulator_probe,
217 .remove = rc5t583_regulator_remove,
218};
219
220static int __init rc5t583_regulator_init(void)
221{
222 return platform_driver_register(&rc5t583_regulator_driver);
223}
224subsys_initcall(rc5t583_regulator_init);
225
226static void __exit rc5t583_regulator_exit(void)
227{
228 platform_driver_unregister(&rc5t583_regulator_driver);
229}
230module_exit(rc5t583_regulator_exit);
231
232MODULE_AUTHOR("Laxman Dewangan <ldewangan@nvidia.com>");
233MODULE_DESCRIPTION("RC5T583 regulator driver");
234MODULE_ALIAS("platform:rc5t583-regulator");
235MODULE_LICENSE("GPL v2");
236
