On Sat, 16 Mar 2019 17:46:40 +0000 Jonathan Cameron <jic23@xxxxxxxxxx> wrote: > On Fri, 15 Mar 2019 23:12:27 -0300 > Renato Lui Geh <renatogeh@xxxxxxxxx> wrote: > > > Previously, the AD7780 driver only supported gpio for the 'powerdown' > > pin. This commit adds suppport for the 'gain' and 'filter' pin. > > > > Signed-off-by: Renato Lui Geh <renatogeh@xxxxxxxxx> > > Signed-off-by: Giuliano Belinassi <giuliano.belinassi@xxxxxx> > > Co-developed-by: Giuliano Belinassi <giuliano.belinassi@xxxxxx> > Something a little odd happened when trying to use git am on this, > but patch was happy so I did it that way. Please give it a quick > sanity check once I push the tree out incase we have a real problem. > > Applied to the togreg branch of iio.git to be shortly pushed out > as testing for the autobuilders to play with it. Ah, we missed a 64 bit being divided below. Found by 0day. > > Thanks, > > Jonathan > > > --- > > Changes in v3: > > - Renamed ad7780_chip_info's filter to odr > > - Renamed ad778x_filter to ad778x_odr_avail > > - Changed vref variable from unsigned int to unsigned long long to avoid > > overflow > > - Removed unnecessary AD_SD_CHANNEL macro > > Changes in v4: > > - Removed useless macro > > - Added default case for switch to suppress warning > > - Removed chunks belonging to filter reading, adding these as a > > patch for itself > > Changes in v5: > > - ad778x_odr_avail moved to filter patch > > - Split gain reading to its own patch > > - Init GPIOs in a separate function > > > > drivers/staging/iio/adc/ad7780.c | 114 ++++++++++++++++++++++++++----- > > 1 file changed, 96 insertions(+), 18 deletions(-) > > > > diff --git a/drivers/staging/iio/adc/ad7780.c b/drivers/staging/iio/adc/ad7780.c > > index c4a85789c2db..07e5e35c92a3 100644 > > --- a/drivers/staging/iio/adc/ad7780.c > > +++ b/drivers/staging/iio/adc/ad7780.c > > @@ -39,6 +39,9 @@ > > #define AD7170_PATTERN (AD7780_PAT0 | AD7170_PAT2) > > #define AD7170_PATTERN_MASK (AD7780_PAT0 | AD7780_PAT1 | AD7170_PAT2) > > > > +#define AD7780_GAIN_MIDPOINT 64 > > +#define AD7780_FILTER_MIDPOINT 13350 > > + > > struct ad7780_chip_info { > > struct iio_chan_spec channel; > > unsigned int pattern_mask; > > @@ -50,7 +53,10 @@ struct ad7780_state { > > const struct ad7780_chip_info *chip_info; > > struct regulator *reg; > > struct gpio_desc *powerdown_gpio; > > - unsigned int gain; > > + struct gpio_desc *gain_gpio; > > + struct gpio_desc *filter_gpio; > > + unsigned int gain; > > + unsigned int int_vref_mv; > > > > struct ad_sigma_delta sd; > > }; > > @@ -104,8 +110,10 @@ static int ad7780_read_raw(struct iio_dev *indio_dev, > > voltage_uv = regulator_get_voltage(st->reg); > > if (voltage_uv < 0) > > return voltage_uv; > > - *val = (voltage_uv / 1000) * st->gain; > > + voltage_uv /= 1000; > > + *val = voltage_uv * st->gain; > > *val2 = chan->scan_type.realbits - 1; > > + st->int_vref_mv = voltage_uv; > > return IIO_VAL_FRACTIONAL_LOG2; > > case IIO_CHAN_INFO_OFFSET: > > *val = -(1 << (chan->scan_type.realbits - 1)); > > @@ -115,6 +123,50 @@ static int ad7780_read_raw(struct iio_dev *indio_dev, > > return -EINVAL; > > } > > > > +static int ad7780_write_raw(struct iio_dev *indio_dev, > > + struct iio_chan_spec const *chan, > > + int val, > > + int val2, > > + long m) > > +{ > > + struct ad7780_state *st = iio_priv(indio_dev); > > + const struct ad7780_chip_info *chip_info = st->chip_info; > > + unsigned long long vref; > > + unsigned int full_scale, gain; > > + > > + if (!chip_info->is_ad778x) > > + return -EINVAL; > > + > > + switch (m) { > > + case IIO_CHAN_INFO_SCALE: > > + if (val != 0) > > + return -EINVAL; > > + > > + vref = st->int_vref_mv * 1000000LL; > > + full_scale = 1 << (chip_info->channel.scan_type.realbits - 1); > > + gain = DIV_ROUND_CLOSEST(vref, full_scale); DIV_ROUND_CLOSEST_ULL needed as vref is long long. I'll fix up. Jonathan > > + gain = DIV_ROUND_CLOSEST(gain, val2); > > + st->gain = gain; > > + if (gain < AD7780_GAIN_MIDPOINT) > > + gain = 0; > > + else > > + gain = 1; > > + gpiod_set_value(st->gain_gpio, gain); > > + break; > > + case IIO_CHAN_INFO_SAMP_FREQ: > > + if (1000*val + val2/1000 < AD7780_FILTER_MIDPOINT) > > + val = 0; > > + else > > + val = 1; > > + gpiod_set_value(st->filter_gpio, val); > > + break; > > + default: > > + break; > > + } > > + > > + return 0; > > +} > > + > > static int ad7780_postprocess_sample(struct ad_sigma_delta *sigma_delta, > > unsigned int raw_sample) > > { > > @@ -125,13 +177,6 @@ static int ad7780_postprocess_sample(struct ad_sigma_delta *sigma_delta, > > ((raw_sample & chip_info->pattern_mask) != chip_info->pattern)) > > return -EIO; > > > > - if (chip_info->is_ad778x) { > > - if (raw_sample & AD7780_GAIN) > > - st->gain = 1; > > - else > > - st->gain = 128; > > - } > > - > > return 0; > > } > > > > @@ -173,8 +218,47 @@ static const struct ad7780_chip_info ad7780_chip_info_tbl[] = { > > > > static const struct iio_info ad7780_info = { > > .read_raw = ad7780_read_raw, > > + .write_raw = ad7780_write_raw, > > }; > > > > +static int ad7780_init_gpios(struct device *dev, struct ad7780_state *st) > > +{ > > + int ret; > > + > > + st->powerdown_gpio = devm_gpiod_get_optional(dev, > > + "powerdown", > > + GPIOD_OUT_LOW); > > + if (IS_ERR(st->powerdown_gpio)) { > > + ret = PTR_ERR(st->powerdown_gpio); > > + dev_err(dev, "Failed to request powerdown GPIO: %d\n", ret); > > + return ret; > > + } > > + > > + if (!st->chip_info->is_ad778x) > > + return 0; > > + > nitpick: One blank line is always enough. More just reduces the amount of > code that can be seen at a time. > > > + > > + st->gain_gpio = devm_gpiod_get_optional(dev, > > + "adi,gain", > > + GPIOD_OUT_HIGH); > > + if (IS_ERR(st->gain_gpio)) { > > + ret = PTR_ERR(st->gain_gpio); > > + dev_err(dev, "Failed to request gain GPIO: %d\n", ret); > > + return ret; > > + } > > + > > + st->filter_gpio = devm_gpiod_get_optional(dev, > > + "adi,filter", > > + GPIOD_OUT_HIGH); > > + if (IS_ERR(st->filter_gpio)) { > > + ret = PTR_ERR(st->filter_gpio); > > + dev_err(dev, "Failed to request filter GPIO: %d\n", ret); > > + return ret; > > + } > > + > > + return 0; > > +} > > + > > static int ad7780_probe(struct spi_device *spi) > > { > > struct ad7780_state *st; > > @@ -212,15 +296,9 @@ static int ad7780_probe(struct spi_device *spi) > > indio_dev->num_channels = 1; > > indio_dev->info = &ad7780_info; > > > > - st->powerdown_gpio = devm_gpiod_get_optional(&spi->dev, > > - "powerdown", > > - GPIOD_OUT_LOW); > > - if (IS_ERR(st->powerdown_gpio)) { > > - ret = PTR_ERR(st->powerdown_gpio); > > - dev_err(&spi->dev, "Failed to request powerdown GPIO: %d\n", > > - ret); > > - goto error_disable_reg; > > - } > > + ret = ad7780_init_gpios(&spi->dev, st); > > + if (ret) > > + goto error_cleanup_buffer_and_trigger; > > > > ret = ad_sd_setup_buffer_and_trigger(indio_dev); > > if (ret) > _______________________________________________ devel mailing list devel@xxxxxxxxxxxxxxxxxxxxxx http://driverdev.linuxdriverproject.org/mailman/listinfo/driverdev-devel