iio: st_sensors: fix scale configuration for h3lis331dl

fix scale configuration/parsing for h3lis331dl accel driver
when sensitivity is higher than 1(m/s^2)/digit

Signed-off-by: Lorenzo Bianconi <lorenzo.bianconi@st.com>
Fixes: 1e52fefc9b0c ("iio: accel: Add support for the h3lis331dl accelerometer")
Cc: <Stable@vger.kernel.org>
Signed-off-by: Jonathan Cameron <jic23@kernel.org>

1 files changed, 5 insertions, 3 deletions

diff --git a/drivers/iio/common/st_sensors/st_sensors_core.c b/drivers/iio/common/st_sensors/st_sensors_core.c
index 285a64a589d7..975a1f19f747 100644
--- a/drivers/iio/common/st_sensors/st_sensors_core.c
+++ b/drivers/iio/common/st_sensors/st_sensors_core.c
@@ -612,7 +612,7 @@ EXPORT_SYMBOL(st_sensors_sysfs_sampling_frequency_avail);
 ssize_t st_sensors_sysfs_scale_avail(struct device *dev,
                                 struct device_attribute *attr, char *buf)
 {
-        int i, len = 0;
+        int i, len = 0, q, r;
         struct iio_dev *indio_dev = dev_get_drvdata(dev);
         struct st_sensor_data *sdata = iio_priv(indio_dev);
 
@@ -621,8 +621,10 @@ ssize_t st_sensors_sysfs_scale_avail(struct device *dev,
                 if (sdata->sensor_settings->fs.fs_avl[i].num == 0)
                         break;
 
-                len += scnprintf(buf + len, PAGE_SIZE - len, "0.%06u ",
-                                sdata->sensor_settings->fs.fs_avl[i].gain);
+                q = sdata->sensor_settings->fs.fs_avl[i].gain / 1000000;
+                r = sdata->sensor_settings->fs.fs_avl[i].gain % 1000000;
+
+                len += scnprintf(buf + len, PAGE_SIZE - len, "%u.%06u ", q, r);
         }
         mutex_unlock(&indio_dev->mlock);
         buf[len - 1] = '\n';