180503b23SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 2ec04cb04SLars-Peter Clausen /* 3ec04cb04SLars-Peter Clausen * Common library for ADIS16XXX devices 4ec04cb04SLars-Peter Clausen * 5ec04cb04SLars-Peter Clausen * Copyright 2012 Analog Devices Inc. 6ec04cb04SLars-Peter Clausen * Author: Lars-Peter Clausen <lars@metafoo.de> 7ec04cb04SLars-Peter Clausen */ 8ec04cb04SLars-Peter Clausen 9ec04cb04SLars-Peter Clausen #include <linux/delay.h> 10ec04cb04SLars-Peter Clausen #include <linux/mutex.h> 11ec04cb04SLars-Peter Clausen #include <linux/device.h> 12ec04cb04SLars-Peter Clausen #include <linux/kernel.h> 13ec04cb04SLars-Peter Clausen #include <linux/spi/spi.h> 14ec04cb04SLars-Peter Clausen #include <linux/slab.h> 15ec04cb04SLars-Peter Clausen #include <linux/sysfs.h> 16ec04cb04SLars-Peter Clausen #include <linux/module.h> 17ec04cb04SLars-Peter Clausen #include <asm/unaligned.h> 18ec04cb04SLars-Peter Clausen 19ec04cb04SLars-Peter Clausen #include <linux/iio/iio.h> 20ec04cb04SLars-Peter Clausen #include <linux/iio/sysfs.h> 21ec04cb04SLars-Peter Clausen #include <linux/iio/buffer.h> 22ec04cb04SLars-Peter Clausen #include <linux/iio/imu/adis.h> 23ec04cb04SLars-Peter Clausen 24ec04cb04SLars-Peter Clausen #define ADIS_MSC_CTRL_DATA_RDY_EN BIT(2) 25ec04cb04SLars-Peter Clausen #define ADIS_MSC_CTRL_DATA_RDY_POL_HIGH BIT(1) 26ec04cb04SLars-Peter Clausen #define ADIS_MSC_CTRL_DATA_RDY_DIO2 BIT(0) 27ec04cb04SLars-Peter Clausen #define ADIS_GLOB_CMD_SW_RESET BIT(7) 28ec04cb04SLars-Peter Clausen 29770d4656SAlexandru Ardelean /** 30770d4656SAlexandru Ardelean * __adis_write_reg() - write N bytes to register (unlocked version) 31770d4656SAlexandru Ardelean * @adis: The adis device 32770d4656SAlexandru Ardelean * @reg: The address of the lower of the two registers 33770d4656SAlexandru Ardelean * @value: The value to write to device (up to 4 bytes) 34770d4656SAlexandru Ardelean * @size: The size of the @value (in bytes) 35770d4656SAlexandru Ardelean */ 36770d4656SAlexandru Ardelean int __adis_write_reg(struct adis *adis, unsigned int reg, 3757a1228aSLars-Peter Clausen unsigned int value, unsigned int size) 38ec04cb04SLars-Peter Clausen { 39484a0bf0SLars-Peter Clausen unsigned int page = reg / ADIS_PAGE_SIZE; 4057a1228aSLars-Peter Clausen int ret, i; 41ec04cb04SLars-Peter Clausen struct spi_message msg; 42ec04cb04SLars-Peter Clausen struct spi_transfer xfers[] = { 43ec04cb04SLars-Peter Clausen { 44ec04cb04SLars-Peter Clausen .tx_buf = adis->tx, 45ec04cb04SLars-Peter Clausen .bits_per_word = 8, 46ec04cb04SLars-Peter Clausen .len = 2, 47ec04cb04SLars-Peter Clausen .cs_change = 1, 48a4e6f40cSAlexandru Ardelean .delay.value = adis->data->write_delay, 49a4e6f40cSAlexandru Ardelean .delay.unit = SPI_DELAY_UNIT_USECS, 50329f0dacSAlexandru Ardelean .cs_change_delay.value = adis->data->cs_change_delay, 51329f0dacSAlexandru Ardelean .cs_change_delay.unit = SPI_DELAY_UNIT_USECS, 52ec04cb04SLars-Peter Clausen }, { 53ec04cb04SLars-Peter Clausen .tx_buf = adis->tx + 2, 54ec04cb04SLars-Peter Clausen .bits_per_word = 8, 55ec04cb04SLars-Peter Clausen .len = 2, 5657a1228aSLars-Peter Clausen .cs_change = 1, 57a4e6f40cSAlexandru Ardelean .delay.value = adis->data->write_delay, 58a4e6f40cSAlexandru Ardelean .delay.unit = SPI_DELAY_UNIT_USECS, 59329f0dacSAlexandru Ardelean .cs_change_delay.value = adis->data->cs_change_delay, 60329f0dacSAlexandru Ardelean .cs_change_delay.unit = SPI_DELAY_UNIT_USECS, 6157a1228aSLars-Peter Clausen }, { 6257a1228aSLars-Peter Clausen .tx_buf = adis->tx + 4, 6357a1228aSLars-Peter Clausen .bits_per_word = 8, 6457a1228aSLars-Peter Clausen .len = 2, 6557a1228aSLars-Peter Clausen .cs_change = 1, 66a4e6f40cSAlexandru Ardelean .delay.value = adis->data->write_delay, 67a4e6f40cSAlexandru Ardelean .delay.unit = SPI_DELAY_UNIT_USECS, 68329f0dacSAlexandru Ardelean .cs_change_delay.value = adis->data->cs_change_delay, 69329f0dacSAlexandru Ardelean .cs_change_delay.unit = SPI_DELAY_UNIT_USECS, 7057a1228aSLars-Peter Clausen }, { 7157a1228aSLars-Peter Clausen .tx_buf = adis->tx + 6, 7257a1228aSLars-Peter Clausen .bits_per_word = 8, 7357a1228aSLars-Peter Clausen .len = 2, 74a4e6f40cSAlexandru Ardelean .delay.value = adis->data->write_delay, 75a4e6f40cSAlexandru Ardelean .delay.unit = SPI_DELAY_UNIT_USECS, 76484a0bf0SLars-Peter Clausen }, { 77484a0bf0SLars-Peter Clausen .tx_buf = adis->tx + 8, 78484a0bf0SLars-Peter Clausen .bits_per_word = 8, 79484a0bf0SLars-Peter Clausen .len = 2, 80a4e6f40cSAlexandru Ardelean .delay.value = adis->data->write_delay, 81a4e6f40cSAlexandru Ardelean .delay.unit = SPI_DELAY_UNIT_USECS, 82ec04cb04SLars-Peter Clausen }, 83ec04cb04SLars-Peter Clausen }; 84ec04cb04SLars-Peter Clausen 85ec04cb04SLars-Peter Clausen spi_message_init(&msg); 86484a0bf0SLars-Peter Clausen 87484a0bf0SLars-Peter Clausen if (adis->current_page != page) { 88484a0bf0SLars-Peter Clausen adis->tx[0] = ADIS_WRITE_REG(ADIS_REG_PAGE_ID); 89484a0bf0SLars-Peter Clausen adis->tx[1] = page; 90484a0bf0SLars-Peter Clausen spi_message_add_tail(&xfers[0], &msg); 91484a0bf0SLars-Peter Clausen } 92484a0bf0SLars-Peter Clausen 9357a1228aSLars-Peter Clausen switch (size) { 9457a1228aSLars-Peter Clausen case 4: 95484a0bf0SLars-Peter Clausen adis->tx[8] = ADIS_WRITE_REG(reg + 3); 96484a0bf0SLars-Peter Clausen adis->tx[9] = (value >> 24) & 0xff; 97484a0bf0SLars-Peter Clausen adis->tx[6] = ADIS_WRITE_REG(reg + 2); 98484a0bf0SLars-Peter Clausen adis->tx[7] = (value >> 16) & 0xff; 9982d65f9dSGustavo A. R. Silva /* fall through */ 10057a1228aSLars-Peter Clausen case 2: 101484a0bf0SLars-Peter Clausen adis->tx[4] = ADIS_WRITE_REG(reg + 1); 102484a0bf0SLars-Peter Clausen adis->tx[5] = (value >> 8) & 0xff; 10382d65f9dSGustavo A. R. Silva /* fall through */ 10457a1228aSLars-Peter Clausen case 1: 105484a0bf0SLars-Peter Clausen adis->tx[2] = ADIS_WRITE_REG(reg); 106484a0bf0SLars-Peter Clausen adis->tx[3] = value & 0xff; 10757a1228aSLars-Peter Clausen break; 10857a1228aSLars-Peter Clausen default: 109770d4656SAlexandru Ardelean return -EINVAL; 11057a1228aSLars-Peter Clausen } 11157a1228aSLars-Peter Clausen 112484a0bf0SLars-Peter Clausen xfers[size].cs_change = 0; 11357a1228aSLars-Peter Clausen 114484a0bf0SLars-Peter Clausen for (i = 1; i <= size; i++) 11557a1228aSLars-Peter Clausen spi_message_add_tail(&xfers[i], &msg); 11657a1228aSLars-Peter Clausen 117ec04cb04SLars-Peter Clausen ret = spi_sync(adis->spi, &msg); 11857a1228aSLars-Peter Clausen if (ret) { 11957a1228aSLars-Peter Clausen dev_err(&adis->spi->dev, "Failed to write register 0x%02X: %d\n", 12057a1228aSLars-Peter Clausen reg, ret); 121484a0bf0SLars-Peter Clausen } else { 122484a0bf0SLars-Peter Clausen adis->current_page = page; 12357a1228aSLars-Peter Clausen } 12457a1228aSLars-Peter Clausen 125ec04cb04SLars-Peter Clausen return ret; 126ec04cb04SLars-Peter Clausen } 127770d4656SAlexandru Ardelean EXPORT_SYMBOL_GPL(__adis_write_reg); 128ec04cb04SLars-Peter Clausen 129ec04cb04SLars-Peter Clausen /** 130770d4656SAlexandru Ardelean * __adis_read_reg() - read N bytes from register (unlocked version) 131ec04cb04SLars-Peter Clausen * @adis: The adis device 132ec04cb04SLars-Peter Clausen * @reg: The address of the lower of the two registers 133ec04cb04SLars-Peter Clausen * @val: The value read back from the device 134770d4656SAlexandru Ardelean * @size: The size of the @val buffer 135ec04cb04SLars-Peter Clausen */ 136770d4656SAlexandru Ardelean int __adis_read_reg(struct adis *adis, unsigned int reg, 13757a1228aSLars-Peter Clausen unsigned int *val, unsigned int size) 138ec04cb04SLars-Peter Clausen { 139484a0bf0SLars-Peter Clausen unsigned int page = reg / ADIS_PAGE_SIZE; 140ec04cb04SLars-Peter Clausen struct spi_message msg; 141ec04cb04SLars-Peter Clausen int ret; 142ec04cb04SLars-Peter Clausen struct spi_transfer xfers[] = { 143ec04cb04SLars-Peter Clausen { 144ec04cb04SLars-Peter Clausen .tx_buf = adis->tx, 145ec04cb04SLars-Peter Clausen .bits_per_word = 8, 146ec04cb04SLars-Peter Clausen .len = 2, 147ec04cb04SLars-Peter Clausen .cs_change = 1, 148a4e6f40cSAlexandru Ardelean .delay.value = adis->data->write_delay, 149a4e6f40cSAlexandru Ardelean .delay.unit = SPI_DELAY_UNIT_USECS, 150329f0dacSAlexandru Ardelean .cs_change_delay.value = adis->data->cs_change_delay, 151329f0dacSAlexandru Ardelean .cs_change_delay.unit = SPI_DELAY_UNIT_USECS, 152ec04cb04SLars-Peter Clausen }, { 15357a1228aSLars-Peter Clausen .tx_buf = adis->tx + 2, 154484a0bf0SLars-Peter Clausen .bits_per_word = 8, 155484a0bf0SLars-Peter Clausen .len = 2, 156484a0bf0SLars-Peter Clausen .cs_change = 1, 157a4e6f40cSAlexandru Ardelean .delay.value = adis->data->read_delay, 158a4e6f40cSAlexandru Ardelean .delay.unit = SPI_DELAY_UNIT_USECS, 159329f0dacSAlexandru Ardelean .cs_change_delay.value = adis->data->cs_change_delay, 160329f0dacSAlexandru Ardelean .cs_change_delay.unit = SPI_DELAY_UNIT_USECS, 161484a0bf0SLars-Peter Clausen }, { 162484a0bf0SLars-Peter Clausen .tx_buf = adis->tx + 4, 163ec04cb04SLars-Peter Clausen .rx_buf = adis->rx, 164ec04cb04SLars-Peter Clausen .bits_per_word = 8, 165ec04cb04SLars-Peter Clausen .len = 2, 16657a1228aSLars-Peter Clausen .cs_change = 1, 167a4e6f40cSAlexandru Ardelean .delay.value = adis->data->read_delay, 168a4e6f40cSAlexandru Ardelean .delay.unit = SPI_DELAY_UNIT_USECS, 169329f0dacSAlexandru Ardelean .cs_change_delay.value = adis->data->cs_change_delay, 170329f0dacSAlexandru Ardelean .cs_change_delay.unit = SPI_DELAY_UNIT_USECS, 17157a1228aSLars-Peter Clausen }, { 17257a1228aSLars-Peter Clausen .rx_buf = adis->rx + 2, 17357a1228aSLars-Peter Clausen .bits_per_word = 8, 17457a1228aSLars-Peter Clausen .len = 2, 175a4e6f40cSAlexandru Ardelean .delay.value = adis->data->read_delay, 176a4e6f40cSAlexandru Ardelean .delay.unit = SPI_DELAY_UNIT_USECS, 177ec04cb04SLars-Peter Clausen }, 178ec04cb04SLars-Peter Clausen }; 179ec04cb04SLars-Peter Clausen 180ec04cb04SLars-Peter Clausen spi_message_init(&msg); 18157a1228aSLars-Peter Clausen 182484a0bf0SLars-Peter Clausen if (adis->current_page != page) { 183484a0bf0SLars-Peter Clausen adis->tx[0] = ADIS_WRITE_REG(ADIS_REG_PAGE_ID); 184484a0bf0SLars-Peter Clausen adis->tx[1] = page; 185484a0bf0SLars-Peter Clausen spi_message_add_tail(&xfers[0], &msg); 186484a0bf0SLars-Peter Clausen } 187484a0bf0SLars-Peter Clausen 18857a1228aSLars-Peter Clausen switch (size) { 18957a1228aSLars-Peter Clausen case 4: 190484a0bf0SLars-Peter Clausen adis->tx[2] = ADIS_READ_REG(reg + 2); 19157a1228aSLars-Peter Clausen adis->tx[3] = 0; 192ec04cb04SLars-Peter Clausen spi_message_add_tail(&xfers[1], &msg); 19382d65f9dSGustavo A. R. Silva /* fall through */ 194484a0bf0SLars-Peter Clausen case 2: 195484a0bf0SLars-Peter Clausen adis->tx[4] = ADIS_READ_REG(reg); 196484a0bf0SLars-Peter Clausen adis->tx[5] = 0; 19757a1228aSLars-Peter Clausen spi_message_add_tail(&xfers[2], &msg); 198484a0bf0SLars-Peter Clausen spi_message_add_tail(&xfers[3], &msg); 19957a1228aSLars-Peter Clausen break; 20057a1228aSLars-Peter Clausen default: 201770d4656SAlexandru Ardelean return -EINVAL; 20257a1228aSLars-Peter Clausen } 20357a1228aSLars-Peter Clausen 204ec04cb04SLars-Peter Clausen ret = spi_sync(adis->spi, &msg); 205ec04cb04SLars-Peter Clausen if (ret) { 20657a1228aSLars-Peter Clausen dev_err(&adis->spi->dev, "Failed to read register 0x%02X: %d\n", 207ec04cb04SLars-Peter Clausen reg, ret); 208770d4656SAlexandru Ardelean return ret; 209484a0bf0SLars-Peter Clausen } else { 210484a0bf0SLars-Peter Clausen adis->current_page = page; 211ec04cb04SLars-Peter Clausen } 212ec04cb04SLars-Peter Clausen 21357a1228aSLars-Peter Clausen switch (size) { 21457a1228aSLars-Peter Clausen case 4: 21557a1228aSLars-Peter Clausen *val = get_unaligned_be32(adis->rx); 21657a1228aSLars-Peter Clausen break; 21757a1228aSLars-Peter Clausen case 2: 21857a1228aSLars-Peter Clausen *val = get_unaligned_be16(adis->rx + 2); 21957a1228aSLars-Peter Clausen break; 22057a1228aSLars-Peter Clausen } 22157a1228aSLars-Peter Clausen 222ec04cb04SLars-Peter Clausen return ret; 223ec04cb04SLars-Peter Clausen } 224770d4656SAlexandru Ardelean EXPORT_SYMBOL_GPL(__adis_read_reg); 225ec04cb04SLars-Peter Clausen 22678026a6fSLars-Peter Clausen #ifdef CONFIG_DEBUG_FS 22778026a6fSLars-Peter Clausen 22878026a6fSLars-Peter Clausen int adis_debugfs_reg_access(struct iio_dev *indio_dev, 22978026a6fSLars-Peter Clausen unsigned int reg, unsigned int writeval, unsigned int *readval) 23078026a6fSLars-Peter Clausen { 23178026a6fSLars-Peter Clausen struct adis *adis = iio_device_get_drvdata(indio_dev); 23278026a6fSLars-Peter Clausen 23378026a6fSLars-Peter Clausen if (readval) { 23478026a6fSLars-Peter Clausen uint16_t val16; 23578026a6fSLars-Peter Clausen int ret; 23678026a6fSLars-Peter Clausen 23778026a6fSLars-Peter Clausen ret = adis_read_reg_16(adis, reg, &val16); 23838262c01SAlexandru Ardelean if (ret == 0) 23978026a6fSLars-Peter Clausen *readval = val16; 24078026a6fSLars-Peter Clausen 24178026a6fSLars-Peter Clausen return ret; 24278026a6fSLars-Peter Clausen } else { 24378026a6fSLars-Peter Clausen return adis_write_reg_16(adis, reg, writeval); 24478026a6fSLars-Peter Clausen } 24578026a6fSLars-Peter Clausen } 24678026a6fSLars-Peter Clausen EXPORT_SYMBOL(adis_debugfs_reg_access); 24778026a6fSLars-Peter Clausen 24878026a6fSLars-Peter Clausen #endif 24978026a6fSLars-Peter Clausen 250ec04cb04SLars-Peter Clausen /** 251ec04cb04SLars-Peter Clausen * adis_enable_irq() - Enable or disable data ready IRQ 252ec04cb04SLars-Peter Clausen * @adis: The adis device 253ec04cb04SLars-Peter Clausen * @enable: Whether to enable the IRQ 254ec04cb04SLars-Peter Clausen * 255ec04cb04SLars-Peter Clausen * Returns 0 on success, negative error code otherwise 256ec04cb04SLars-Peter Clausen */ 257ec04cb04SLars-Peter Clausen int adis_enable_irq(struct adis *adis, bool enable) 258ec04cb04SLars-Peter Clausen { 259ec04cb04SLars-Peter Clausen int ret = 0; 260ec04cb04SLars-Peter Clausen uint16_t msc; 261ec04cb04SLars-Peter Clausen 262100bfa38SAlexandru Ardelean mutex_lock(&adis->state_lock); 2632f3abe6cSLars-Peter Clausen 264100bfa38SAlexandru Ardelean if (adis->data->enable_irq) { 265100bfa38SAlexandru Ardelean ret = adis->data->enable_irq(adis, enable); 266100bfa38SAlexandru Ardelean goto out_unlock; 267100bfa38SAlexandru Ardelean } 268100bfa38SAlexandru Ardelean 269100bfa38SAlexandru Ardelean ret = __adis_read_reg_16(adis, adis->data->msc_ctrl_reg, &msc); 270ec04cb04SLars-Peter Clausen if (ret) 271100bfa38SAlexandru Ardelean goto out_unlock; 272ec04cb04SLars-Peter Clausen 273ec04cb04SLars-Peter Clausen msc |= ADIS_MSC_CTRL_DATA_RDY_POL_HIGH; 274ec04cb04SLars-Peter Clausen msc &= ~ADIS_MSC_CTRL_DATA_RDY_DIO2; 275ec04cb04SLars-Peter Clausen if (enable) 276ec04cb04SLars-Peter Clausen msc |= ADIS_MSC_CTRL_DATA_RDY_EN; 277ec04cb04SLars-Peter Clausen else 278ec04cb04SLars-Peter Clausen msc &= ~ADIS_MSC_CTRL_DATA_RDY_EN; 279ec04cb04SLars-Peter Clausen 280100bfa38SAlexandru Ardelean ret = __adis_write_reg_16(adis, adis->data->msc_ctrl_reg, msc); 281ec04cb04SLars-Peter Clausen 282100bfa38SAlexandru Ardelean out_unlock: 283100bfa38SAlexandru Ardelean mutex_unlock(&adis->state_lock); 284ec04cb04SLars-Peter Clausen return ret; 285ec04cb04SLars-Peter Clausen } 286ec04cb04SLars-Peter Clausen EXPORT_SYMBOL(adis_enable_irq); 287ec04cb04SLars-Peter Clausen 288ec04cb04SLars-Peter Clausen /** 2896a4d6a7dSAlexandru Ardelean * __adis_check_status() - Check the device for error conditions (unlocked) 290ec04cb04SLars-Peter Clausen * @adis: The adis device 291ec04cb04SLars-Peter Clausen * 292ec04cb04SLars-Peter Clausen * Returns 0 on success, a negative error code otherwise 293ec04cb04SLars-Peter Clausen */ 2946a4d6a7dSAlexandru Ardelean int __adis_check_status(struct adis *adis) 295ec04cb04SLars-Peter Clausen { 296ec04cb04SLars-Peter Clausen uint16_t status; 297ec04cb04SLars-Peter Clausen int ret; 298ec04cb04SLars-Peter Clausen int i; 299ec04cb04SLars-Peter Clausen 3006a4d6a7dSAlexandru Ardelean ret = __adis_read_reg_16(adis, adis->data->diag_stat_reg, &status); 3016a39ab3bSAlexandru Ardelean if (ret) 302ec04cb04SLars-Peter Clausen return ret; 303ec04cb04SLars-Peter Clausen 304ec04cb04SLars-Peter Clausen status &= adis->data->status_error_mask; 305ec04cb04SLars-Peter Clausen 306ec04cb04SLars-Peter Clausen if (status == 0) 307ec04cb04SLars-Peter Clausen return 0; 308ec04cb04SLars-Peter Clausen 309ec04cb04SLars-Peter Clausen for (i = 0; i < 16; ++i) { 310ec04cb04SLars-Peter Clausen if (status & BIT(i)) { 311ec04cb04SLars-Peter Clausen dev_err(&adis->spi->dev, "%s.\n", 312ec04cb04SLars-Peter Clausen adis->data->status_error_msgs[i]); 313ec04cb04SLars-Peter Clausen } 314ec04cb04SLars-Peter Clausen } 315ec04cb04SLars-Peter Clausen 316ec04cb04SLars-Peter Clausen return -EIO; 317ec04cb04SLars-Peter Clausen } 3186a4d6a7dSAlexandru Ardelean EXPORT_SYMBOL_GPL(__adis_check_status); 319ec04cb04SLars-Peter Clausen 320ec04cb04SLars-Peter Clausen /** 321762ab093SAlexandru Ardelean * __adis_reset() - Reset the device (unlocked version) 322ec04cb04SLars-Peter Clausen * @adis: The adis device 323ec04cb04SLars-Peter Clausen * 324ec04cb04SLars-Peter Clausen * Returns 0 on success, a negative error code otherwise 325ec04cb04SLars-Peter Clausen */ 326762ab093SAlexandru Ardelean int __adis_reset(struct adis *adis) 327ec04cb04SLars-Peter Clausen { 328ec04cb04SLars-Peter Clausen int ret; 329380b107bSNuno Sá const struct adis_timeout *timeouts = adis->data->timeouts; 330ec04cb04SLars-Peter Clausen 331762ab093SAlexandru Ardelean ret = __adis_write_reg_8(adis, adis->data->glob_cmd_reg, 332ec04cb04SLars-Peter Clausen ADIS_GLOB_CMD_SW_RESET); 333380b107bSNuno Sá if (ret) { 334ec04cb04SLars-Peter Clausen dev_err(&adis->spi->dev, "Failed to reset device: %d\n", ret); 335ec04cb04SLars-Peter Clausen return ret; 336ec04cb04SLars-Peter Clausen } 337380b107bSNuno Sá 338380b107bSNuno Sá msleep(timeouts->sw_reset_ms); 339380b107bSNuno Sá 340380b107bSNuno Sá return 0; 341380b107bSNuno Sá } 342762ab093SAlexandru Ardelean EXPORT_SYMBOL_GPL(__adis_reset); 343ec04cb04SLars-Peter Clausen 344ec04cb04SLars-Peter Clausen static int adis_self_test(struct adis *adis) 345ec04cb04SLars-Peter Clausen { 346ec04cb04SLars-Peter Clausen int ret; 347380b107bSNuno Sá const struct adis_timeout *timeouts = adis->data->timeouts; 348ec04cb04SLars-Peter Clausen 349fdcf6bbbSNuno Sá ret = __adis_write_reg_16(adis, adis->data->self_test_reg, 350ec04cb04SLars-Peter Clausen adis->data->self_test_mask); 351ec04cb04SLars-Peter Clausen if (ret) { 352ec04cb04SLars-Peter Clausen dev_err(&adis->spi->dev, "Failed to initiate self test: %d\n", 353ec04cb04SLars-Peter Clausen ret); 354ec04cb04SLars-Peter Clausen return ret; 355ec04cb04SLars-Peter Clausen } 356ec04cb04SLars-Peter Clausen 357380b107bSNuno Sá msleep(timeouts->self_test_ms); 358ec04cb04SLars-Peter Clausen 359cb5a07f1SAlexandru Ardelean ret = __adis_check_status(adis); 360af8a4127SLars-Peter Clausen 361af8a4127SLars-Peter Clausen if (adis->data->self_test_no_autoclear) 362fdcf6bbbSNuno Sá __adis_write_reg_16(adis, adis->data->self_test_reg, 0x00); 363af8a4127SLars-Peter Clausen 364af8a4127SLars-Peter Clausen return ret; 365ec04cb04SLars-Peter Clausen } 366ec04cb04SLars-Peter Clausen 367ec04cb04SLars-Peter Clausen /** 3683f17ada8SAlexandru Ardelean * __adis_initial_startup() - Device initial setup 369ec04cb04SLars-Peter Clausen * @adis: The adis device 370ec04cb04SLars-Peter Clausen * 371ec04cb04SLars-Peter Clausen * Returns 0 if the device is operational, a negative error code otherwise. 372ec04cb04SLars-Peter Clausen * 373ec04cb04SLars-Peter Clausen * This function should be called early on in the device initialization sequence 374ec04cb04SLars-Peter Clausen * to ensure that the device is in a sane and known state and that it is usable. 375ec04cb04SLars-Peter Clausen */ 3763f17ada8SAlexandru Ardelean int __adis_initial_startup(struct adis *adis) 377ec04cb04SLars-Peter Clausen { 378ec04cb04SLars-Peter Clausen int ret; 379ec04cb04SLars-Peter Clausen 380ec04cb04SLars-Peter Clausen ret = adis_self_test(adis); 381ec04cb04SLars-Peter Clausen if (ret) { 382ec04cb04SLars-Peter Clausen dev_err(&adis->spi->dev, "Self-test failed, trying reset.\n"); 383cb5a07f1SAlexandru Ardelean __adis_reset(adis); 384ec04cb04SLars-Peter Clausen ret = adis_self_test(adis); 3853f17ada8SAlexandru Ardelean if (ret) 386ec04cb04SLars-Peter Clausen dev_err(&adis->spi->dev, "Second self-test failed, giving up.\n"); 387ec04cb04SLars-Peter Clausen } 388ec04cb04SLars-Peter Clausen 389cb5a07f1SAlexandru Ardelean return ret; 390ec04cb04SLars-Peter Clausen } 3913f17ada8SAlexandru Ardelean EXPORT_SYMBOL_GPL(__adis_initial_startup); 392ec04cb04SLars-Peter Clausen 393ec04cb04SLars-Peter Clausen /** 394ec04cb04SLars-Peter Clausen * adis_single_conversion() - Performs a single sample conversion 395ec04cb04SLars-Peter Clausen * @indio_dev: The IIO device 396ec04cb04SLars-Peter Clausen * @chan: The IIO channel 397ec04cb04SLars-Peter Clausen * @error_mask: Mask for the error bit 398ec04cb04SLars-Peter Clausen * @val: Result of the conversion 399ec04cb04SLars-Peter Clausen * 400ec04cb04SLars-Peter Clausen * Returns IIO_VAL_INT on success, a negative error code otherwise. 401ec04cb04SLars-Peter Clausen * 402ec04cb04SLars-Peter Clausen * The function performs a single conversion on a given channel and post 403ec04cb04SLars-Peter Clausen * processes the value accordingly to the channel spec. If a error_mask is given 404ec04cb04SLars-Peter Clausen * the function will check if the mask is set in the returned raw value. If it 405ec04cb04SLars-Peter Clausen * is set the function will perform a self-check. If the device does not report 406ec04cb04SLars-Peter Clausen * a error bit in the channels raw value set error_mask to 0. 407ec04cb04SLars-Peter Clausen */ 408ec04cb04SLars-Peter Clausen int adis_single_conversion(struct iio_dev *indio_dev, 409ec04cb04SLars-Peter Clausen const struct iio_chan_spec *chan, unsigned int error_mask, int *val) 410ec04cb04SLars-Peter Clausen { 411ec04cb04SLars-Peter Clausen struct adis *adis = iio_device_get_drvdata(indio_dev); 41257a1228aSLars-Peter Clausen unsigned int uval; 413ec04cb04SLars-Peter Clausen int ret; 414ec04cb04SLars-Peter Clausen 415c5485a5dSAlexandru Ardelean mutex_lock(&adis->state_lock); 416ec04cb04SLars-Peter Clausen 417c5485a5dSAlexandru Ardelean ret = __adis_read_reg(adis, chan->address, &uval, 41857a1228aSLars-Peter Clausen chan->scan_type.storagebits / 8); 419ec04cb04SLars-Peter Clausen if (ret) 420ec04cb04SLars-Peter Clausen goto err_unlock; 421ec04cb04SLars-Peter Clausen 42257a1228aSLars-Peter Clausen if (uval & error_mask) { 423c5485a5dSAlexandru Ardelean ret = __adis_check_status(adis); 424ec04cb04SLars-Peter Clausen if (ret) 425ec04cb04SLars-Peter Clausen goto err_unlock; 426ec04cb04SLars-Peter Clausen } 427ec04cb04SLars-Peter Clausen 428ec04cb04SLars-Peter Clausen if (chan->scan_type.sign == 's') 42957a1228aSLars-Peter Clausen *val = sign_extend32(uval, chan->scan_type.realbits - 1); 430ec04cb04SLars-Peter Clausen else 43157a1228aSLars-Peter Clausen *val = uval & ((1 << chan->scan_type.realbits) - 1); 432ec04cb04SLars-Peter Clausen 433ec04cb04SLars-Peter Clausen ret = IIO_VAL_INT; 434ec04cb04SLars-Peter Clausen err_unlock: 435c5485a5dSAlexandru Ardelean mutex_unlock(&adis->state_lock); 436ec04cb04SLars-Peter Clausen return ret; 437ec04cb04SLars-Peter Clausen } 438ec04cb04SLars-Peter Clausen EXPORT_SYMBOL_GPL(adis_single_conversion); 439ec04cb04SLars-Peter Clausen 440ec04cb04SLars-Peter Clausen /** 441ec04cb04SLars-Peter Clausen * adis_init() - Initialize adis device structure 442ec04cb04SLars-Peter Clausen * @adis: The adis device 443ec04cb04SLars-Peter Clausen * @indio_dev: The iio device 444ec04cb04SLars-Peter Clausen * @spi: The spi device 445ec04cb04SLars-Peter Clausen * @data: Chip specific data 446ec04cb04SLars-Peter Clausen * 447ec04cb04SLars-Peter Clausen * Returns 0 on success, a negative error code otherwise. 448ec04cb04SLars-Peter Clausen * 449ec04cb04SLars-Peter Clausen * This function must be called, before any other adis helper function may be 450ec04cb04SLars-Peter Clausen * called. 451ec04cb04SLars-Peter Clausen */ 452ec04cb04SLars-Peter Clausen int adis_init(struct adis *adis, struct iio_dev *indio_dev, 453ec04cb04SLars-Peter Clausen struct spi_device *spi, const struct adis_data *data) 454ec04cb04SLars-Peter Clausen { 455380b107bSNuno Sá if (!data || !data->timeouts) { 456380b107bSNuno Sá dev_err(&spi->dev, "No config data or timeouts not defined!\n"); 457380b107bSNuno Sá return -EINVAL; 458380b107bSNuno Sá } 459380b107bSNuno Sá 4606a9afcb1SAlexandru Ardelean mutex_init(&adis->state_lock); 461ec04cb04SLars-Peter Clausen adis->spi = spi; 462ec04cb04SLars-Peter Clausen adis->data = data; 463ec04cb04SLars-Peter Clausen iio_device_set_drvdata(indio_dev, adis); 464ec04cb04SLars-Peter Clausen 465484a0bf0SLars-Peter Clausen if (data->has_paging) { 466484a0bf0SLars-Peter Clausen /* Need to set the page before first read/write */ 467484a0bf0SLars-Peter Clausen adis->current_page = -1; 468484a0bf0SLars-Peter Clausen } else { 469484a0bf0SLars-Peter Clausen /* Page will always be 0 */ 470484a0bf0SLars-Peter Clausen adis->current_page = 0; 471484a0bf0SLars-Peter Clausen } 472484a0bf0SLars-Peter Clausen 473ec04cb04SLars-Peter Clausen return adis_enable_irq(adis, false); 474ec04cb04SLars-Peter Clausen } 475ec04cb04SLars-Peter Clausen EXPORT_SYMBOL_GPL(adis_init); 476ec04cb04SLars-Peter Clausen 477ec04cb04SLars-Peter Clausen MODULE_LICENSE("GPL"); 478ec04cb04SLars-Peter Clausen MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>"); 479ec04cb04SLars-Peter Clausen MODULE_DESCRIPTION("Common library code for ADIS16XXX devices"); 480