For adding newer sensor some basic rework of the code is necessary.

This commit reworks the code and uses regmap field to read out
temp_data.

Signed-off-by: Philipp Rossak <embe...@gmail.com>
---
 drivers/iio/adc/sun4i-gpadc-iio.c | 21 +++++++++++++--------
 1 file changed, 13 insertions(+), 8 deletions(-)

diff --git a/drivers/iio/adc/sun4i-gpadc-iio.c 
b/drivers/iio/adc/sun4i-gpadc-iio.c
index d48f338af563..c278e165e161 100644
--- a/drivers/iio/adc/sun4i-gpadc-iio.c
+++ b/drivers/iio/adc/sun4i-gpadc-iio.c
@@ -63,6 +63,7 @@ struct gpadc_data {
        int             (*ths_suspend)(struct sun4i_gpadc_iio *info);
        int             (*ths_resume)(struct sun4i_gpadc_iio *info);
        bool            support_irq;
+       u32             temp_data_base;
 };
 
 static irqreturn_t sun4i_gpadc_data_irq_handler(int irq, void *dev_id);
@@ -77,6 +78,7 @@ static const struct gpadc_data sun4i_gpadc_data = {
        .adc_channel = true,
        .ths_irq_thread = sun4i_gpadc_data_irq_handler,
        .support_irq = true,
+       .temp_data_base = SUN4I_GPADC_TEMP_DATA,
 };
 
 static const struct gpadc_data sun5i_gpadc_data = {
@@ -89,6 +91,7 @@ static const struct gpadc_data sun5i_gpadc_data = {
        .adc_channel = true,
        .ths_irq_thread = sun4i_gpadc_data_irq_handler,
        .support_irq = true,
+       .temp_data_base = SUN4I_GPADC_TEMP_DATA,
 };
 
 static const struct gpadc_data sun6i_gpadc_data = {
@@ -101,12 +104,14 @@ static const struct gpadc_data sun6i_gpadc_data = {
        .adc_channel = true,
        .ths_irq_thread = sun4i_gpadc_data_irq_handler,
        .support_irq = true,
+       .temp_data_base = SUN4I_GPADC_TEMP_DATA,
 };
 
 static const struct gpadc_data sun8i_a33_gpadc_data = {
        .temp_offset = -1662,
        .temp_scale = 162,
        .tp_mode_en = SUN8I_A33_GPADC_CTRL1_CHOP_TEMP_EN,
+       .temp_data_base = SUN4I_GPADC_TEMP_DATA,
 };
 
 struct sun4i_gpadc_iio {
@@ -271,18 +276,18 @@ static int sun4i_gpadc_temp_read(struct iio_dev 
*indio_dev, int *val)
 {
        struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
 
-       if (!info->data->support_irq) {
-               pm_runtime_get_sync(indio_dev->dev.parent);
+       if (info->data->adc_channel)
+               return sun4i_gpadc_read(indio_dev, 0, val,
+                               SUN4I_GPADC_IRQ_TEMP_DATA);
 
-               regmap_read(info->regmap, SUN4I_GPADC_TEMP_DATA, val);
+       pm_runtime_get_sync(indio_dev->dev.parent);
 
-               pm_runtime_mark_last_busy(indio_dev->dev.parent);
-               pm_runtime_put_autosuspend(indio_dev->dev.parent);
+       regmap_read(info->regmap, info->data->temp_data_base, val);
 
-               return 0;
-       }
+       pm_runtime_mark_last_busy(indio_dev->dev.parent);
+       pm_runtime_put_autosuspend(indio_dev->dev.parent);
 
-       return sun4i_gpadc_read(indio_dev, 0, val, SUN4I_GPADC_IRQ_TEMP_DATA);
+       return 0;
 }
 
 static int sun4i_gpadc_temp_offset(struct iio_dev *indio_dev, int *val)
-- 
2.11.0

-- 
You received this message because you are subscribed to the Google Groups 
"linux-sunxi" group.
To unsubscribe from this group and stop receiving emails from it, send an email 
to linux-sunxi+unsubscr...@googlegroups.com.
For more options, visit https://groups.google.com/d/optout.

Reply via email to