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> 10ecb010d4SNuno Sá #include <linux/gpio/consumer.h> 11ec04cb04SLars-Peter Clausen #include <linux/mutex.h> 12ec04cb04SLars-Peter Clausen #include <linux/device.h> 13ec04cb04SLars-Peter Clausen #include <linux/kernel.h> 14ec04cb04SLars-Peter Clausen #include <linux/spi/spi.h> 15ec04cb04SLars-Peter Clausen #include <linux/module.h> 16ec04cb04SLars-Peter Clausen #include <asm/unaligned.h> 17ec04cb04SLars-Peter Clausen 18ec04cb04SLars-Peter Clausen #include <linux/iio/iio.h> 19ec04cb04SLars-Peter Clausen #include <linux/iio/imu/adis.h> 20ec04cb04SLars-Peter Clausen 21ec04cb04SLars-Peter Clausen #define ADIS_MSC_CTRL_DATA_RDY_EN BIT(2) 22ec04cb04SLars-Peter Clausen #define ADIS_MSC_CTRL_DATA_RDY_POL_HIGH BIT(1) 23ec04cb04SLars-Peter Clausen #define ADIS_MSC_CTRL_DATA_RDY_DIO2 BIT(0) 24ec04cb04SLars-Peter Clausen #define ADIS_GLOB_CMD_SW_RESET BIT(7) 25ec04cb04SLars-Peter Clausen 26770d4656SAlexandru Ardelean /** 27770d4656SAlexandru Ardelean * __adis_write_reg() - write N bytes to register (unlocked version) 28770d4656SAlexandru Ardelean * @adis: The adis device 29770d4656SAlexandru Ardelean * @reg: The address of the lower of the two registers 30770d4656SAlexandru Ardelean * @value: The value to write to device (up to 4 bytes) 31770d4656SAlexandru Ardelean * @size: The size of the @value (in bytes) 32770d4656SAlexandru Ardelean */ 33c39010eaSNuno Sá int __adis_write_reg(struct adis *adis, unsigned int reg, unsigned int value, 34c39010eaSNuno Sá unsigned int size) 35ec04cb04SLars-Peter Clausen { 36484a0bf0SLars-Peter Clausen unsigned int page = reg / ADIS_PAGE_SIZE; 3757a1228aSLars-Peter Clausen int ret, i; 38ec04cb04SLars-Peter Clausen struct spi_message msg; 39ec04cb04SLars-Peter Clausen struct spi_transfer xfers[] = { 40ec04cb04SLars-Peter Clausen { 41ec04cb04SLars-Peter Clausen .tx_buf = adis->tx, 42ec04cb04SLars-Peter Clausen .bits_per_word = 8, 43ec04cb04SLars-Peter Clausen .len = 2, 44ec04cb04SLars-Peter Clausen .cs_change = 1, 45a4e6f40cSAlexandru Ardelean .delay.value = adis->data->write_delay, 46a4e6f40cSAlexandru Ardelean .delay.unit = SPI_DELAY_UNIT_USECS, 47329f0dacSAlexandru Ardelean .cs_change_delay.value = adis->data->cs_change_delay, 48329f0dacSAlexandru Ardelean .cs_change_delay.unit = SPI_DELAY_UNIT_USECS, 49ec04cb04SLars-Peter Clausen }, { 50ec04cb04SLars-Peter Clausen .tx_buf = adis->tx + 2, 51ec04cb04SLars-Peter Clausen .bits_per_word = 8, 52ec04cb04SLars-Peter Clausen .len = 2, 5357a1228aSLars-Peter Clausen .cs_change = 1, 54a4e6f40cSAlexandru Ardelean .delay.value = adis->data->write_delay, 55a4e6f40cSAlexandru Ardelean .delay.unit = SPI_DELAY_UNIT_USECS, 56329f0dacSAlexandru Ardelean .cs_change_delay.value = adis->data->cs_change_delay, 57329f0dacSAlexandru Ardelean .cs_change_delay.unit = SPI_DELAY_UNIT_USECS, 5857a1228aSLars-Peter Clausen }, { 5957a1228aSLars-Peter Clausen .tx_buf = adis->tx + 4, 6057a1228aSLars-Peter Clausen .bits_per_word = 8, 6157a1228aSLars-Peter Clausen .len = 2, 6257a1228aSLars-Peter Clausen .cs_change = 1, 63a4e6f40cSAlexandru Ardelean .delay.value = adis->data->write_delay, 64a4e6f40cSAlexandru Ardelean .delay.unit = SPI_DELAY_UNIT_USECS, 65329f0dacSAlexandru Ardelean .cs_change_delay.value = adis->data->cs_change_delay, 66329f0dacSAlexandru Ardelean .cs_change_delay.unit = SPI_DELAY_UNIT_USECS, 6757a1228aSLars-Peter Clausen }, { 6857a1228aSLars-Peter Clausen .tx_buf = adis->tx + 6, 6957a1228aSLars-Peter Clausen .bits_per_word = 8, 7057a1228aSLars-Peter Clausen .len = 2, 71a4e6f40cSAlexandru Ardelean .delay.value = adis->data->write_delay, 72a4e6f40cSAlexandru Ardelean .delay.unit = SPI_DELAY_UNIT_USECS, 73484a0bf0SLars-Peter Clausen }, { 74484a0bf0SLars-Peter Clausen .tx_buf = adis->tx + 8, 75484a0bf0SLars-Peter Clausen .bits_per_word = 8, 76484a0bf0SLars-Peter Clausen .len = 2, 77a4e6f40cSAlexandru Ardelean .delay.value = adis->data->write_delay, 78a4e6f40cSAlexandru Ardelean .delay.unit = SPI_DELAY_UNIT_USECS, 79ec04cb04SLars-Peter Clausen }, 80ec04cb04SLars-Peter Clausen }; 81ec04cb04SLars-Peter Clausen 82ec04cb04SLars-Peter Clausen spi_message_init(&msg); 83484a0bf0SLars-Peter Clausen 84484a0bf0SLars-Peter Clausen if (adis->current_page != page) { 85484a0bf0SLars-Peter Clausen adis->tx[0] = ADIS_WRITE_REG(ADIS_REG_PAGE_ID); 86484a0bf0SLars-Peter Clausen adis->tx[1] = page; 87484a0bf0SLars-Peter Clausen spi_message_add_tail(&xfers[0], &msg); 88484a0bf0SLars-Peter Clausen } 89484a0bf0SLars-Peter Clausen 9057a1228aSLars-Peter Clausen switch (size) { 9157a1228aSLars-Peter Clausen case 4: 92484a0bf0SLars-Peter Clausen adis->tx[8] = ADIS_WRITE_REG(reg + 3); 93484a0bf0SLars-Peter Clausen adis->tx[9] = (value >> 24) & 0xff; 94484a0bf0SLars-Peter Clausen adis->tx[6] = ADIS_WRITE_REG(reg + 2); 95484a0bf0SLars-Peter Clausen adis->tx[7] = (value >> 16) & 0xff; 96df561f66SGustavo A. R. Silva fallthrough; 9757a1228aSLars-Peter Clausen case 2: 98484a0bf0SLars-Peter Clausen adis->tx[4] = ADIS_WRITE_REG(reg + 1); 99484a0bf0SLars-Peter Clausen adis->tx[5] = (value >> 8) & 0xff; 100df561f66SGustavo A. R. Silva fallthrough; 10157a1228aSLars-Peter Clausen case 1: 102484a0bf0SLars-Peter Clausen adis->tx[2] = ADIS_WRITE_REG(reg); 103484a0bf0SLars-Peter Clausen adis->tx[3] = value & 0xff; 10457a1228aSLars-Peter Clausen break; 10557a1228aSLars-Peter Clausen default: 106770d4656SAlexandru Ardelean return -EINVAL; 10757a1228aSLars-Peter Clausen } 10857a1228aSLars-Peter Clausen 109484a0bf0SLars-Peter Clausen xfers[size].cs_change = 0; 11057a1228aSLars-Peter Clausen 111484a0bf0SLars-Peter Clausen for (i = 1; i <= size; i++) 11257a1228aSLars-Peter Clausen spi_message_add_tail(&xfers[i], &msg); 11357a1228aSLars-Peter Clausen 114ec04cb04SLars-Peter Clausen ret = spi_sync(adis->spi, &msg); 11557a1228aSLars-Peter Clausen if (ret) { 11657a1228aSLars-Peter Clausen dev_err(&adis->spi->dev, "Failed to write register 0x%02X: %d\n", 11757a1228aSLars-Peter Clausen reg, ret); 118484a0bf0SLars-Peter Clausen } else { 119484a0bf0SLars-Peter Clausen adis->current_page = page; 12057a1228aSLars-Peter Clausen } 12157a1228aSLars-Peter Clausen 122ec04cb04SLars-Peter Clausen return ret; 123ec04cb04SLars-Peter Clausen } 124*6c9304d6SJonathan Cameron EXPORT_SYMBOL_NS_GPL(__adis_write_reg, IIO_ADISLIB); 125ec04cb04SLars-Peter Clausen 126ec04cb04SLars-Peter Clausen /** 127770d4656SAlexandru Ardelean * __adis_read_reg() - read N bytes from register (unlocked version) 128ec04cb04SLars-Peter Clausen * @adis: The adis device 129ec04cb04SLars-Peter Clausen * @reg: The address of the lower of the two registers 130ec04cb04SLars-Peter Clausen * @val: The value read back from the device 131770d4656SAlexandru Ardelean * @size: The size of the @val buffer 132ec04cb04SLars-Peter Clausen */ 133c39010eaSNuno Sá int __adis_read_reg(struct adis *adis, unsigned int reg, unsigned int *val, 134c39010eaSNuno Sá unsigned int size) 135ec04cb04SLars-Peter Clausen { 136484a0bf0SLars-Peter Clausen unsigned int page = reg / ADIS_PAGE_SIZE; 137ec04cb04SLars-Peter Clausen struct spi_message msg; 138ec04cb04SLars-Peter Clausen int ret; 139ec04cb04SLars-Peter Clausen struct spi_transfer xfers[] = { 140ec04cb04SLars-Peter Clausen { 141ec04cb04SLars-Peter Clausen .tx_buf = adis->tx, 142ec04cb04SLars-Peter Clausen .bits_per_word = 8, 143ec04cb04SLars-Peter Clausen .len = 2, 144ec04cb04SLars-Peter Clausen .cs_change = 1, 145a4e6f40cSAlexandru Ardelean .delay.value = adis->data->write_delay, 146a4e6f40cSAlexandru Ardelean .delay.unit = SPI_DELAY_UNIT_USECS, 147329f0dacSAlexandru Ardelean .cs_change_delay.value = adis->data->cs_change_delay, 148329f0dacSAlexandru Ardelean .cs_change_delay.unit = SPI_DELAY_UNIT_USECS, 149ec04cb04SLars-Peter Clausen }, { 15057a1228aSLars-Peter Clausen .tx_buf = adis->tx + 2, 151484a0bf0SLars-Peter Clausen .bits_per_word = 8, 152484a0bf0SLars-Peter Clausen .len = 2, 153484a0bf0SLars-Peter Clausen .cs_change = 1, 154a4e6f40cSAlexandru Ardelean .delay.value = adis->data->read_delay, 155a4e6f40cSAlexandru Ardelean .delay.unit = SPI_DELAY_UNIT_USECS, 156329f0dacSAlexandru Ardelean .cs_change_delay.value = adis->data->cs_change_delay, 157329f0dacSAlexandru Ardelean .cs_change_delay.unit = SPI_DELAY_UNIT_USECS, 158484a0bf0SLars-Peter Clausen }, { 159484a0bf0SLars-Peter Clausen .tx_buf = adis->tx + 4, 160ec04cb04SLars-Peter Clausen .rx_buf = adis->rx, 161ec04cb04SLars-Peter Clausen .bits_per_word = 8, 162ec04cb04SLars-Peter Clausen .len = 2, 16357a1228aSLars-Peter Clausen .cs_change = 1, 164a4e6f40cSAlexandru Ardelean .delay.value = adis->data->read_delay, 165a4e6f40cSAlexandru Ardelean .delay.unit = SPI_DELAY_UNIT_USECS, 166329f0dacSAlexandru Ardelean .cs_change_delay.value = adis->data->cs_change_delay, 167329f0dacSAlexandru Ardelean .cs_change_delay.unit = SPI_DELAY_UNIT_USECS, 16857a1228aSLars-Peter Clausen }, { 16957a1228aSLars-Peter Clausen .rx_buf = adis->rx + 2, 17057a1228aSLars-Peter Clausen .bits_per_word = 8, 17157a1228aSLars-Peter Clausen .len = 2, 172a4e6f40cSAlexandru Ardelean .delay.value = adis->data->read_delay, 173a4e6f40cSAlexandru Ardelean .delay.unit = SPI_DELAY_UNIT_USECS, 174ec04cb04SLars-Peter Clausen }, 175ec04cb04SLars-Peter Clausen }; 176ec04cb04SLars-Peter Clausen 177ec04cb04SLars-Peter Clausen spi_message_init(&msg); 17857a1228aSLars-Peter Clausen 179484a0bf0SLars-Peter Clausen if (adis->current_page != page) { 180484a0bf0SLars-Peter Clausen adis->tx[0] = ADIS_WRITE_REG(ADIS_REG_PAGE_ID); 181484a0bf0SLars-Peter Clausen adis->tx[1] = page; 182484a0bf0SLars-Peter Clausen spi_message_add_tail(&xfers[0], &msg); 183484a0bf0SLars-Peter Clausen } 184484a0bf0SLars-Peter Clausen 18557a1228aSLars-Peter Clausen switch (size) { 18657a1228aSLars-Peter Clausen case 4: 187484a0bf0SLars-Peter Clausen adis->tx[2] = ADIS_READ_REG(reg + 2); 18857a1228aSLars-Peter Clausen adis->tx[3] = 0; 189ec04cb04SLars-Peter Clausen spi_message_add_tail(&xfers[1], &msg); 190df561f66SGustavo A. R. Silva fallthrough; 191484a0bf0SLars-Peter Clausen case 2: 192484a0bf0SLars-Peter Clausen adis->tx[4] = ADIS_READ_REG(reg); 193484a0bf0SLars-Peter Clausen adis->tx[5] = 0; 19457a1228aSLars-Peter Clausen spi_message_add_tail(&xfers[2], &msg); 195484a0bf0SLars-Peter Clausen spi_message_add_tail(&xfers[3], &msg); 19657a1228aSLars-Peter Clausen break; 19757a1228aSLars-Peter Clausen default: 198770d4656SAlexandru Ardelean return -EINVAL; 19957a1228aSLars-Peter Clausen } 20057a1228aSLars-Peter Clausen 201ec04cb04SLars-Peter Clausen ret = spi_sync(adis->spi, &msg); 202ec04cb04SLars-Peter Clausen if (ret) { 20357a1228aSLars-Peter Clausen dev_err(&adis->spi->dev, "Failed to read register 0x%02X: %d\n", 204ec04cb04SLars-Peter Clausen reg, ret); 205770d4656SAlexandru Ardelean return ret; 206ec04cb04SLars-Peter Clausen } 207ec04cb04SLars-Peter Clausen 208c39010eaSNuno Sá adis->current_page = page; 209c39010eaSNuno Sá 21057a1228aSLars-Peter Clausen switch (size) { 21157a1228aSLars-Peter Clausen case 4: 21257a1228aSLars-Peter Clausen *val = get_unaligned_be32(adis->rx); 21357a1228aSLars-Peter Clausen break; 21457a1228aSLars-Peter Clausen case 2: 21557a1228aSLars-Peter Clausen *val = get_unaligned_be16(adis->rx + 2); 21657a1228aSLars-Peter Clausen break; 21757a1228aSLars-Peter Clausen } 21857a1228aSLars-Peter Clausen 219ec04cb04SLars-Peter Clausen return ret; 220ec04cb04SLars-Peter Clausen } 221*6c9304d6SJonathan Cameron EXPORT_SYMBOL_NS_GPL(__adis_read_reg, IIO_ADISLIB); 222b9c5eec7SNuno Sá /** 223b9c5eec7SNuno Sá * __adis_update_bits_base() - ADIS Update bits function - Unlocked version 224b9c5eec7SNuno Sá * @adis: The adis device 225b9c5eec7SNuno Sá * @reg: The address of the lower of the two registers 226b9c5eec7SNuno Sá * @mask: Bitmask to change 227b9c5eec7SNuno Sá * @val: Value to be written 228b9c5eec7SNuno Sá * @size: Size of the register to update 229b9c5eec7SNuno Sá * 230b9c5eec7SNuno Sá * Updates the desired bits of @reg in accordance with @mask and @val. 231b9c5eec7SNuno Sá */ 232b9c5eec7SNuno Sá int __adis_update_bits_base(struct adis *adis, unsigned int reg, const u32 mask, 233b9c5eec7SNuno Sá const u32 val, u8 size) 234b9c5eec7SNuno Sá { 235b9c5eec7SNuno Sá int ret; 236b9c5eec7SNuno Sá u32 __val; 237b9c5eec7SNuno Sá 238b9c5eec7SNuno Sá ret = __adis_read_reg(adis, reg, &__val, size); 239b9c5eec7SNuno Sá if (ret) 240b9c5eec7SNuno Sá return ret; 241b9c5eec7SNuno Sá 242b9c5eec7SNuno Sá __val = (__val & ~mask) | (val & mask); 243b9c5eec7SNuno Sá 244b9c5eec7SNuno Sá return __adis_write_reg(adis, reg, __val, size); 245b9c5eec7SNuno Sá } 246*6c9304d6SJonathan Cameron EXPORT_SYMBOL_NS_GPL(__adis_update_bits_base, IIO_ADISLIB); 247ec04cb04SLars-Peter Clausen 24878026a6fSLars-Peter Clausen #ifdef CONFIG_DEBUG_FS 24978026a6fSLars-Peter Clausen 250c39010eaSNuno Sá int adis_debugfs_reg_access(struct iio_dev *indio_dev, unsigned int reg, 251c39010eaSNuno Sá unsigned int writeval, unsigned int *readval) 25278026a6fSLars-Peter Clausen { 25378026a6fSLars-Peter Clausen struct adis *adis = iio_device_get_drvdata(indio_dev); 25478026a6fSLars-Peter Clausen 25578026a6fSLars-Peter Clausen if (readval) { 256c39010eaSNuno Sá u16 val16; 25778026a6fSLars-Peter Clausen int ret; 25878026a6fSLars-Peter Clausen 25978026a6fSLars-Peter Clausen ret = adis_read_reg_16(adis, reg, &val16); 26038262c01SAlexandru Ardelean if (ret == 0) 26178026a6fSLars-Peter Clausen *readval = val16; 26278026a6fSLars-Peter Clausen 26378026a6fSLars-Peter Clausen return ret; 26478026a6fSLars-Peter Clausen } 265c39010eaSNuno Sá 266c39010eaSNuno Sá return adis_write_reg_16(adis, reg, writeval); 26778026a6fSLars-Peter Clausen } 268*6c9304d6SJonathan Cameron EXPORT_SYMBOL_NS(adis_debugfs_reg_access, IIO_ADISLIB); 26978026a6fSLars-Peter Clausen 27078026a6fSLars-Peter Clausen #endif 27178026a6fSLars-Peter Clausen 272ec04cb04SLars-Peter Clausen /** 273ec04cb04SLars-Peter Clausen * adis_enable_irq() - Enable or disable data ready IRQ 274ec04cb04SLars-Peter Clausen * @adis: The adis device 275ec04cb04SLars-Peter Clausen * @enable: Whether to enable the IRQ 276ec04cb04SLars-Peter Clausen * 277ec04cb04SLars-Peter Clausen * Returns 0 on success, negative error code otherwise 278ec04cb04SLars-Peter Clausen */ 279ec04cb04SLars-Peter Clausen int adis_enable_irq(struct adis *adis, bool enable) 280ec04cb04SLars-Peter Clausen { 281ec04cb04SLars-Peter Clausen int ret = 0; 282c39010eaSNuno Sá u16 msc; 283ec04cb04SLars-Peter Clausen 284100bfa38SAlexandru Ardelean mutex_lock(&adis->state_lock); 2852f3abe6cSLars-Peter Clausen 286100bfa38SAlexandru Ardelean if (adis->data->enable_irq) { 287100bfa38SAlexandru Ardelean ret = adis->data->enable_irq(adis, enable); 288100bfa38SAlexandru Ardelean goto out_unlock; 289c39010eaSNuno Sá } 290c39010eaSNuno Sá 291c39010eaSNuno Sá if (adis->data->unmasked_drdy) { 29231fa357aSNuno Sá if (enable) 29331fa357aSNuno Sá enable_irq(adis->spi->irq); 29431fa357aSNuno Sá else 29531fa357aSNuno Sá disable_irq(adis->spi->irq); 29631fa357aSNuno Sá 29731fa357aSNuno Sá goto out_unlock; 298100bfa38SAlexandru Ardelean } 299100bfa38SAlexandru Ardelean 300100bfa38SAlexandru Ardelean ret = __adis_read_reg_16(adis, adis->data->msc_ctrl_reg, &msc); 301ec04cb04SLars-Peter Clausen if (ret) 302100bfa38SAlexandru Ardelean goto out_unlock; 303ec04cb04SLars-Peter Clausen 304ec04cb04SLars-Peter Clausen msc |= ADIS_MSC_CTRL_DATA_RDY_POL_HIGH; 305ec04cb04SLars-Peter Clausen msc &= ~ADIS_MSC_CTRL_DATA_RDY_DIO2; 306ec04cb04SLars-Peter Clausen if (enable) 307ec04cb04SLars-Peter Clausen msc |= ADIS_MSC_CTRL_DATA_RDY_EN; 308ec04cb04SLars-Peter Clausen else 309ec04cb04SLars-Peter Clausen msc &= ~ADIS_MSC_CTRL_DATA_RDY_EN; 310ec04cb04SLars-Peter Clausen 311100bfa38SAlexandru Ardelean ret = __adis_write_reg_16(adis, adis->data->msc_ctrl_reg, msc); 312ec04cb04SLars-Peter Clausen 313100bfa38SAlexandru Ardelean out_unlock: 314100bfa38SAlexandru Ardelean mutex_unlock(&adis->state_lock); 315ec04cb04SLars-Peter Clausen return ret; 316ec04cb04SLars-Peter Clausen } 317*6c9304d6SJonathan Cameron EXPORT_SYMBOL_NS(adis_enable_irq, IIO_ADISLIB); 318ec04cb04SLars-Peter Clausen 319ec04cb04SLars-Peter Clausen /** 3206a4d6a7dSAlexandru Ardelean * __adis_check_status() - Check the device for error conditions (unlocked) 321ec04cb04SLars-Peter Clausen * @adis: The adis device 322ec04cb04SLars-Peter Clausen * 323ec04cb04SLars-Peter Clausen * Returns 0 on success, a negative error code otherwise 324ec04cb04SLars-Peter Clausen */ 3256a4d6a7dSAlexandru Ardelean int __adis_check_status(struct adis *adis) 326ec04cb04SLars-Peter Clausen { 327c39010eaSNuno Sá u16 status; 328ec04cb04SLars-Peter Clausen int ret; 329ec04cb04SLars-Peter Clausen int i; 330ec04cb04SLars-Peter Clausen 3316a4d6a7dSAlexandru Ardelean ret = __adis_read_reg_16(adis, adis->data->diag_stat_reg, &status); 3326a39ab3bSAlexandru Ardelean if (ret) 333ec04cb04SLars-Peter Clausen return ret; 334ec04cb04SLars-Peter Clausen 335ec04cb04SLars-Peter Clausen status &= adis->data->status_error_mask; 336ec04cb04SLars-Peter Clausen 337ec04cb04SLars-Peter Clausen if (status == 0) 338ec04cb04SLars-Peter Clausen return 0; 339ec04cb04SLars-Peter Clausen 340ec04cb04SLars-Peter Clausen for (i = 0; i < 16; ++i) { 341ec04cb04SLars-Peter Clausen if (status & BIT(i)) { 342ec04cb04SLars-Peter Clausen dev_err(&adis->spi->dev, "%s.\n", 343ec04cb04SLars-Peter Clausen adis->data->status_error_msgs[i]); 344ec04cb04SLars-Peter Clausen } 345ec04cb04SLars-Peter Clausen } 346ec04cb04SLars-Peter Clausen 347ec04cb04SLars-Peter Clausen return -EIO; 348ec04cb04SLars-Peter Clausen } 349*6c9304d6SJonathan Cameron EXPORT_SYMBOL_NS_GPL(__adis_check_status, IIO_ADISLIB); 350ec04cb04SLars-Peter Clausen 351ec04cb04SLars-Peter Clausen /** 352762ab093SAlexandru Ardelean * __adis_reset() - Reset the device (unlocked version) 353ec04cb04SLars-Peter Clausen * @adis: The adis device 354ec04cb04SLars-Peter Clausen * 355ec04cb04SLars-Peter Clausen * Returns 0 on success, a negative error code otherwise 356ec04cb04SLars-Peter Clausen */ 357762ab093SAlexandru Ardelean int __adis_reset(struct adis *adis) 358ec04cb04SLars-Peter Clausen { 359ec04cb04SLars-Peter Clausen int ret; 360380b107bSNuno Sá const struct adis_timeout *timeouts = adis->data->timeouts; 361ec04cb04SLars-Peter Clausen 362762ab093SAlexandru Ardelean ret = __adis_write_reg_8(adis, adis->data->glob_cmd_reg, 363ec04cb04SLars-Peter Clausen ADIS_GLOB_CMD_SW_RESET); 364380b107bSNuno Sá if (ret) { 365ec04cb04SLars-Peter Clausen dev_err(&adis->spi->dev, "Failed to reset device: %d\n", ret); 366ec04cb04SLars-Peter Clausen return ret; 367ec04cb04SLars-Peter Clausen } 368380b107bSNuno Sá 369380b107bSNuno Sá msleep(timeouts->sw_reset_ms); 370380b107bSNuno Sá 371380b107bSNuno Sá return 0; 372380b107bSNuno Sá } 373*6c9304d6SJonathan Cameron EXPORT_SYMBOL_NS_GPL(__adis_reset, IIO_ADIS_LIB); 374ec04cb04SLars-Peter Clausen 375ec04cb04SLars-Peter Clausen static int adis_self_test(struct adis *adis) 376ec04cb04SLars-Peter Clausen { 377ec04cb04SLars-Peter Clausen int ret; 378380b107bSNuno Sá const struct adis_timeout *timeouts = adis->data->timeouts; 379ec04cb04SLars-Peter Clausen 380fdcf6bbbSNuno Sá ret = __adis_write_reg_16(adis, adis->data->self_test_reg, 381ec04cb04SLars-Peter Clausen adis->data->self_test_mask); 382ec04cb04SLars-Peter Clausen if (ret) { 383ec04cb04SLars-Peter Clausen dev_err(&adis->spi->dev, "Failed to initiate self test: %d\n", 384ec04cb04SLars-Peter Clausen ret); 385ec04cb04SLars-Peter Clausen return ret; 386ec04cb04SLars-Peter Clausen } 387ec04cb04SLars-Peter Clausen 388380b107bSNuno Sá msleep(timeouts->self_test_ms); 389ec04cb04SLars-Peter Clausen 390cb5a07f1SAlexandru Ardelean ret = __adis_check_status(adis); 391af8a4127SLars-Peter Clausen 392af8a4127SLars-Peter Clausen if (adis->data->self_test_no_autoclear) 393fdcf6bbbSNuno Sá __adis_write_reg_16(adis, adis->data->self_test_reg, 0x00); 394af8a4127SLars-Peter Clausen 395af8a4127SLars-Peter Clausen return ret; 396ec04cb04SLars-Peter Clausen } 397ec04cb04SLars-Peter Clausen 398ec04cb04SLars-Peter Clausen /** 3993f17ada8SAlexandru Ardelean * __adis_initial_startup() - Device initial setup 400ec04cb04SLars-Peter Clausen * @adis: The adis device 401ec04cb04SLars-Peter Clausen * 402ecb010d4SNuno Sá * The function performs a HW reset via a reset pin that should be specified 403ecb010d4SNuno Sá * via GPIOLIB. If no pin is configured a SW reset will be performed. 404ecb010d4SNuno Sá * The RST pin for the ADIS devices should be configured as ACTIVE_LOW. 405ecb010d4SNuno Sá * 4061fd45670SAlexandru Ardelean * After the self-test operation is performed, the function will also check 4071fd45670SAlexandru Ardelean * that the product ID is as expected. This assumes that drivers providing 4081fd45670SAlexandru Ardelean * 'prod_id_reg' will also provide the 'prod_id'. 4091fd45670SAlexandru Ardelean * 410ec04cb04SLars-Peter Clausen * Returns 0 if the device is operational, a negative error code otherwise. 411ec04cb04SLars-Peter Clausen * 412ec04cb04SLars-Peter Clausen * This function should be called early on in the device initialization sequence 413ec04cb04SLars-Peter Clausen * to ensure that the device is in a sane and known state and that it is usable. 414ec04cb04SLars-Peter Clausen */ 4153f17ada8SAlexandru Ardelean int __adis_initial_startup(struct adis *adis) 416ec04cb04SLars-Peter Clausen { 417ecb010d4SNuno Sá const struct adis_timeout *timeouts = adis->data->timeouts; 418ecb010d4SNuno Sá struct gpio_desc *gpio; 419c39010eaSNuno Sá u16 prod_id; 420ec04cb04SLars-Peter Clausen int ret; 421ec04cb04SLars-Peter Clausen 422ecb010d4SNuno Sá /* check if the device has rst pin low */ 4237e77ef8bSAntti Keränen gpio = devm_gpiod_get_optional(&adis->spi->dev, "reset", GPIOD_OUT_HIGH); 424ecb010d4SNuno Sá if (IS_ERR(gpio)) 425ecb010d4SNuno Sá return PTR_ERR(gpio); 426ecb010d4SNuno Sá 427ecb010d4SNuno Sá if (gpio) { 428c39010eaSNuno Sá usleep_range(10, 12); 429ecb010d4SNuno Sá /* bring device out of reset */ 430ecb010d4SNuno Sá gpiod_set_value_cansleep(gpio, 0); 431ecb010d4SNuno Sá msleep(timeouts->reset_ms); 432ecb010d4SNuno Sá } else { 433ecb010d4SNuno Sá ret = __adis_reset(adis); 4343f17ada8SAlexandru Ardelean if (ret) 435ecb010d4SNuno Sá return ret; 436ec04cb04SLars-Peter Clausen } 437ec04cb04SLars-Peter Clausen 4381fd45670SAlexandru Ardelean ret = adis_self_test(adis); 4391fd45670SAlexandru Ardelean if (ret) 4401fd45670SAlexandru Ardelean return ret; 4411fd45670SAlexandru Ardelean 44231fa357aSNuno Sá /* 44331fa357aSNuno Sá * don't bother calling this if we can't unmask the IRQ as in this case 44431fa357aSNuno Sá * the IRQ is most likely not yet requested and we will request it 44531fa357aSNuno Sá * with 'IRQF_NO_AUTOEN' anyways. 44631fa357aSNuno Sá */ 44731fa357aSNuno Sá if (!adis->data->unmasked_drdy) 448b600bd7eSNuno Sá adis_enable_irq(adis, false); 449b600bd7eSNuno Sá 4501fd45670SAlexandru Ardelean if (!adis->data->prod_id_reg) 4511fd45670SAlexandru Ardelean return 0; 4521fd45670SAlexandru Ardelean 4531fd45670SAlexandru Ardelean ret = adis_read_reg_16(adis, adis->data->prod_id_reg, &prod_id); 4541fd45670SAlexandru Ardelean if (ret) 4551fd45670SAlexandru Ardelean return ret; 4561fd45670SAlexandru Ardelean 4571fd45670SAlexandru Ardelean if (prod_id != adis->data->prod_id) 4581fd45670SAlexandru Ardelean dev_warn(&adis->spi->dev, 45997f1755eSChristophe JAILLET "Device ID(%u) and product ID(%u) do not match.\n", 4601fd45670SAlexandru Ardelean adis->data->prod_id, prod_id); 4611fd45670SAlexandru Ardelean 4621fd45670SAlexandru Ardelean return 0; 463ec04cb04SLars-Peter Clausen } 464*6c9304d6SJonathan Cameron EXPORT_SYMBOL_NS_GPL(__adis_initial_startup, IIO_ADISLIB); 465ec04cb04SLars-Peter Clausen 466ec04cb04SLars-Peter Clausen /** 467ec04cb04SLars-Peter Clausen * adis_single_conversion() - Performs a single sample conversion 468ec04cb04SLars-Peter Clausen * @indio_dev: The IIO device 469ec04cb04SLars-Peter Clausen * @chan: The IIO channel 470ec04cb04SLars-Peter Clausen * @error_mask: Mask for the error bit 471ec04cb04SLars-Peter Clausen * @val: Result of the conversion 472ec04cb04SLars-Peter Clausen * 473ec04cb04SLars-Peter Clausen * Returns IIO_VAL_INT on success, a negative error code otherwise. 474ec04cb04SLars-Peter Clausen * 475ec04cb04SLars-Peter Clausen * The function performs a single conversion on a given channel and post 476ec04cb04SLars-Peter Clausen * processes the value accordingly to the channel spec. If a error_mask is given 477ec04cb04SLars-Peter Clausen * the function will check if the mask is set in the returned raw value. If it 478ec04cb04SLars-Peter Clausen * is set the function will perform a self-check. If the device does not report 479ec04cb04SLars-Peter Clausen * a error bit in the channels raw value set error_mask to 0. 480ec04cb04SLars-Peter Clausen */ 481ec04cb04SLars-Peter Clausen int adis_single_conversion(struct iio_dev *indio_dev, 482c39010eaSNuno Sá const struct iio_chan_spec *chan, 483c39010eaSNuno Sá unsigned int error_mask, int *val) 484ec04cb04SLars-Peter Clausen { 485ec04cb04SLars-Peter Clausen struct adis *adis = iio_device_get_drvdata(indio_dev); 48657a1228aSLars-Peter Clausen unsigned int uval; 487ec04cb04SLars-Peter Clausen int ret; 488ec04cb04SLars-Peter Clausen 489c5485a5dSAlexandru Ardelean mutex_lock(&adis->state_lock); 490ec04cb04SLars-Peter Clausen 491c5485a5dSAlexandru Ardelean ret = __adis_read_reg(adis, chan->address, &uval, 49257a1228aSLars-Peter Clausen chan->scan_type.storagebits / 8); 493ec04cb04SLars-Peter Clausen if (ret) 494ec04cb04SLars-Peter Clausen goto err_unlock; 495ec04cb04SLars-Peter Clausen 49657a1228aSLars-Peter Clausen if (uval & error_mask) { 497c5485a5dSAlexandru Ardelean ret = __adis_check_status(adis); 498ec04cb04SLars-Peter Clausen if (ret) 499ec04cb04SLars-Peter Clausen goto err_unlock; 500ec04cb04SLars-Peter Clausen } 501ec04cb04SLars-Peter Clausen 502ec04cb04SLars-Peter Clausen if (chan->scan_type.sign == 's') 50357a1228aSLars-Peter Clausen *val = sign_extend32(uval, chan->scan_type.realbits - 1); 504ec04cb04SLars-Peter Clausen else 50557a1228aSLars-Peter Clausen *val = uval & ((1 << chan->scan_type.realbits) - 1); 506ec04cb04SLars-Peter Clausen 507ec04cb04SLars-Peter Clausen ret = IIO_VAL_INT; 508ec04cb04SLars-Peter Clausen err_unlock: 509c5485a5dSAlexandru Ardelean mutex_unlock(&adis->state_lock); 510ec04cb04SLars-Peter Clausen return ret; 511ec04cb04SLars-Peter Clausen } 512*6c9304d6SJonathan Cameron EXPORT_SYMBOL_NS_GPL(adis_single_conversion, IIO_ADISLIB); 513ec04cb04SLars-Peter Clausen 514ec04cb04SLars-Peter Clausen /** 515ec04cb04SLars-Peter Clausen * adis_init() - Initialize adis device structure 516ec04cb04SLars-Peter Clausen * @adis: The adis device 517ec04cb04SLars-Peter Clausen * @indio_dev: The iio device 518ec04cb04SLars-Peter Clausen * @spi: The spi device 519ec04cb04SLars-Peter Clausen * @data: Chip specific data 520ec04cb04SLars-Peter Clausen * 521ec04cb04SLars-Peter Clausen * Returns 0 on success, a negative error code otherwise. 522ec04cb04SLars-Peter Clausen * 523ec04cb04SLars-Peter Clausen * This function must be called, before any other adis helper function may be 524ec04cb04SLars-Peter Clausen * called. 525ec04cb04SLars-Peter Clausen */ 526ec04cb04SLars-Peter Clausen int adis_init(struct adis *adis, struct iio_dev *indio_dev, 527ec04cb04SLars-Peter Clausen struct spi_device *spi, const struct adis_data *data) 528ec04cb04SLars-Peter Clausen { 529380b107bSNuno Sá if (!data || !data->timeouts) { 530380b107bSNuno Sá dev_err(&spi->dev, "No config data or timeouts not defined!\n"); 531380b107bSNuno Sá return -EINVAL; 532380b107bSNuno Sá } 533380b107bSNuno Sá 5346a9afcb1SAlexandru Ardelean mutex_init(&adis->state_lock); 535ec04cb04SLars-Peter Clausen adis->spi = spi; 536ec04cb04SLars-Peter Clausen adis->data = data; 537ec04cb04SLars-Peter Clausen iio_device_set_drvdata(indio_dev, adis); 538ec04cb04SLars-Peter Clausen 539484a0bf0SLars-Peter Clausen if (data->has_paging) { 540484a0bf0SLars-Peter Clausen /* Need to set the page before first read/write */ 541484a0bf0SLars-Peter Clausen adis->current_page = -1; 542484a0bf0SLars-Peter Clausen } else { 543484a0bf0SLars-Peter Clausen /* Page will always be 0 */ 544484a0bf0SLars-Peter Clausen adis->current_page = 0; 545484a0bf0SLars-Peter Clausen } 546484a0bf0SLars-Peter Clausen 547b600bd7eSNuno Sá return 0; 548ec04cb04SLars-Peter Clausen } 549*6c9304d6SJonathan Cameron EXPORT_SYMBOL_NS_GPL(adis_init, IIO_ADISLIB); 550ec04cb04SLars-Peter Clausen 551ec04cb04SLars-Peter Clausen MODULE_LICENSE("GPL"); 552ec04cb04SLars-Peter Clausen MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>"); 553ec04cb04SLars-Peter Clausen MODULE_DESCRIPTION("Common library code for ADIS16XXX devices"); 554