1 files changed, 23 insertions, 0 deletions

diff --git a/drivers/iio/magnetometer/st_magn_i2c.c b/drivers/iio/magnetometer/st_magn_i2c.c
index 892e0feeb5c1..689250058442 100644
--- a/drivers/iio/magnetometer/st_magn_i2c.c
+++ b/drivers/iio/magnetometer/st_magn_i2c.c
@@ -18,6 +18,27 @@
 #include <linux/iio/common/st_sensors_i2c.h>
 #include "st_magn.h"
 
+#ifdef CONFIG_OF
+static const struct of_device_id st_magn_of_match[] = {
+        {
+                .compatible = "st,lsm303dlhc-magn",
+                .data = LSM303DLHC_MAGN_DEV_NAME,
+        },
+        {
+                .compatible = "st,lsm303dlm-magn",
+                .data = LSM303DLM_MAGN_DEV_NAME,
+        },
+        {
+                .compatible = "st,lis3mdl-magn",
+                .data = LIS3MDL_MAGN_DEV_NAME,
+        },
+        {},
+};
+MODULE_DEVICE_TABLE(of, st_magn_of_match);
+#else
+#define st_magn_of_match NULL
+#endif
+
 static int st_magn_i2c_probe(struct i2c_client *client,
                                                 const struct i2c_device_id *id)
 {
@@ -31,6 +52,7 @@ static int st_magn_i2c_probe(struct i2c_client *client,
 
         mdata = iio_priv(indio_dev);
         mdata->dev = &client->dev;
+        st_sensors_of_i2c_probe(client, st_magn_of_match);
 
         st_sensors_i2c_configure(indio_dev, client, mdata);
 
@@ -61,6 +83,7 @@ static struct i2c_driver st_magn_driver = {
         .driver = {
                 .owner = THIS_MODULE,
                 .name = "st-magn-i2c",
+                .of_match_table = of_match_ptr(st_magn_of_match),
         },
         .probe = st_magn_i2c_probe,
         .remove = st_magn_i2c_remove,