iio: gyro: st_gyro_spi: add OF capability to st_gyro_spi

Add device tree support for L3G4200D, LSM330D, LSM330DL, LSM330DLC,
L3GD20, L3GD20H, L3G4IS, LSM330, LSM9DS0 gyroscope sensors

Signed-off-by: Lorenzo Bianconi <lorenzo.bianconi@st.com>
Reviewed-by: Linus Walleij <linus.walleij@linaro.org>
Signed-off-by: Jonathan Cameron <jic23@kernel.org>

diff --git a/drivers/iio/gyro/st_gyro_spi.c b/drivers/iio/gyro/st_gyro_spi.c
index fa14d8f2170d71018ab47e6ae7bfcaad303b3486..0b52ed577dc21c26b8b40de9d82ff4e1448418ee 100644 (file)
--- a/drivers/iio/gyro/st_gyro_spi.c
+++ b/drivers/iio/gyro/st_gyro_spi.c
@@ -18,6 +18,56 @@
 #include <linux/iio/common/st_sensors_spi.h>
 #include "st_gyro.h"
 
+#ifdef CONFIG_OF
+/*
+ * For new single-chip sensors use <device_name> as compatible string.
+ * For old single-chip devices keep <device_name>-gyro to maintain
+ * compatibility
+ */
+static const struct of_device_id st_gyro_of_match[] = {
+       {
+               .compatible = "st,l3g4200d-gyro",
+               .data = L3G4200D_GYRO_DEV_NAME,
+       },
+       {
+               .compatible = "st,lsm330d-gyro",
+               .data = LSM330D_GYRO_DEV_NAME,
+       },
+       {
+               .compatible = "st,lsm330dl-gyro",
+               .data = LSM330DL_GYRO_DEV_NAME,
+       },
+       {
+               .compatible = "st,lsm330dlc-gyro",
+               .data = LSM330DLC_GYRO_DEV_NAME,
+       },
+       {
+               .compatible = "st,l3gd20-gyro",
+               .data = L3GD20_GYRO_DEV_NAME,
+       },
+       {
+               .compatible = "st,l3gd20h-gyro",
+               .data = L3GD20H_GYRO_DEV_NAME,
+       },
+       {
+               .compatible = "st,l3g4is-gyro",
+               .data = L3G4IS_GYRO_DEV_NAME,
+       },
+       {
+               .compatible = "st,lsm330-gyro",
+               .data = LSM330_GYRO_DEV_NAME,
+       },
+       {
+               .compatible = "st,lsm9ds0-gyro",
+               .data = LSM9DS0_GYRO_DEV_NAME,
+       },
+       {},
+};
+MODULE_DEVICE_TABLE(of, st_gyro_of_match);
+#else
+#define st_gyro_of_match       NULL
+#endif
+
 static int st_gyro_spi_probe(struct spi_device *spi)
 {
        struct iio_dev *indio_dev;
@@ -30,6 +80,8 @@ static int st_gyro_spi_probe(struct spi_device *spi)
 
        gdata = iio_priv(indio_dev);
 
+       st_sensors_of_name_probe(&spi->dev, st_gyro_of_match,
+                                spi->modalias, sizeof(spi->modalias));
        st_sensors_spi_configure(indio_dev, spi, gdata);
 
        err = st_gyro_common_probe(indio_dev);
@@ -63,6 +115,7 @@ MODULE_DEVICE_TABLE(spi, st_gyro_id_table);
 static struct spi_driver st_gyro_driver = {
        .driver = {
                .name = "st-gyro-spi",
+               .of_match_table = of_match_ptr(st_gyro_of_match),
        },
        .probe = st_gyro_spi_probe,
        .remove = st_gyro_spi_remove,