.. | .. |
---|
| 1 | +// SPDX-License-Identifier: GPL-2.0+ |
---|
1 | 2 | /* |
---|
2 | 3 | * ADIS16240 Programmable Impact Sensor and Recorder driver |
---|
3 | 4 | * |
---|
4 | 5 | * Copyright 2010 Analog Devices Inc. |
---|
5 | | - * |
---|
6 | | - * Licensed under the GPL-2 or later. |
---|
7 | 6 | */ |
---|
8 | 7 | |
---|
9 | 8 | #include <linux/interrupt.h> |
---|
10 | 9 | #include <linux/irq.h> |
---|
11 | | -#include <linux/gpio.h> |
---|
12 | 10 | #include <linux/delay.h> |
---|
13 | 11 | #include <linux/device.h> |
---|
14 | 12 | #include <linux/kernel.h> |
---|
.. | .. |
---|
176 | 174 | /* Power supply above 3.625 V */ |
---|
177 | 175 | #define ADIS16240_DIAG_STAT_POWER_HIGH_BIT 1 |
---|
178 | 176 | |
---|
179 | | - /* Power supply below 3.15 V */ |
---|
| 177 | + /* Power supply below 2.225 V */ |
---|
180 | 178 | #define ADIS16240_DIAG_STAT_POWER_LOW_BIT 0 |
---|
181 | 179 | |
---|
182 | 180 | /* GLOB_CMD */ |
---|
.. | .. |
---|
310 | 308 | long mask) |
---|
311 | 309 | { |
---|
312 | 310 | struct adis *st = iio_priv(indio_dev); |
---|
313 | | - int bits = 10; |
---|
314 | | - s16 val16; |
---|
315 | 311 | u8 addr; |
---|
316 | 312 | |
---|
317 | 313 | switch (mask) { |
---|
318 | 314 | case IIO_CHAN_INFO_CALIBBIAS: |
---|
319 | | - val16 = val & ((1 << bits) - 1); |
---|
320 | 315 | addr = adis16240_addresses[chan->scan_index][0]; |
---|
321 | | - return adis_write_reg_16(st, addr, val16); |
---|
| 316 | + return adis_write_reg_16(st, addr, val & GENMASK(9, 0)); |
---|
322 | 317 | } |
---|
323 | 318 | return -EINVAL; |
---|
324 | 319 | } |
---|
.. | .. |
---|
364 | 359 | [ADIS16240_DIAG_STAT_POWER_LOW_BIT] = "Power supply below 2.225V", |
---|
365 | 360 | }; |
---|
366 | 361 | |
---|
| 362 | +static const struct adis_timeout adis16240_timeouts = { |
---|
| 363 | + .reset_ms = ADIS16240_STARTUP_DELAY, |
---|
| 364 | + .sw_reset_ms = ADIS16240_STARTUP_DELAY, |
---|
| 365 | + .self_test_ms = ADIS16240_STARTUP_DELAY, |
---|
| 366 | +}; |
---|
| 367 | + |
---|
367 | 368 | static const struct adis_data adis16240_data = { |
---|
368 | 369 | .write_delay = 35, |
---|
369 | 370 | .read_delay = 35, |
---|
.. | .. |
---|
372 | 373 | .diag_stat_reg = ADIS16240_DIAG_STAT, |
---|
373 | 374 | |
---|
374 | 375 | .self_test_mask = ADIS16240_MSC_CTRL_SELF_TEST_EN, |
---|
| 376 | + .self_test_reg = ADIS16240_MSC_CTRL, |
---|
375 | 377 | .self_test_no_autoclear = true, |
---|
376 | | - .startup_delay = ADIS16240_STARTUP_DELAY, |
---|
| 378 | + .timeouts = &adis16240_timeouts, |
---|
377 | 379 | |
---|
378 | 380 | .status_error_msgs = adis16240_status_error_msgs, |
---|
379 | 381 | .status_error_mask = BIT(ADIS16240_DIAG_STAT_PWRON_FAIL_BIT) | |
---|
.. | .. |
---|
398 | 400 | spi_set_drvdata(spi, indio_dev); |
---|
399 | 401 | |
---|
400 | 402 | indio_dev->name = spi->dev.driver->name; |
---|
401 | | - indio_dev->dev.parent = &spi->dev; |
---|
402 | 403 | indio_dev->info = &adis16240_info; |
---|
403 | 404 | indio_dev->channels = adis16240_channels; |
---|
404 | 405 | indio_dev->num_channels = ARRAY_SIZE(adis16240_channels); |
---|
405 | 406 | indio_dev->modes = INDIO_DIRECT_MODE; |
---|
406 | 407 | |
---|
| 408 | + spi->mode = SPI_MODE_3; |
---|
| 409 | + ret = spi_setup(spi); |
---|
| 410 | + if (ret) { |
---|
| 411 | + dev_err(&spi->dev, "spi_setup failed!\n"); |
---|
| 412 | + return ret; |
---|
| 413 | + } |
---|
| 414 | + |
---|
407 | 415 | ret = adis_init(st, indio_dev, spi, &adis16240_data); |
---|
408 | 416 | if (ret) |
---|
409 | 417 | return ret; |
---|
410 | | - ret = adis_setup_buffer_and_trigger(st, indio_dev, NULL); |
---|
| 418 | + ret = devm_adis_setup_buffer_and_trigger(st, indio_dev, NULL); |
---|
411 | 419 | if (ret) |
---|
412 | 420 | return ret; |
---|
413 | 421 | |
---|
414 | 422 | /* Get the device into a sane initial state */ |
---|
415 | 423 | ret = adis_initial_startup(st); |
---|
416 | 424 | if (ret) |
---|
417 | | - goto error_cleanup_buffer_trigger; |
---|
418 | | - ret = iio_device_register(indio_dev); |
---|
419 | | - if (ret) |
---|
420 | | - goto error_cleanup_buffer_trigger; |
---|
421 | | - return 0; |
---|
| 425 | + return ret; |
---|
422 | 426 | |
---|
423 | | -error_cleanup_buffer_trigger: |
---|
424 | | - adis_cleanup_buffer_and_trigger(st, indio_dev); |
---|
425 | | - return ret; |
---|
| 427 | + return devm_iio_device_register(&spi->dev, indio_dev); |
---|
426 | 428 | } |
---|
427 | | - |
---|
428 | | -static int adis16240_remove(struct spi_device *spi) |
---|
429 | | -{ |
---|
430 | | - struct iio_dev *indio_dev = spi_get_drvdata(spi); |
---|
431 | | - struct adis *st = iio_priv(indio_dev); |
---|
432 | | - |
---|
433 | | - iio_device_unregister(indio_dev); |
---|
434 | | - adis_cleanup_buffer_and_trigger(st, indio_dev); |
---|
435 | | - |
---|
436 | | - return 0; |
---|
437 | | -} |
---|
| 429 | +static const struct of_device_id adis16240_of_match[] = { |
---|
| 430 | + { .compatible = "adi,adis16240" }, |
---|
| 431 | + { }, |
---|
| 432 | +}; |
---|
| 433 | +MODULE_DEVICE_TABLE(of, adis16240_of_match); |
---|
438 | 434 | |
---|
439 | 435 | static struct spi_driver adis16240_driver = { |
---|
440 | 436 | .driver = { |
---|
441 | 437 | .name = "adis16240", |
---|
| 438 | + .of_match_table = adis16240_of_match, |
---|
442 | 439 | }, |
---|
443 | 440 | .probe = adis16240_probe, |
---|
444 | | - .remove = adis16240_remove, |
---|
445 | 441 | }; |
---|
446 | 442 | module_spi_driver(adis16240_driver); |
---|
447 | 443 | |
---|
.. | .. |
---|
449 | 445 | MODULE_DESCRIPTION("Analog Devices Programmable Impact Sensor and Recorder"); |
---|
450 | 446 | MODULE_LICENSE("GPL v2"); |
---|
451 | 447 | MODULE_ALIAS("spi:adis16240"); |
---|
| 448 | +MODULE_IMPORT_NS(IIO_ADISLIB); |
---|