iio: imu: bmi160: added mount-matrix support

Add mount-matrix binding support. As chip could have different orientations
a mount matrix support is needed to correctly translate these differences.

Signed-off-by: Jonathan Albrieux <jonathan.albrieux@gmail.com>
Signed-off-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>

diff --git a/drivers/iio/imu/bmi160/bmi160.h b/drivers/iio/imu/bmi160/bmi160.h
index 923c3b274fde9b8cf0a6559828ac979d34000050..a82e040bd10983350ec3bdeaf42163dbcd24da89 100644 (file)
--- a/drivers/iio/imu/bmi160/bmi160.h
+++ b/drivers/iio/imu/bmi160/bmi160.h
@@ -9,6 +9,7 @@ struct bmi160_data {
        struct regmap *regmap;
        struct iio_trigger *trig;
        struct regulator_bulk_data supplies[2];
+       struct iio_mount_matrix orientation;
 };
 
 extern const struct regmap_config bmi160_regmap_config;

diff --git a/drivers/iio/imu/bmi160/bmi160_core.c b/drivers/iio/imu/bmi160/bmi160_core.c
index d3316ca02fbd9612eb7cf905a283ad997a948f01..26d586daee26f3623377c46d645c94902cdeb624 100644 (file)
--- a/drivers/iio/imu/bmi160/bmi160_core.c
+++ b/drivers/iio/imu/bmi160/bmi160_core.c
@@ -110,6 +110,7 @@
                .storagebits = 16,                              \
                .endianness = IIO_LE,                           \
        },                                                      \
+       .ext_info = bmi160_ext_info,                            \
 }
 
 /* scan indexes follow DATA register order */
@@ -265,6 +266,20 @@ static const struct  bmi160_odr_item bmi160_odr_table[] = {
        },
 };
 
+static const struct iio_mount_matrix *
+bmi160_get_mount_matrix(const struct iio_dev *indio_dev,
+                       const struct iio_chan_spec *chan)
+{
+       struct bmi160_data *data = iio_priv(indio_dev);
+
+       return &data->orientation;
+}
+
+static const struct iio_chan_spec_ext_info bmi160_ext_info[] = {
+       IIO_MOUNT_MATRIX(IIO_SHARED_BY_DIR, bmi160_get_mount_matrix),
+       { }
+};
+
 static const struct iio_chan_spec bmi160_channels[] = {
        BMI160_CHANNEL(IIO_ACCEL, X, BMI160_SCAN_ACCEL_X),
        BMI160_CHANNEL(IIO_ACCEL, Y, BMI160_SCAN_ACCEL_Y),
@@ -839,6 +854,11 @@ int bmi160_core_probe(struct device *dev, struct regmap *regmap,
                return ret;
        }
 
+       ret = iio_read_mount_matrix(dev, "mount-matrix",
+                                   &data->orientation);
+       if (ret)
+               return ret;
+
        ret = bmi160_chip_init(data, use_spi);
        if (ret)
                return ret;