forked from ~ljy/RK356X_SDK_RELEASE

blame | history | patch | commit | commitdiff
hc
2024-01-03 2f7c68cb55ecb7331f2381deb497c27155f32faf 
 kernel/drivers/iio/gyro/adis16136.c
....@@ -1,10 +1,9 @@
1
+// SPDX-License-Identifier: GPL-2.0-only
12 /*
23  * ADIS16133/ADIS16135/ADIS16136 gyroscope driver
34  *
45  * Copyright 2012 Analog Devices Inc.
56  *   Author: Lars-Peter Clausen <lars@metafoo.de>
6
- *
7
- * Licensed under the GPL-2.
87  */
98 
109 #include <linux/interrupt.h>
....@@ -60,6 +59,7 @@
6059 struct adis16136_chip_info {
6160 	unsigned int precision;
6261 	unsigned int fullscale;
62
+	const struct adis_data adis_data;
6363 };
6464 
6565 struct adis16136 {
....@@ -81,19 +81,19 @@
8181 
8282 	ret = adis_read_reg_16(&adis16136->adis, ADIS16136_REG_SERIAL_NUM,
8383 		&serial);
84
-	if (ret < 0)
84
+	if (ret)
8585 		return ret;
8686 
8787 	ret = adis_read_reg_16(&adis16136->adis, ADIS16136_REG_LOT1, &lot1);
88
-	if (ret < 0)
88
+	if (ret)
8989 		return ret;
9090 
9191 	ret = adis_read_reg_16(&adis16136->adis, ADIS16136_REG_LOT2, &lot2);
92
-	if (ret < 0)
92
+	if (ret)
9393 		return ret;
9494 
9595 	ret = adis_read_reg_16(&adis16136->adis, ADIS16136_REG_LOT3, &lot3);
96
-	if (ret < 0)
96
+	if (ret)
9797 		return ret;
9898 
9999 	len = snprintf(buf, sizeof(buf), "%.4x%.4x%.4x-%.4x\n", lot1, lot2,
....@@ -117,7 +117,7 @@
117117 
118118 	ret = adis_read_reg_16(&adis16136->adis, ADIS16136_REG_PROD_ID,
119119 		&prod_id);
120
-	if (ret < 0)
120
+	if (ret)
121121 		return ret;
122122 
123123 	*val = prod_id;
....@@ -135,7 +135,7 @@
135135 
136136 	ret = adis_read_reg_16(&adis16136->adis, ADIS16136_REG_FLASH_CNT,
137137 		&flash_count);
138
-	if (ret < 0)
138
+	if (ret)
139139 		return ret;
140140 
141141 	*val = flash_count;
....@@ -148,16 +148,14 @@
148148 static int adis16136_debugfs_init(struct iio_dev *indio_dev)
149149 {
150150 	struct adis16136 *adis16136 = iio_priv(indio_dev);
151
+	struct dentry *d = iio_get_debugfs_dentry(indio_dev);
151152 
152153 	debugfs_create_file_unsafe("serial_number", 0400,
153
-		indio_dev->debugfs_dentry, adis16136,
154
-		&adis16136_serial_fops);
154
+		d, adis16136, &adis16136_serial_fops);
155155 	debugfs_create_file_unsafe("product_id", 0400,
156
-		indio_dev->debugfs_dentry,
157
-		adis16136, &adis16136_product_id_fops);
156
+		d, adis16136, &adis16136_product_id_fops);
158157 	debugfs_create_file_unsafe("flash_count", 0400,
159
-		indio_dev->debugfs_dentry,
160
-		adis16136, &adis16136_flash_count_fops);
158
+		d, adis16136, &adis16136_flash_count_fops);
161159 
162160 	return 0;
163161 }
....@@ -186,13 +184,13 @@
186184 	return adis_write_reg_16(&adis16136->adis, ADIS16136_REG_SMPL_PRD, t);
187185 }
188186 
189
-static int adis16136_get_freq(struct adis16136 *adis16136, unsigned int *freq)
187
+static int __adis16136_get_freq(struct adis16136 *adis16136, unsigned int *freq)
190188 {
191189 	uint16_t t;
192190 	int ret;
193191 
194
-	ret = adis_read_reg_16(&adis16136->adis, ADIS16136_REG_SMPL_PRD, &t);
195
-	if (ret < 0)
192
+	ret = __adis_read_reg_16(&adis16136->adis, ADIS16136_REG_SMPL_PRD, &t);
193
+	if (ret)
196194 		return ret;
197195 
198196 	*freq = 32768 / (t + 1);
....@@ -225,11 +223,14 @@
225223 {
226224 	struct iio_dev *indio_dev = dev_to_iio_dev(dev);
227225 	struct adis16136 *adis16136 = iio_priv(indio_dev);
226
+	struct mutex *slock = &adis16136->adis.state_lock;
228227 	unsigned int freq;
229228 	int ret;
230229 
231
-	ret = adis16136_get_freq(adis16136, &freq);
232
-	if (ret < 0)
230
+	mutex_lock(slock);
231
+	ret = __adis16136_get_freq(adis16136, &freq);
232
+	mutex_unlock(slock);
233
+	if (ret)
233234 		return ret;
234235 
235236 	return sprintf(buf, "%d\n", freq);
....@@ -253,42 +254,50 @@
253254 static int adis16136_set_filter(struct iio_dev *indio_dev, int val)
254255 {
255256 	struct adis16136 *adis16136 = iio_priv(indio_dev);
257
+	struct mutex *slock = &adis16136->adis.state_lock;
256258 	unsigned int freq;
257259 	int i, ret;
258260 
259
-	ret = adis16136_get_freq(adis16136, &freq);
260
-	if (ret < 0)
261
-		return ret;
261
+	mutex_lock(slock);
262
+	ret = __adis16136_get_freq(adis16136, &freq);
263
+	if (ret)
264
+		goto out_unlock;
262265 
263266 	for (i = ARRAY_SIZE(adis16136_3db_divisors) - 1; i >= 1; i--) {
264267 		if (freq / adis16136_3db_divisors[i] >= val)
265268 			break;
266269 	}
267270 
268
-	return adis_write_reg_16(&adis16136->adis, ADIS16136_REG_AVG_CNT, i);
271
+	ret = __adis_write_reg_16(&adis16136->adis, ADIS16136_REG_AVG_CNT, i);
272
+out_unlock:
273
+	mutex_unlock(slock);
274
+
275
+	return ret;
269276 }
270277 
271278 static int adis16136_get_filter(struct iio_dev *indio_dev, int *val)
272279 {
273280 	struct adis16136 *adis16136 = iio_priv(indio_dev);
281
+	struct mutex *slock = &adis16136->adis.state_lock;
274282 	unsigned int freq;
275283 	uint16_t val16;
276284 	int ret;
277285 
278
-	mutex_lock(&indio_dev->mlock);
286
+	mutex_lock(slock);
279287 
280
-	ret = adis_read_reg_16(&adis16136->adis, ADIS16136_REG_AVG_CNT, &val16);
281
-	if (ret < 0)
288
+	ret = __adis_read_reg_16(&adis16136->adis, ADIS16136_REG_AVG_CNT,
289
+				 &val16);
290
+	if (ret)
282291 		goto err_unlock;
283292 
284
-	ret = adis16136_get_freq(adis16136, &freq);
285
-	if (ret < 0)
293
+	ret = __adis16136_get_freq(adis16136, &freq);
294
+	if (ret)
286295 		goto err_unlock;
287296 
288297 	*val = freq / adis16136_3db_divisors[val16 & 0x07];
289298 
290299 err_unlock:
291
-	mutex_unlock(&indio_dev->mlock);
300
+	mutex_unlock(slock);
292301 
293302 	return ret ? ret : IIO_VAL_INT;
294303 }
....@@ -319,7 +328,7 @@
319328 	case IIO_CHAN_INFO_CALIBBIAS:
320329 		ret = adis_read_reg_32(&adis16136->adis,
321330 			ADIS16136_REG_GYRO_OFF2, &val32);
322
-		if (ret < 0)
331
+		if (ret)
323332 			return ret;
324333 
325334 		*val = sign_extend32(val32, 31);
....@@ -455,23 +464,22 @@
455464 	[ADIS16136_DIAG_STAT_FLASH_CHKSUM_FAIL] = "Flash checksum error",
456465 };
457466 
458
-static const struct adis_data adis16136_data = {
459
-	.diag_stat_reg = ADIS16136_REG_DIAG_STAT,
460
-	.glob_cmd_reg = ADIS16136_REG_GLOB_CMD,
461
-	.msc_ctrl_reg = ADIS16136_REG_MSC_CTRL,
462
-
463
-	.self_test_mask = ADIS16136_MSC_CTRL_SELF_TEST,
464
-	.startup_delay = 80,
465
-
466
-	.read_delay = 10,
467
-	.write_delay = 10,
468
-
469
-	.status_error_msgs = adis16136_status_error_msgs,
470
-	.status_error_mask = BIT(ADIS16136_DIAG_STAT_FLASH_UPDATE_FAIL) |
471
-		BIT(ADIS16136_DIAG_STAT_SPI_FAIL) |
472
-		BIT(ADIS16136_DIAG_STAT_SELF_TEST_FAIL) |
473
-		BIT(ADIS16136_DIAG_STAT_FLASH_CHKSUM_FAIL),
474
-};
467
+#define ADIS16136_DATA(_timeouts)					\
468
+{									\
469
+	.diag_stat_reg = ADIS16136_REG_DIAG_STAT,			\
470
+	.glob_cmd_reg = ADIS16136_REG_GLOB_CMD,				\
471
+	.msc_ctrl_reg = ADIS16136_REG_MSC_CTRL,				\
472
+	.self_test_reg = ADIS16136_REG_MSC_CTRL,			\
473
+	.self_test_mask = ADIS16136_MSC_CTRL_SELF_TEST,			\
474
+	.read_delay = 10,						\
475
+	.write_delay = 10,						\
476
+	.status_error_msgs = adis16136_status_error_msgs,		\
477
+	.status_error_mask = BIT(ADIS16136_DIAG_STAT_FLASH_UPDATE_FAIL) |	\
478
+		BIT(ADIS16136_DIAG_STAT_SPI_FAIL) |			\
479
+		BIT(ADIS16136_DIAG_STAT_SELF_TEST_FAIL) |		\
480
+		BIT(ADIS16136_DIAG_STAT_FLASH_CHKSUM_FAIL),		\
481
+	.timeouts = (_timeouts),					\
482
+}
475483 
476484 enum adis16136_id {
477485 	ID_ADIS16133,
....@@ -480,30 +488,52 @@
480488 	ID_ADIS16137,
481489 };
482490 
491
+static const struct adis_timeout adis16133_timeouts = {
492
+	.reset_ms = 75,
493
+	.sw_reset_ms = 75,
494
+	.self_test_ms = 50,
495
+};
496
+
497
+static const struct adis_timeout adis16136_timeouts = {
498
+	.reset_ms = 128,
499
+	.sw_reset_ms = 75,
500
+	.self_test_ms = 245,
501
+};
502
+
483503 static const struct adis16136_chip_info adis16136_chip_info[] = {
484504 	[ID_ADIS16133] = {
485505 		.precision = IIO_DEGREE_TO_RAD(1200),
486506 		.fullscale = 24000,
507
+		.adis_data = ADIS16136_DATA(&adis16133_timeouts),
487508 	},
488509 	[ID_ADIS16135] = {
489510 		.precision = IIO_DEGREE_TO_RAD(300),
490511 		.fullscale = 24000,
512
+		.adis_data = ADIS16136_DATA(&adis16133_timeouts),
491513 	},
492514 	[ID_ADIS16136] = {
493515 		.precision = IIO_DEGREE_TO_RAD(450),
494516 		.fullscale = 24623,
517
+		.adis_data = ADIS16136_DATA(&adis16136_timeouts),
495518 	},
496519 	[ID_ADIS16137] = {
497520 		.precision = IIO_DEGREE_TO_RAD(1000),
498521 		.fullscale = 24609,
522
+		.adis_data = ADIS16136_DATA(&adis16136_timeouts),
499523 	},
500524 };
525
+
526
+static void adis16136_stop(void *data)
527
+{
528
+	adis16136_stop_device(data);
529
+}
501530 
502531 static int adis16136_probe(struct spi_device *spi)
503532 {
504533 	const struct spi_device_id *id = spi_get_device_id(spi);
505534 	struct adis16136 *adis16136;
506535 	struct iio_dev *indio_dev;
536
+	const struct adis_data *adis16136_data;
507537 	int ret;
508538 
509539 	indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*adis16136));
....@@ -515,49 +545,35 @@
515545 	adis16136 = iio_priv(indio_dev);
516546 
517547 	adis16136->chip_info = &adis16136_chip_info[id->driver_data];
518
-	indio_dev->dev.parent = &spi->dev;
519548 	indio_dev->name = spi_get_device_id(spi)->name;
520549 	indio_dev->channels = adis16136_channels;
521550 	indio_dev->num_channels = ARRAY_SIZE(adis16136_channels);
522551 	indio_dev->info = &adis16136_info;
523552 	indio_dev->modes = INDIO_DIRECT_MODE;
524553 
525
-	ret = adis_init(&adis16136->adis, indio_dev, spi, &adis16136_data);
554
+	adis16136_data = &adis16136->chip_info->adis_data;
555
+
556
+	ret = adis_init(&adis16136->adis, indio_dev, spi, adis16136_data);
526557 	if (ret)
527558 		return ret;
528559 
529
-	ret = adis_setup_buffer_and_trigger(&adis16136->adis, indio_dev, NULL);
560
+	ret = devm_adis_setup_buffer_and_trigger(&adis16136->adis, indio_dev, NULL);
530561 	if (ret)
531562 		return ret;
532563 
533564 	ret = adis16136_initial_setup(indio_dev);
534565 	if (ret)
535
-		goto error_cleanup_buffer;
566
+		return ret;
536567 
537
-	ret = iio_device_register(indio_dev);
568
+	ret = devm_add_action_or_reset(&spi->dev, adis16136_stop, indio_dev);
538569 	if (ret)
539
-		goto error_stop_device;
570
+		return ret;
571
+
572
+	ret = devm_iio_device_register(&spi->dev, indio_dev);
573
+	if (ret)
574
+		return ret;
540575 
541576 	adis16136_debugfs_init(indio_dev);
542
-
543
-	return 0;
544
-
545
-error_stop_device:
546
-	adis16136_stop_device(indio_dev);
547
-error_cleanup_buffer:
548
-	adis_cleanup_buffer_and_trigger(&adis16136->adis, indio_dev);
549
-	return ret;
550
-}
551
-
552
-static int adis16136_remove(struct spi_device *spi)
553
-{
554
-	struct iio_dev *indio_dev = spi_get_drvdata(spi);
555
-	struct adis16136 *adis16136 = iio_priv(indio_dev);
556
-
557
-	iio_device_unregister(indio_dev);
558
-	adis16136_stop_device(indio_dev);
559
-
560
-	adis_cleanup_buffer_and_trigger(&adis16136->adis, indio_dev);
561577 
562578 	return 0;
563579 }
....@@ -577,10 +593,10 @@
577593 	},
578594 	.id_table = adis16136_ids,
579595 	.probe = adis16136_probe,
580
-	.remove = adis16136_remove,
581596 };
582597 module_spi_driver(adis16136_driver);
583598 
584599 MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>");
585600 MODULE_DESCRIPTION("Analog Devices ADIS16133/ADIS16135/ADIS16136 gyroscope driver");
586601 MODULE_LICENSE("GPL v2");
602
+MODULE_IMPORT_NS(IIO_ADISLIB);