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