iio: gyro: adxrs290: Add debugfs register access support

Extend support to read/write byte data from/to the device using
debugfs iio interface.

Signed-off-by: Nishant Malpani <nish.malpani25@gmail.com>
Reviewed-by: Andy Shevchenko <andy.shevchenko@gmail.com>
Link: https://lore.kernel.org/r/20200910180450.29696-4-nish.malpani25@gmail.com
Signed-off-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>

diff --git a/drivers/iio/gyro/adxrs290.c b/drivers/iio/gyro/adxrs290.c
index 41b1f995a143d61d6ac0791b28108493bb602e35..ca6fc234076ee8e1198f65c2aabd3b3cfbe49c85 100644 (file)
--- a/drivers/iio/gyro/adxrs290.c
+++ b/drivers/iio/gyro/adxrs290.c
@@ -436,6 +436,31 @@ static int adxrs290_read_avail(struct iio_dev *indio_dev,
        }
 }
 
+static int adxrs290_reg_access_rw(struct spi_device *spi, unsigned int reg,
+                                 unsigned int *readval)
+{
+       int ret;
+
+       ret = spi_w8r8(spi, ADXRS290_READ_REG(reg));
+       if (ret < 0)
+               return ret;
+
+       *readval = ret;
+
+       return 0;
+}
+
+static int adxrs290_reg_access(struct iio_dev *indio_dev, unsigned int reg,
+                              unsigned int writeval, unsigned int *readval)
+{
+       struct adxrs290_state *st = iio_priv(indio_dev);
+
+       if (readval)
+               return adxrs290_reg_access_rw(st->spi, reg, readval);
+       else
+               return adxrs290_spi_write_reg(st->spi, reg, writeval);
+}
+
 static int adxrs290_data_rdy_trigger_set_state(struct iio_trigger *trig,
                                               bool state)
 {
@@ -551,6 +576,7 @@ static const struct iio_info adxrs290_info = {
        .read_raw = &adxrs290_read_raw,
        .write_raw = &adxrs290_write_raw,
        .read_avail = &adxrs290_read_avail,
+       .debugfs_reg_access = &adxrs290_reg_access,
 };
 
 static int adxrs290_probe_trigger(struct iio_dev *indio_dev)