| .. | .. |
|---|
| 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; |
|---|