.. | .. |
---|
| 1 | +// SPDX-License-Identifier: GPL-2.0-only |
---|
1 | 2 | /* |
---|
2 | 3 | * AFE4404 Heart Rate Monitors and Low-Cost Pulse Oximeters |
---|
3 | 4 | * |
---|
4 | | - * Copyright (C) 2015-2016 Texas Instruments Incorporated - http://www.ti.com/ |
---|
| 5 | + * Copyright (C) 2015-2016 Texas Instruments Incorporated - https://www.ti.com/ |
---|
5 | 6 | * Andrew F. Davis <afd@ti.com> |
---|
6 | | - * |
---|
7 | | - * This program is free software; you can redistribute it and/or modify |
---|
8 | | - * it under the terms of the GNU General Public License version 2 as |
---|
9 | | - * published by the Free Software Foundation. |
---|
10 | | - * |
---|
11 | | - * This program is distributed in the hope that it will be useful, but |
---|
12 | | - * WITHOUT ANY WARRANTY; without even the implied warranty of |
---|
13 | | - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
---|
14 | | - * General Public License for more details. |
---|
15 | 7 | */ |
---|
16 | 8 | |
---|
17 | 9 | #include <linux/device.h> |
---|
.. | .. |
---|
258 | 250 | int *val, int *val2, long mask) |
---|
259 | 251 | { |
---|
260 | 252 | struct afe4404_data *afe = iio_priv(indio_dev); |
---|
261 | | - unsigned int value_reg = afe4404_channel_values[chan->address]; |
---|
262 | | - unsigned int led_field = afe4404_channel_leds[chan->address]; |
---|
263 | | - unsigned int offdac_field = afe4404_channel_offdacs[chan->address]; |
---|
| 253 | + unsigned int value_reg, led_field, offdac_field; |
---|
264 | 254 | int ret; |
---|
265 | 255 | |
---|
266 | 256 | switch (chan->type) { |
---|
267 | 257 | case IIO_INTENSITY: |
---|
268 | 258 | switch (mask) { |
---|
269 | 259 | case IIO_CHAN_INFO_RAW: |
---|
| 260 | + value_reg = afe4404_channel_values[chan->address]; |
---|
270 | 261 | ret = regmap_read(afe->regmap, value_reg, val); |
---|
271 | 262 | if (ret) |
---|
272 | 263 | return ret; |
---|
273 | 264 | return IIO_VAL_INT; |
---|
274 | 265 | case IIO_CHAN_INFO_OFFSET: |
---|
| 266 | + offdac_field = afe4404_channel_offdacs[chan->address]; |
---|
275 | 267 | ret = regmap_field_read(afe->fields[offdac_field], val); |
---|
276 | 268 | if (ret) |
---|
277 | 269 | return ret; |
---|
.. | .. |
---|
281 | 273 | case IIO_CURRENT: |
---|
282 | 274 | switch (mask) { |
---|
283 | 275 | case IIO_CHAN_INFO_RAW: |
---|
| 276 | + led_field = afe4404_channel_leds[chan->address]; |
---|
284 | 277 | ret = regmap_field_read(afe->fields[led_field], val); |
---|
285 | 278 | if (ret) |
---|
286 | 279 | return ret; |
---|
.. | .. |
---|
303 | 296 | int val, int val2, long mask) |
---|
304 | 297 | { |
---|
305 | 298 | struct afe4404_data *afe = iio_priv(indio_dev); |
---|
306 | | - unsigned int led_field = afe4404_channel_leds[chan->address]; |
---|
307 | | - unsigned int offdac_field = afe4404_channel_offdacs[chan->address]; |
---|
| 299 | + unsigned int led_field, offdac_field; |
---|
308 | 300 | |
---|
309 | 301 | switch (chan->type) { |
---|
310 | 302 | case IIO_INTENSITY: |
---|
311 | 303 | switch (mask) { |
---|
312 | 304 | case IIO_CHAN_INFO_OFFSET: |
---|
| 305 | + offdac_field = afe4404_channel_offdacs[chan->address]; |
---|
313 | 306 | return regmap_field_write(afe->fields[offdac_field], val); |
---|
314 | 307 | } |
---|
315 | 308 | break; |
---|
316 | 309 | case IIO_CURRENT: |
---|
317 | 310 | switch (mask) { |
---|
318 | 311 | case IIO_CHAN_INFO_RAW: |
---|
| 312 | + led_field = afe4404_channel_leds[chan->address]; |
---|
319 | 313 | return regmap_field_write(afe->fields[led_field], val); |
---|
320 | 314 | } |
---|
321 | 315 | break; |
---|
.. | .. |
---|
527 | 521 | } |
---|
528 | 522 | |
---|
529 | 523 | indio_dev->modes = INDIO_DIRECT_MODE; |
---|
530 | | - indio_dev->dev.parent = afe->dev; |
---|
531 | 524 | indio_dev->channels = afe4404_channels; |
---|
532 | 525 | indio_dev->num_channels = ARRAY_SIZE(afe4404_channels); |
---|
533 | 526 | indio_dev->name = AFE4404_DRIVER_NAME; |
---|