Commit | Line | Data |
---|---|---|
3cad5fc8 AL |
1 | // SPDX-License-Identifier: GPL-2.0+ |
2 | // | |
3 | // wm831x-isink.c -- Current sink driver for the WM831x series | |
4 | // | |
5 | // Copyright 2009 Wolfson Microelectronics PLC. | |
6 | // | |
7 | // Author: Mark Brown <broonie@opensource.wolfsonmicro.com> | |
d4d6b722 MB |
8 | |
9 | #include <linux/module.h> | |
10 | #include <linux/moduleparam.h> | |
11 | #include <linux/init.h> | |
12 | #include <linux/bitops.h> | |
13 | #include <linux/err.h> | |
14 | #include <linux/i2c.h> | |
15 | #include <linux/platform_device.h> | |
16 | #include <linux/regulator/driver.h> | |
5a0e3ad6 | 17 | #include <linux/slab.h> |
d4d6b722 MB |
18 | |
19 | #include <linux/mfd/wm831x/core.h> | |
20 | #include <linux/mfd/wm831x/regulator.h> | |
21 | #include <linux/mfd/wm831x/pdata.h> | |
22 | ||
23 | #define WM831X_ISINK_MAX_NAME 7 | |
24 | ||
25 | struct wm831x_isink { | |
26 | char name[WM831X_ISINK_MAX_NAME]; | |
27 | struct regulator_desc desc; | |
28 | int reg; | |
29 | struct wm831x *wm831x; | |
30 | struct regulator_dev *regulator; | |
31 | }; | |
32 | ||
33 | static int wm831x_isink_enable(struct regulator_dev *rdev) | |
34 | { | |
35 | struct wm831x_isink *isink = rdev_get_drvdata(rdev); | |
36 | struct wm831x *wm831x = isink->wm831x; | |
37 | int ret; | |
38 | ||
39 | /* We have a two stage enable: first start the ISINK... */ | |
40 | ret = wm831x_set_bits(wm831x, isink->reg, WM831X_CS1_ENA, | |
41 | WM831X_CS1_ENA); | |
42 | if (ret != 0) | |
43 | return ret; | |
44 | ||
45 | /* ...then enable drive */ | |
46 | ret = wm831x_set_bits(wm831x, isink->reg, WM831X_CS1_DRIVE, | |
47 | WM831X_CS1_DRIVE); | |
48 | if (ret != 0) | |
49 | wm831x_set_bits(wm831x, isink->reg, WM831X_CS1_ENA, 0); | |
50 | ||
51 | return ret; | |
52 | ||
53 | } | |
54 | ||
55 | static int wm831x_isink_disable(struct regulator_dev *rdev) | |
56 | { | |
57 | struct wm831x_isink *isink = rdev_get_drvdata(rdev); | |
58 | struct wm831x *wm831x = isink->wm831x; | |
59 | int ret; | |
60 | ||
61 | ret = wm831x_set_bits(wm831x, isink->reg, WM831X_CS1_DRIVE, 0); | |
62 | if (ret < 0) | |
63 | return ret; | |
64 | ||
65 | ret = wm831x_set_bits(wm831x, isink->reg, WM831X_CS1_ENA, 0); | |
66 | if (ret < 0) | |
67 | return ret; | |
68 | ||
69 | return ret; | |
70 | ||
71 | } | |
72 | ||
73 | static int wm831x_isink_is_enabled(struct regulator_dev *rdev) | |
74 | { | |
75 | struct wm831x_isink *isink = rdev_get_drvdata(rdev); | |
76 | struct wm831x *wm831x = isink->wm831x; | |
77 | int ret; | |
78 | ||
79 | ret = wm831x_reg_read(wm831x, isink->reg); | |
80 | if (ret < 0) | |
81 | return ret; | |
82 | ||
83 | if ((ret & (WM831X_CS1_ENA | WM831X_CS1_DRIVE)) == | |
84 | (WM831X_CS1_ENA | WM831X_CS1_DRIVE)) | |
85 | return 1; | |
86 | else | |
87 | return 0; | |
88 | } | |
89 | ||
b0d6dd3b | 90 | static const struct regulator_ops wm831x_isink_ops = { |
d4d6b722 MB |
91 | .is_enabled = wm831x_isink_is_enabled, |
92 | .enable = wm831x_isink_enable, | |
93 | .disable = wm831x_isink_disable, | |
d48acfd0 AL |
94 | .set_current_limit = regulator_set_current_limit_regmap, |
95 | .get_current_limit = regulator_get_current_limit_regmap, | |
d4d6b722 MB |
96 | }; |
97 | ||
98 | static irqreturn_t wm831x_isink_irq(int irq, void *data) | |
99 | { | |
100 | struct wm831x_isink *isink = data; | |
101 | ||
f7a62172 | 102 | regulator_lock(isink->regulator); |
d4d6b722 MB |
103 | regulator_notifier_call_chain(isink->regulator, |
104 | REGULATOR_EVENT_OVER_CURRENT, | |
105 | NULL); | |
f7a62172 | 106 | regulator_unlock(isink->regulator); |
d4d6b722 MB |
107 | |
108 | return IRQ_HANDLED; | |
109 | } | |
110 | ||
111 | ||
a5023574 | 112 | static int wm831x_isink_probe(struct platform_device *pdev) |
d4d6b722 MB |
113 | { |
114 | struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent); | |
dff91d0b | 115 | struct wm831x_pdata *pdata = dev_get_platdata(wm831x->dev); |
d4d6b722 MB |
116 | struct wm831x_isink *isink; |
117 | int id = pdev->id % ARRAY_SIZE(pdata->isink); | |
c172708d | 118 | struct regulator_config config = { }; |
d4d6b722 MB |
119 | struct resource *res; |
120 | int ret, irq; | |
121 | ||
122 | dev_dbg(&pdev->dev, "Probing ISINK%d\n", id + 1); | |
123 | ||
124 | if (pdata == NULL || pdata->isink[id] == NULL) | |
125 | return -ENODEV; | |
126 | ||
fded2f4f MB |
127 | isink = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_isink), |
128 | GFP_KERNEL); | |
d718debc | 129 | if (!isink) |
d4d6b722 | 130 | return -ENOMEM; |
d4d6b722 | 131 | |
e8092da9 MB |
132 | isink->wm831x = wm831x; |
133 | ||
5656098e | 134 | res = platform_get_resource(pdev, IORESOURCE_REG, 0); |
d4d6b722 | 135 | if (res == NULL) { |
5656098e | 136 | dev_err(&pdev->dev, "No REG resource\n"); |
d4d6b722 MB |
137 | ret = -EINVAL; |
138 | goto err; | |
139 | } | |
140 | isink->reg = res->start; | |
141 | ||
142 | /* For current parts this is correct; probably need to revisit | |
143 | * in future. | |
144 | */ | |
145 | snprintf(isink->name, sizeof(isink->name), "ISINK%d", id + 1); | |
146 | isink->desc.name = isink->name; | |
147 | isink->desc.id = id; | |
148 | isink->desc.ops = &wm831x_isink_ops; | |
149 | isink->desc.type = REGULATOR_CURRENT; | |
150 | isink->desc.owner = THIS_MODULE; | |
d48acfd0 AL |
151 | isink->desc.curr_table = wm831x_isinkv_values, |
152 | isink->desc.n_current_limits = ARRAY_SIZE(wm831x_isinkv_values), | |
153 | isink->desc.csel_reg = isink->reg, | |
154 | isink->desc.csel_mask = WM831X_CS1_ISEL_MASK, | |
d4d6b722 | 155 | |
c172708d MB |
156 | config.dev = pdev->dev.parent; |
157 | config.init_data = pdata->isink[id]; | |
158 | config.driver_data = isink; | |
d48acfd0 | 159 | config.regmap = wm831x->regmap; |
c172708d | 160 | |
af151ded MB |
161 | isink->regulator = devm_regulator_register(&pdev->dev, &isink->desc, |
162 | &config); | |
d4d6b722 MB |
163 | if (IS_ERR(isink->regulator)) { |
164 | ret = PTR_ERR(isink->regulator); | |
165 | dev_err(wm831x->dev, "Failed to register ISINK%d: %d\n", | |
166 | id + 1, ret); | |
167 | goto err; | |
168 | } | |
169 | ||
cd99758b | 170 | irq = wm831x_irq(wm831x, platform_get_irq(pdev, 0)); |
63fb3149 MB |
171 | ret = devm_request_threaded_irq(&pdev->dev, irq, NULL, |
172 | wm831x_isink_irq, | |
29454738 FE |
173 | IRQF_TRIGGER_RISING | IRQF_ONESHOT, |
174 | isink->name, | |
63fb3149 | 175 | isink); |
d4d6b722 MB |
176 | if (ret != 0) { |
177 | dev_err(&pdev->dev, "Failed to request ISINK IRQ %d: %d\n", | |
178 | irq, ret); | |
af151ded | 179 | goto err; |
d4d6b722 MB |
180 | } |
181 | ||
182 | platform_set_drvdata(pdev, isink); | |
183 | ||
184 | return 0; | |
185 | ||
d4d6b722 | 186 | err: |
d4d6b722 MB |
187 | return ret; |
188 | } | |
189 | ||
d4d6b722 MB |
190 | static struct platform_driver wm831x_isink_driver = { |
191 | .probe = wm831x_isink_probe, | |
d4d6b722 MB |
192 | .driver = { |
193 | .name = "wm831x-isink", | |
194 | }, | |
195 | }; | |
196 | ||
197 | static int __init wm831x_isink_init(void) | |
198 | { | |
199 | int ret; | |
200 | ret = platform_driver_register(&wm831x_isink_driver); | |
201 | if (ret != 0) | |
202 | pr_err("Failed to register WM831x ISINK driver: %d\n", ret); | |
203 | ||
204 | return ret; | |
205 | } | |
206 | subsys_initcall(wm831x_isink_init); | |
207 | ||
208 | static void __exit wm831x_isink_exit(void) | |
209 | { | |
210 | platform_driver_unregister(&wm831x_isink_driver); | |
211 | } | |
212 | module_exit(wm831x_isink_exit); | |
213 | ||
214 | /* Module information */ | |
215 | MODULE_AUTHOR("Mark Brown"); | |
216 | MODULE_DESCRIPTION("WM831x current sink driver"); | |
217 | MODULE_LICENSE("GPL"); | |
218 | MODULE_ALIAS("platform:wm831x-isink"); |