disable FB

hc

2024-01-04 1543e317f1da31b75942316931e8f491a8920811

 kernel/drivers/iio/health/afe4403.c
..
..
@@ -1,17 +1,9 @@
1
+// SPDX-License-Identifier: GPL-2.0-only
1
2
 /*
2
3
  * AFE4403 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>
..
..
@@ -30,6 +22,8 @@
30
22
 #include <linux/iio/trigger.h>
31
23
 #include <linux/iio/triggered_buffer.h>
32
24
 #include <linux/iio/trigger_consumer.h>
25
+
26
+#include <asm/unaligned.h>
33
27
 
34
28
 #include "afe440x.h"
35
29
 
..
..
@@ -231,13 +225,11 @@
231
225
 	if (ret)
232
226
 		return ret;
233
227
 
234
-	ret = spi_write_then_read(afe->spi, &reg, 1, rx, 3);
228
+	ret = spi_write_then_read(afe->spi, &reg, 1, rx, sizeof(rx));
235
229
 	if (ret)
236
230
 		return ret;
237
231
 
238
-	*val = (rx[0] << 16) |
239
-		(rx[1] << 8) |
240
-		(rx[2]);
232
+	*val = get_unaligned_be24(&rx[0]);
241
233
 
242
234
 	/* Disable reading from the device */
243
235
 	tx[3] = AFE440X_CONTROL0_WRITE;
..
..
@@ -253,14 +245,14 @@
253
245
 			    int *val, int *val2, long mask)
254
246
 {
255
247
 	struct afe4403_data *afe = iio_priv(indio_dev);
256
-	unsigned int reg = afe4403_channel_values[chan->address];
257
-	unsigned int field = afe4403_channel_leds[chan->address];
248
+	unsigned int reg, field;
258
249
 	int ret;
259
250
 
260
251
 	switch (chan->type) {
261
252
 	case IIO_INTENSITY:
262
253
 		switch (mask) {
263
254
 		case IIO_CHAN_INFO_RAW:
255
+			reg = afe4403_channel_values[chan->address];
264
256
 			ret = afe4403_read(afe, reg, val);
265
257
 			if (ret)
266
258
 				return ret;
..
..
@@ -270,6 +262,7 @@
270
262
 	case IIO_CURRENT:
271
263
 		switch (mask) {
272
264
 		case IIO_CHAN_INFO_RAW:
265
+			field = afe4403_channel_leds[chan->address];
273
266
 			ret = regmap_field_read(afe->fields[field], val);
274
267
 			if (ret)
275
268
 				return ret;
..
..
@@ -332,13 +325,11 @@
332
325
 			 indio_dev->masklength) {
333
326
 		ret = spi_write_then_read(afe->spi,
334
327
 					  &afe4403_channel_values[bit], 1,
335
-					  rx, 3);
328
+					  rx, sizeof(rx));
336
329
 		if (ret)
337
330
 			goto err;
338
331
 
339
-		afe->buffer[i++] = (rx[0] << 16) |
340
-				   (rx[1] << 8) |
341
-				   (rx[2]);
332
+		afe->buffer[i++] = get_unaligned_be24(&rx[0]);
342
333
 	}
343
334
 
344
335
 	/* Disable reading from the device */
..
..
@@ -522,7 +513,6 @@
522
513
 	}
523
514
 
524
515
 	indio_dev->modes = INDIO_DIRECT_MODE;
525
-	indio_dev->dev.parent = afe->dev;
526
516
 	indio_dev->channels = afe4403_channels;
527
517
 	indio_dev->num_channels = ARRAY_SIZE(afe4403_channels);
528
518
 	indio_dev->name = AFE4403_DRIVER_NAME;