iio:imu:adis: Add debugfs register access support

Provide a IIO debugfs register access function for the ADIS library. This
function can be used by individual drivers to allow raw register access via
debugfs.

Signed-off-by: Lars-Peter Clausen <lars@metafoo.de>
Signed-off-by: Jonathan Cameron <jic23@kernel.org>

diff --git a/drivers/iio/imu/adis.c b/drivers/iio/imu/adis.c
index 8259b774078f98babfdf0195c2a97042058ce960..28d4df2fe76a4cf917c16f7b87c9d54b6b63bc06 100644 (file)
--- a/drivers/iio/imu/adis.c
+++ b/drivers/iio/imu/adis.c
@@ -135,6 +135,29 @@ error_ret:
 }
 EXPORT_SYMBOL_GPL(adis_read_reg_16);
 
+#ifdef CONFIG_DEBUG_FS
+
+int adis_debugfs_reg_access(struct iio_dev *indio_dev,
+       unsigned int reg, unsigned int writeval, unsigned int *readval)
+{
+       struct adis *adis = iio_device_get_drvdata(indio_dev);
+
+       if (readval) {
+               uint16_t val16;
+               int ret;
+
+               ret = adis_read_reg_16(adis, reg, &val16);
+               *readval = val16;
+
+               return ret;
+       } else {
+               return adis_write_reg_16(adis, reg, writeval);
+       }
+}
+EXPORT_SYMBOL(adis_debugfs_reg_access);
+
+#endif
+
 /**
  * adis_enable_irq() - Enable or disable data ready IRQ
  * @adis: The adis device

diff --git a/include/linux/iio/imu/adis.h b/include/linux/iio/imu/adis.h
index 8c3304d44b978d1ecb3c73f4740be867c2c1aba0..fce7bc3ba0b50e30cf2b791adb48a321da491e64 100644 (file)
--- a/include/linux/iio/imu/adis.h
+++ b/include/linux/iio/imu/adis.h
@@ -183,4 +183,15 @@ static inline void adis_remove_trigger(struct adis *adis)
 
 #endif /* CONFIG_IIO_BUFFER */
 
+#ifdef CONFIG_DEBUG_FS
+
+int adis_debugfs_reg_access(struct iio_dev *indio_dev,
+       unsigned int reg, unsigned int writeval, unsigned int *readval);
+
+#else
+
+#define adis_debugfs_reg_access NULL
+
+#endif
+
 #endif