diff options
author | Quentin Schulz <quentin.schulz@free-electrons.com> | 2017-04-04 02:34:41 -0400 |
---|---|---|
committer | Lee Jones <lee.jones@linaro.org> | 2017-04-27 04:25:07 -0400 |
commit | 0e34d5de961d5a8a84cf77878ca871c6e8104620 (patch) | |
tree | ab1eb178d67f1320548b0530cae31743daad27a9 | |
parent | be269180c9335c257a2763c3fd3a44e65c90c1f0 (diff) |
iio: adc: add support for X-Powers AXP20X and AXP22X PMICs ADCs
The X-Powers AXP20X and AXP22X PMICs have multiple ADCs. They expose the
battery voltage, battery charge and discharge currents, AC-in and VBUS
voltages and currents, 2 GPIOs muxable in ADC mode and PMIC temperature.
This adds support for most of AXP20X and AXP22X ADCs.
Signed-off-by: Quentin Schulz <quentin.schulz@free-electrons.com>
Acked-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Acked-by: Chen-Yu Tsai <wens@csie.org>
Reviewed-by: Jonathan Cameron <jic23@kernel.org>
Signed-off-by: Lee Jones <lee.jones@linaro.org>
-rw-r--r-- | drivers/iio/adc/Kconfig | 10 | ||||
-rw-r--r-- | drivers/iio/adc/Makefile | 1 | ||||
-rw-r--r-- | drivers/iio/adc/axp20x_adc.c | 617 |
3 files changed, 628 insertions, 0 deletions
diff --git a/drivers/iio/adc/Kconfig b/drivers/iio/adc/Kconfig index 5d134053a1bc..ff5ad3be55b4 100644 --- a/drivers/iio/adc/Kconfig +++ b/drivers/iio/adc/Kconfig | |||
@@ -154,6 +154,16 @@ config AT91_SAMA5D2_ADC | |||
154 | To compile this driver as a module, choose M here: the module will be | 154 | To compile this driver as a module, choose M here: the module will be |
155 | called at91-sama5d2_adc. | 155 | called at91-sama5d2_adc. |
156 | 156 | ||
157 | config AXP20X_ADC | ||
158 | tristate "X-Powers AXP20X and AXP22X ADC driver" | ||
159 | depends on MFD_AXP20X | ||
160 | help | ||
161 | Say yes here to have support for X-Powers power management IC (PMIC) | ||
162 | AXP20X and AXP22X ADC devices. | ||
163 | |||
164 | To compile this driver as a module, choose M here: the module will be | ||
165 | called axp20x_adc. | ||
166 | |||
157 | config AXP288_ADC | 167 | config AXP288_ADC |
158 | tristate "X-Powers AXP288 ADC driver" | 168 | tristate "X-Powers AXP288 ADC driver" |
159 | depends on MFD_AXP20X | 169 | depends on MFD_AXP20X |
diff --git a/drivers/iio/adc/Makefile b/drivers/iio/adc/Makefile index 54b5f7259063..a01de757f42c 100644 --- a/drivers/iio/adc/Makefile +++ b/drivers/iio/adc/Makefile | |||
@@ -16,6 +16,7 @@ obj-$(CONFIG_AD7887) += ad7887.o | |||
16 | obj-$(CONFIG_AD799X) += ad799x.o | 16 | obj-$(CONFIG_AD799X) += ad799x.o |
17 | obj-$(CONFIG_AT91_ADC) += at91_adc.o | 17 | obj-$(CONFIG_AT91_ADC) += at91_adc.o |
18 | obj-$(CONFIG_AT91_SAMA5D2_ADC) += at91-sama5d2_adc.o | 18 | obj-$(CONFIG_AT91_SAMA5D2_ADC) += at91-sama5d2_adc.o |
19 | obj-$(CONFIG_AXP20X_ADC) += axp20x_adc.o | ||
19 | obj-$(CONFIG_AXP288_ADC) += axp288_adc.o | 20 | obj-$(CONFIG_AXP288_ADC) += axp288_adc.o |
20 | obj-$(CONFIG_BCM_IPROC_ADC) += bcm_iproc_adc.o | 21 | obj-$(CONFIG_BCM_IPROC_ADC) += bcm_iproc_adc.o |
21 | obj-$(CONFIG_BERLIN2_ADC) += berlin2-adc.o | 22 | obj-$(CONFIG_BERLIN2_ADC) += berlin2-adc.o |
diff --git a/drivers/iio/adc/axp20x_adc.c b/drivers/iio/adc/axp20x_adc.c new file mode 100644 index 000000000000..11e177180ea0 --- /dev/null +++ b/drivers/iio/adc/axp20x_adc.c | |||
@@ -0,0 +1,617 @@ | |||
1 | /* ADC driver for AXP20X and AXP22X PMICs | ||
2 | * | ||
3 | * Copyright (c) 2016 Free Electrons NextThing Co. | ||
4 | * Quentin Schulz <quentin.schulz@free-electrons.com> | ||
5 | * | ||
6 | * This program is free software; you can redistribute it and/or modify it under | ||
7 | * the terms of the GNU General Public License version 2 as published by the | ||
8 | * Free Software Foundation. | ||
9 | */ | ||
10 | |||
11 | #include <linux/completion.h> | ||
12 | #include <linux/interrupt.h> | ||
13 | #include <linux/io.h> | ||
14 | #include <linux/module.h> | ||
15 | #include <linux/of.h> | ||
16 | #include <linux/of_device.h> | ||
17 | #include <linux/platform_device.h> | ||
18 | #include <linux/pm_runtime.h> | ||
19 | #include <linux/regmap.h> | ||
20 | #include <linux/thermal.h> | ||
21 | |||
22 | #include <linux/iio/iio.h> | ||
23 | #include <linux/iio/driver.h> | ||
24 | #include <linux/iio/machine.h> | ||
25 | #include <linux/mfd/axp20x.h> | ||
26 | |||
27 | #define AXP20X_ADC_EN1_MASK GENMASK(7, 0) | ||
28 | |||
29 | #define AXP20X_ADC_EN2_MASK (GENMASK(3, 2) | BIT(7)) | ||
30 | #define AXP22X_ADC_EN1_MASK (GENMASK(7, 5) | BIT(0)) | ||
31 | |||
32 | #define AXP20X_GPIO10_IN_RANGE_GPIO0 BIT(0) | ||
33 | #define AXP20X_GPIO10_IN_RANGE_GPIO1 BIT(1) | ||
34 | #define AXP20X_GPIO10_IN_RANGE_GPIO0_VAL(x) ((x) & BIT(0)) | ||
35 | #define AXP20X_GPIO10_IN_RANGE_GPIO1_VAL(x) (((x) & BIT(0)) << 1) | ||
36 | |||
37 | #define AXP20X_ADC_RATE_MASK GENMASK(7, 6) | ||
38 | #define AXP20X_ADC_RATE_HZ(x) ((ilog2((x) / 25) << 6) & AXP20X_ADC_RATE_MASK) | ||
39 | #define AXP22X_ADC_RATE_HZ(x) ((ilog2((x) / 100) << 6) & AXP20X_ADC_RATE_MASK) | ||
40 | |||
41 | #define AXP20X_ADC_CHANNEL(_channel, _name, _type, _reg) \ | ||
42 | { \ | ||
43 | .type = _type, \ | ||
44 | .indexed = 1, \ | ||
45 | .channel = _channel, \ | ||
46 | .address = _reg, \ | ||
47 | .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \ | ||
48 | BIT(IIO_CHAN_INFO_SCALE), \ | ||
49 | .datasheet_name = _name, \ | ||
50 | } | ||
51 | |||
52 | #define AXP20X_ADC_CHANNEL_OFFSET(_channel, _name, _type, _reg) \ | ||
53 | { \ | ||
54 | .type = _type, \ | ||
55 | .indexed = 1, \ | ||
56 | .channel = _channel, \ | ||
57 | .address = _reg, \ | ||
58 | .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \ | ||
59 | BIT(IIO_CHAN_INFO_SCALE) |\ | ||
60 | BIT(IIO_CHAN_INFO_OFFSET),\ | ||
61 | .datasheet_name = _name, \ | ||
62 | } | ||
63 | |||
64 | struct axp_data; | ||
65 | |||
66 | struct axp20x_adc_iio { | ||
67 | struct regmap *regmap; | ||
68 | struct axp_data *data; | ||
69 | }; | ||
70 | |||
71 | enum axp20x_adc_channel_v { | ||
72 | AXP20X_ACIN_V = 0, | ||
73 | AXP20X_VBUS_V, | ||
74 | AXP20X_TS_IN, | ||
75 | AXP20X_GPIO0_V, | ||
76 | AXP20X_GPIO1_V, | ||
77 | AXP20X_IPSOUT_V, | ||
78 | AXP20X_BATT_V, | ||
79 | }; | ||
80 | |||
81 | enum axp20x_adc_channel_i { | ||
82 | AXP20X_ACIN_I = 0, | ||
83 | AXP20X_VBUS_I, | ||
84 | AXP20X_BATT_CHRG_I, | ||
85 | AXP20X_BATT_DISCHRG_I, | ||
86 | }; | ||
87 | |||
88 | enum axp22x_adc_channel_v { | ||
89 | AXP22X_TS_IN = 0, | ||
90 | AXP22X_BATT_V, | ||
91 | }; | ||
92 | |||
93 | enum axp22x_adc_channel_i { | ||
94 | AXP22X_BATT_CHRG_I = 1, | ||
95 | AXP22X_BATT_DISCHRG_I, | ||
96 | }; | ||
97 | |||
98 | static struct iio_map axp20x_maps[] = { | ||
99 | { | ||
100 | .consumer_dev_name = "axp20x-usb-power-supply", | ||
101 | .consumer_channel = "vbus_v", | ||
102 | .adc_channel_label = "vbus_v", | ||
103 | }, { | ||
104 | .consumer_dev_name = "axp20x-usb-power-supply", | ||
105 | .consumer_channel = "vbus_i", | ||
106 | .adc_channel_label = "vbus_i", | ||
107 | }, { | ||
108 | .consumer_dev_name = "axp20x-ac-power-supply", | ||
109 | .consumer_channel = "acin_v", | ||
110 | .adc_channel_label = "acin_v", | ||
111 | }, { | ||
112 | .consumer_dev_name = "axp20x-ac-power-supply", | ||
113 | .consumer_channel = "acin_i", | ||
114 | .adc_channel_label = "acin_i", | ||
115 | }, { | ||
116 | .consumer_dev_name = "axp20x-battery-power-supply", | ||
117 | .consumer_channel = "batt_v", | ||
118 | .adc_channel_label = "batt_v", | ||
119 | }, { | ||
120 | .consumer_dev_name = "axp20x-battery-power-supply", | ||
121 | .consumer_channel = "batt_chrg_i", | ||
122 | .adc_channel_label = "batt_chrg_i", | ||
123 | }, { | ||
124 | .consumer_dev_name = "axp20x-battery-power-supply", | ||
125 | .consumer_channel = "batt_dischrg_i", | ||
126 | .adc_channel_label = "batt_dischrg_i", | ||
127 | }, { /* sentinel */ } | ||
128 | }; | ||
129 | |||
130 | static struct iio_map axp22x_maps[] = { | ||
131 | { | ||
132 | .consumer_dev_name = "axp20x-battery-power-supply", | ||
133 | .consumer_channel = "batt_v", | ||
134 | .adc_channel_label = "batt_v", | ||
135 | }, { | ||
136 | .consumer_dev_name = "axp20x-battery-power-supply", | ||
137 | .consumer_channel = "batt_chrg_i", | ||
138 | .adc_channel_label = "batt_chrg_i", | ||
139 | }, { | ||
140 | .consumer_dev_name = "axp20x-battery-power-supply", | ||
141 | .consumer_channel = "batt_dischrg_i", | ||
142 | .adc_channel_label = "batt_dischrg_i", | ||
143 | }, { /* sentinel */ } | ||
144 | }; | ||
145 | |||
146 | /* | ||
147 | * Channels are mapped by physical system. Their channels share the same index. | ||
148 | * i.e. acin_i is in_current0_raw and acin_v is in_voltage0_raw. | ||
149 | * The only exception is for the battery. batt_v will be in_voltage6_raw and | ||
150 | * charge current in_current6_raw and discharge current will be in_current7_raw. | ||
151 | */ | ||
152 | static const struct iio_chan_spec axp20x_adc_channels[] = { | ||
153 | AXP20X_ADC_CHANNEL(AXP20X_ACIN_V, "acin_v", IIO_VOLTAGE, | ||
154 | AXP20X_ACIN_V_ADC_H), | ||
155 | AXP20X_ADC_CHANNEL(AXP20X_ACIN_I, "acin_i", IIO_CURRENT, | ||
156 | AXP20X_ACIN_I_ADC_H), | ||
157 | AXP20X_ADC_CHANNEL(AXP20X_VBUS_V, "vbus_v", IIO_VOLTAGE, | ||
158 | AXP20X_VBUS_V_ADC_H), | ||
159 | AXP20X_ADC_CHANNEL(AXP20X_VBUS_I, "vbus_i", IIO_CURRENT, | ||
160 | AXP20X_VBUS_I_ADC_H), | ||
161 | { | ||
162 | .type = IIO_TEMP, | ||
163 | .address = AXP20X_TEMP_ADC_H, | ||
164 | .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | | ||
165 | BIT(IIO_CHAN_INFO_SCALE) | | ||
166 | BIT(IIO_CHAN_INFO_OFFSET), | ||
167 | .datasheet_name = "pmic_temp", | ||
168 | }, | ||
169 | AXP20X_ADC_CHANNEL_OFFSET(AXP20X_GPIO0_V, "gpio0_v", IIO_VOLTAGE, | ||
170 | AXP20X_GPIO0_V_ADC_H), | ||
171 | AXP20X_ADC_CHANNEL_OFFSET(AXP20X_GPIO1_V, "gpio1_v", IIO_VOLTAGE, | ||
172 | AXP20X_GPIO1_V_ADC_H), | ||
173 | AXP20X_ADC_CHANNEL(AXP20X_IPSOUT_V, "ipsout_v", IIO_VOLTAGE, | ||
174 | AXP20X_IPSOUT_V_HIGH_H), | ||
175 | AXP20X_ADC_CHANNEL(AXP20X_BATT_V, "batt_v", IIO_VOLTAGE, | ||
176 | AXP20X_BATT_V_H), | ||
177 | AXP20X_ADC_CHANNEL(AXP20X_BATT_CHRG_I, "batt_chrg_i", IIO_CURRENT, | ||
178 | AXP20X_BATT_CHRG_I_H), | ||
179 | AXP20X_ADC_CHANNEL(AXP20X_BATT_DISCHRG_I, "batt_dischrg_i", IIO_CURRENT, | ||
180 | AXP20X_BATT_DISCHRG_I_H), | ||
181 | }; | ||
182 | |||
183 | static const struct iio_chan_spec axp22x_adc_channels[] = { | ||
184 | { | ||
185 | .type = IIO_TEMP, | ||
186 | .address = AXP22X_PMIC_TEMP_H, | ||
187 | .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | | ||
188 | BIT(IIO_CHAN_INFO_SCALE) | | ||
189 | BIT(IIO_CHAN_INFO_OFFSET), | ||
190 | .datasheet_name = "pmic_temp", | ||
191 | }, | ||
192 | AXP20X_ADC_CHANNEL(AXP22X_BATT_V, "batt_v", IIO_VOLTAGE, | ||
193 | AXP20X_BATT_V_H), | ||
194 | AXP20X_ADC_CHANNEL(AXP22X_BATT_CHRG_I, "batt_chrg_i", IIO_CURRENT, | ||
195 | AXP20X_BATT_CHRG_I_H), | ||
196 | AXP20X_ADC_CHANNEL(AXP22X_BATT_DISCHRG_I, "batt_dischrg_i", IIO_CURRENT, | ||
197 | AXP20X_BATT_DISCHRG_I_H), | ||
198 | }; | ||
199 | |||
200 | static int axp20x_adc_raw(struct iio_dev *indio_dev, | ||
201 | struct iio_chan_spec const *chan, int *val) | ||
202 | { | ||
203 | struct axp20x_adc_iio *info = iio_priv(indio_dev); | ||
204 | int size = 12; | ||
205 | |||
206 | /* | ||
207 | * N.B.: Unlike the Chinese datasheets tell, the charging current is | ||
208 | * stored on 12 bits, not 13 bits. Only discharging current is on 13 | ||
209 | * bits. | ||
210 | */ | ||
211 | if (chan->type == IIO_CURRENT && chan->channel == AXP20X_BATT_DISCHRG_I) | ||
212 | size = 13; | ||
213 | else | ||
214 | size = 12; | ||
215 | |||
216 | *val = axp20x_read_variable_width(info->regmap, chan->address, size); | ||
217 | if (*val < 0) | ||
218 | return *val; | ||
219 | |||
220 | return IIO_VAL_INT; | ||
221 | } | ||
222 | |||
223 | static int axp22x_adc_raw(struct iio_dev *indio_dev, | ||
224 | struct iio_chan_spec const *chan, int *val) | ||
225 | { | ||
226 | struct axp20x_adc_iio *info = iio_priv(indio_dev); | ||
227 | int size; | ||
228 | |||
229 | /* | ||
230 | * N.B.: Unlike the Chinese datasheets tell, the charging current is | ||
231 | * stored on 12 bits, not 13 bits. Only discharging current is on 13 | ||
232 | * bits. | ||
233 | */ | ||
234 | if (chan->type == IIO_CURRENT && chan->channel == AXP22X_BATT_DISCHRG_I) | ||
235 | size = 13; | ||
236 | else | ||
237 | size = 12; | ||
238 | |||
239 | *val = axp20x_read_variable_width(info->regmap, chan->address, size); | ||
240 | if (*val < 0) | ||
241 | return *val; | ||
242 | |||
243 | return IIO_VAL_INT; | ||
244 | } | ||
245 | |||
246 | static int axp20x_adc_scale_voltage(int channel, int *val, int *val2) | ||
247 | { | ||
248 | switch (channel) { | ||
249 | case AXP20X_ACIN_V: | ||
250 | case AXP20X_VBUS_V: | ||
251 | *val = 1; | ||
252 | *val2 = 700000; | ||
253 | return IIO_VAL_INT_PLUS_MICRO; | ||
254 | |||
255 | case AXP20X_GPIO0_V: | ||
256 | case AXP20X_GPIO1_V: | ||
257 | *val = 0; | ||
258 | *val2 = 500000; | ||
259 | return IIO_VAL_INT_PLUS_MICRO; | ||
260 | |||
261 | case AXP20X_BATT_V: | ||
262 | *val = 1; | ||
263 | *val2 = 100000; | ||
264 | return IIO_VAL_INT_PLUS_MICRO; | ||
265 | |||
266 | case AXP20X_IPSOUT_V: | ||
267 | *val = 1; | ||
268 | *val2 = 400000; | ||
269 | return IIO_VAL_INT_PLUS_MICRO; | ||
270 | |||
271 | default: | ||
272 | return -EINVAL; | ||
273 | } | ||
274 | } | ||
275 | |||
276 | static int axp20x_adc_scale_current(int channel, int *val, int *val2) | ||
277 | { | ||
278 | switch (channel) { | ||
279 | case AXP20X_ACIN_I: | ||
280 | *val = 0; | ||
281 | *val2 = 625000; | ||
282 | return IIO_VAL_INT_PLUS_MICRO; | ||
283 | |||
284 | case AXP20X_VBUS_I: | ||
285 | *val = 0; | ||
286 | *val2 = 375000; | ||
287 | return IIO_VAL_INT_PLUS_MICRO; | ||
288 | |||
289 | case AXP20X_BATT_DISCHRG_I: | ||
290 | case AXP20X_BATT_CHRG_I: | ||
291 | *val = 0; | ||
292 | *val2 = 500000; | ||
293 | return IIO_VAL_INT_PLUS_MICRO; | ||
294 | |||
295 | default: | ||
296 | return -EINVAL; | ||
297 | } | ||
298 | } | ||
299 | |||
300 | static int axp20x_adc_scale(struct iio_chan_spec const *chan, int *val, | ||
301 | int *val2) | ||
302 | { | ||
303 | switch (chan->type) { | ||
304 | case IIO_VOLTAGE: | ||
305 | return axp20x_adc_scale_voltage(chan->channel, val, val2); | ||
306 | |||
307 | case IIO_CURRENT: | ||
308 | return axp20x_adc_scale_current(chan->channel, val, val2); | ||
309 | |||
310 | case IIO_TEMP: | ||
311 | *val = 100; | ||
312 | return IIO_VAL_INT; | ||
313 | |||
314 | default: | ||
315 | return -EINVAL; | ||
316 | } | ||
317 | } | ||
318 | |||
319 | static int axp22x_adc_scale(struct iio_chan_spec const *chan, int *val, | ||
320 | int *val2) | ||
321 | { | ||
322 | switch (chan->type) { | ||
323 | case IIO_VOLTAGE: | ||
324 | if (chan->channel != AXP22X_BATT_V) | ||
325 | return -EINVAL; | ||
326 | |||
327 | *val = 1; | ||
328 | *val2 = 100000; | ||
329 | return IIO_VAL_INT_PLUS_MICRO; | ||
330 | |||
331 | case IIO_CURRENT: | ||
332 | *val = 0; | ||
333 | *val2 = 500000; | ||
334 | return IIO_VAL_INT_PLUS_MICRO; | ||
335 | |||
336 | case IIO_TEMP: | ||
337 | *val = 100; | ||
338 | return IIO_VAL_INT; | ||
339 | |||
340 | default: | ||
341 | return -EINVAL; | ||
342 | } | ||
343 | } | ||
344 | |||
345 | static int axp20x_adc_offset_voltage(struct iio_dev *indio_dev, int channel, | ||
346 | int *val) | ||
347 | { | ||
348 | struct axp20x_adc_iio *info = iio_priv(indio_dev); | ||
349 | int ret; | ||
350 | |||
351 | ret = regmap_read(info->regmap, AXP20X_GPIO10_IN_RANGE, val); | ||
352 | if (ret < 0) | ||
353 | return ret; | ||
354 | |||
355 | switch (channel) { | ||
356 | case AXP20X_GPIO0_V: | ||
357 | *val &= AXP20X_GPIO10_IN_RANGE_GPIO0; | ||
358 | break; | ||
359 | |||
360 | case AXP20X_GPIO1_V: | ||
361 | *val &= AXP20X_GPIO10_IN_RANGE_GPIO1; | ||
362 | break; | ||
363 | |||
364 | default: | ||
365 | return -EINVAL; | ||
366 | } | ||
367 | |||
368 | *val = !!(*val) * 700000; | ||
369 | |||
370 | return IIO_VAL_INT; | ||
371 | } | ||
372 | |||
373 | static int axp20x_adc_offset(struct iio_dev *indio_dev, | ||
374 | struct iio_chan_spec const *chan, int *val) | ||
375 | { | ||
376 | switch (chan->type) { | ||
377 | case IIO_VOLTAGE: | ||
378 | return axp20x_adc_offset_voltage(indio_dev, chan->channel, val); | ||
379 | |||
380 | case IIO_TEMP: | ||
381 | *val = -1447; | ||
382 | return IIO_VAL_INT; | ||
383 | |||
384 | default: | ||
385 | return -EINVAL; | ||
386 | } | ||
387 | } | ||
388 | |||
389 | static int axp20x_read_raw(struct iio_dev *indio_dev, | ||
390 | struct iio_chan_spec const *chan, int *val, | ||
391 | int *val2, long mask) | ||
392 | { | ||
393 | switch (mask) { | ||
394 | case IIO_CHAN_INFO_OFFSET: | ||
395 | return axp20x_adc_offset(indio_dev, chan, val); | ||
396 | |||
397 | case IIO_CHAN_INFO_SCALE: | ||
398 | return axp20x_adc_scale(chan, val, val2); | ||
399 | |||
400 | case IIO_CHAN_INFO_RAW: | ||
401 | return axp20x_adc_raw(indio_dev, chan, val); | ||
402 | |||
403 | default: | ||
404 | return -EINVAL; | ||
405 | } | ||
406 | } | ||
407 | |||
408 | static int axp22x_read_raw(struct iio_dev *indio_dev, | ||
409 | struct iio_chan_spec const *chan, int *val, | ||
410 | int *val2, long mask) | ||
411 | { | ||
412 | switch (mask) { | ||
413 | case IIO_CHAN_INFO_OFFSET: | ||
414 | *val = -2677; | ||
415 | return IIO_VAL_INT; | ||
416 | |||
417 | case IIO_CHAN_INFO_SCALE: | ||
418 | return axp22x_adc_scale(chan, val, val2); | ||
419 | |||
420 | case IIO_CHAN_INFO_RAW: | ||
421 | return axp22x_adc_raw(indio_dev, chan, val); | ||
422 | |||
423 | default: | ||
424 | return -EINVAL; | ||
425 | } | ||
426 | } | ||
427 | |||
428 | static int axp20x_write_raw(struct iio_dev *indio_dev, | ||
429 | struct iio_chan_spec const *chan, int val, int val2, | ||
430 | long mask) | ||
431 | { | ||
432 | struct axp20x_adc_iio *info = iio_priv(indio_dev); | ||
433 | unsigned int reg, regval; | ||
434 | |||
435 | /* | ||
436 | * The AXP20X PMIC allows the user to choose between 0V and 0.7V offsets | ||
437 | * for (independently) GPIO0 and GPIO1 when in ADC mode. | ||
438 | */ | ||
439 | if (mask != IIO_CHAN_INFO_OFFSET) | ||
440 | return -EINVAL; | ||
441 | |||
442 | if (val != 0 && val != 700000) | ||
443 | return -EINVAL; | ||
444 | |||
445 | switch (chan->channel) { | ||
446 | case AXP20X_GPIO0_V: | ||
447 | reg = AXP20X_GPIO10_IN_RANGE_GPIO0; | ||
448 | regval = AXP20X_GPIO10_IN_RANGE_GPIO0_VAL(!!val); | ||
449 | break; | ||
450 | |||
451 | case AXP20X_GPIO1_V: | ||
452 | reg = AXP20X_GPIO10_IN_RANGE_GPIO1; | ||
453 | regval = AXP20X_GPIO10_IN_RANGE_GPIO1_VAL(!!val); | ||
454 | break; | ||
455 | |||
456 | default: | ||
457 | return -EINVAL; | ||
458 | } | ||
459 | |||
460 | return regmap_update_bits(info->regmap, AXP20X_GPIO10_IN_RANGE, reg, | ||
461 | regval); | ||
462 | } | ||
463 | |||
464 | static const struct iio_info axp20x_adc_iio_info = { | ||
465 | .read_raw = axp20x_read_raw, | ||
466 | .write_raw = axp20x_write_raw, | ||
467 | .driver_module = THIS_MODULE, | ||
468 | }; | ||
469 | |||
470 | static const struct iio_info axp22x_adc_iio_info = { | ||
471 | .read_raw = axp22x_read_raw, | ||
472 | .driver_module = THIS_MODULE, | ||
473 | }; | ||
474 | |||
475 | static int axp20x_adc_rate(int rate) | ||
476 | { | ||
477 | return AXP20X_ADC_RATE_HZ(rate); | ||
478 | } | ||
479 | |||
480 | static int axp22x_adc_rate(int rate) | ||
481 | { | ||
482 | return AXP22X_ADC_RATE_HZ(rate); | ||
483 | } | ||
484 | |||
485 | struct axp_data { | ||
486 | const struct iio_info *iio_info; | ||
487 | int num_channels; | ||
488 | struct iio_chan_spec const *channels; | ||
489 | unsigned long adc_en1_mask; | ||
490 | int (*adc_rate)(int rate); | ||
491 | bool adc_en2; | ||
492 | struct iio_map *maps; | ||
493 | }; | ||
494 | |||
495 | static const struct axp_data axp20x_data = { | ||
496 | .iio_info = &axp20x_adc_iio_info, | ||
497 | .num_channels = ARRAY_SIZE(axp20x_adc_channels), | ||
498 | .channels = axp20x_adc_channels, | ||
499 | .adc_en1_mask = AXP20X_ADC_EN1_MASK, | ||
500 | .adc_rate = axp20x_adc_rate, | ||
501 | .adc_en2 = true, | ||
502 | .maps = axp20x_maps, | ||
503 | }; | ||
504 | |||
505 | static const struct axp_data axp22x_data = { | ||
506 | .iio_info = &axp22x_adc_iio_info, | ||
507 | .num_channels = ARRAY_SIZE(axp22x_adc_channels), | ||
508 | .channels = axp22x_adc_channels, | ||
509 | .adc_en1_mask = AXP22X_ADC_EN1_MASK, | ||
510 | .adc_rate = axp22x_adc_rate, | ||
511 | .adc_en2 = false, | ||
512 | .maps = axp22x_maps, | ||
513 | }; | ||
514 | |||
515 | static const struct platform_device_id axp20x_adc_id_match[] = { | ||
516 | { .name = "axp20x-adc", .driver_data = (kernel_ulong_t)&axp20x_data, }, | ||
517 | { .name = "axp22x-adc", .driver_data = (kernel_ulong_t)&axp22x_data, }, | ||
518 | { /* sentinel */ }, | ||
519 | }; | ||
520 | MODULE_DEVICE_TABLE(platform, axp20x_adc_id_match); | ||
521 | |||
522 | static int axp20x_probe(struct platform_device *pdev) | ||
523 | { | ||
524 | struct axp20x_adc_iio *info; | ||
525 | struct iio_dev *indio_dev; | ||
526 | struct axp20x_dev *axp20x_dev; | ||
527 | int ret; | ||
528 | |||
529 | axp20x_dev = dev_get_drvdata(pdev->dev.parent); | ||
530 | |||
531 | indio_dev = devm_iio_device_alloc(&pdev->dev, sizeof(*info)); | ||
532 | if (!indio_dev) | ||
533 | return -ENOMEM; | ||
534 | |||
535 | info = iio_priv(indio_dev); | ||
536 | platform_set_drvdata(pdev, indio_dev); | ||
537 | |||
538 | info->regmap = axp20x_dev->regmap; | ||
539 | indio_dev->dev.parent = &pdev->dev; | ||
540 | indio_dev->dev.of_node = pdev->dev.of_node; | ||
541 | indio_dev->modes = INDIO_DIRECT_MODE; | ||
542 | |||
543 | info->data = (struct axp_data *)platform_get_device_id(pdev)->driver_data; | ||
544 | |||
545 | indio_dev->name = platform_get_device_id(pdev)->name; | ||
546 | indio_dev->info = info->data->iio_info; | ||
547 | indio_dev->num_channels = info->data->num_channels; | ||
548 | indio_dev->channels = info->data->channels; | ||
549 | |||
550 | /* Enable the ADCs on IP */ | ||
551 | regmap_write(info->regmap, AXP20X_ADC_EN1, info->data->adc_en1_mask); | ||
552 | |||
553 | if (info->data->adc_en2) | ||
554 | /* Enable GPIO0/1 and internal temperature ADCs */ | ||
555 | regmap_update_bits(info->regmap, AXP20X_ADC_EN2, | ||
556 | AXP20X_ADC_EN2_MASK, AXP20X_ADC_EN2_MASK); | ||
557 | |||
558 | /* Configure ADCs rate */ | ||
559 | regmap_update_bits(info->regmap, AXP20X_ADC_RATE, AXP20X_ADC_RATE_MASK, | ||
560 | info->data->adc_rate(100)); | ||
561 | |||
562 | ret = iio_map_array_register(indio_dev, info->data->maps); | ||
563 | if (ret < 0) { | ||
564 | dev_err(&pdev->dev, "failed to register IIO maps: %d\n", ret); | ||
565 | goto fail_map; | ||
566 | } | ||
567 | |||
568 | ret = iio_device_register(indio_dev); | ||
569 | if (ret < 0) { | ||
570 | dev_err(&pdev->dev, "could not register the device\n"); | ||
571 | goto fail_register; | ||
572 | } | ||
573 | |||
574 | return 0; | ||
575 | |||
576 | fail_register: | ||
577 | iio_map_array_unregister(indio_dev); | ||
578 | |||
579 | fail_map: | ||
580 | regmap_write(info->regmap, AXP20X_ADC_EN1, 0); | ||
581 | |||
582 | if (info->data->adc_en2) | ||
583 | regmap_write(info->regmap, AXP20X_ADC_EN2, 0); | ||
584 | |||
585 | return ret; | ||
586 | } | ||
587 | |||
588 | static int axp20x_remove(struct platform_device *pdev) | ||
589 | { | ||
590 | struct iio_dev *indio_dev = platform_get_drvdata(pdev); | ||
591 | struct axp20x_adc_iio *info = iio_priv(indio_dev); | ||
592 | |||
593 | iio_device_unregister(indio_dev); | ||
594 | iio_map_array_unregister(indio_dev); | ||
595 | |||
596 | regmap_write(info->regmap, AXP20X_ADC_EN1, 0); | ||
597 | |||
598 | if (info->data->adc_en2) | ||
599 | regmap_write(info->regmap, AXP20X_ADC_EN2, 0); | ||
600 | |||
601 | return 0; | ||
602 | } | ||
603 | |||
604 | static struct platform_driver axp20x_adc_driver = { | ||
605 | .driver = { | ||
606 | .name = "axp20x-adc", | ||
607 | }, | ||
608 | .id_table = axp20x_adc_id_match, | ||
609 | .probe = axp20x_probe, | ||
610 | .remove = axp20x_remove, | ||
611 | }; | ||
612 | |||
613 | module_platform_driver(axp20x_adc_driver); | ||
614 | |||
615 | MODULE_DESCRIPTION("ADC driver for AXP20X and AXP22X PMICs"); | ||
616 | MODULE_AUTHOR("Quentin Schulz <quentin.schulz@free-electrons.com>"); | ||
617 | MODULE_LICENSE("GPL"); | ||