staging:iio:adc: AD7780: Use private data space from iio_allocate_device + trivial fixes
Use private data space from iio_allocate_device Drop dev_data in favour of iio_priv() Fix typo in gpio name Fix error return path, free gpio Make scale_uv type unsigned long Signed-off-by: Michael Hennerich <michael.hennerich@analog.com> Acked-by: Jonathan Cameron <jic23@cam.ac.uk> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
parent
643ea260b4
commit
f07458ad8f
1 changed files with 36 additions and 44 deletions
|
@ -40,7 +40,6 @@ struct ad7780_chip_info {
|
||||||
};
|
};
|
||||||
|
|
||||||
struct ad7780_state {
|
struct ad7780_state {
|
||||||
struct iio_dev *indio_dev;
|
|
||||||
struct spi_device *spi;
|
struct spi_device *spi;
|
||||||
const struct ad7780_chip_info *chip_info;
|
const struct ad7780_chip_info *chip_info;
|
||||||
struct regulator *reg;
|
struct regulator *reg;
|
||||||
|
@ -92,9 +91,10 @@ static int ad7780_read_raw(struct iio_dev *indio_dev,
|
||||||
int *val2,
|
int *val2,
|
||||||
long m)
|
long m)
|
||||||
{
|
{
|
||||||
int ret, smpl;
|
struct ad7780_state *st = iio_priv(indio_dev);
|
||||||
struct ad7780_state *st = indio_dev->dev_data;
|
struct iio_chan_spec channel = st->chip_info->channel;
|
||||||
unsigned int scale_uv;
|
int ret, smpl = 0;
|
||||||
|
unsigned long scale_uv;
|
||||||
|
|
||||||
switch (m) {
|
switch (m) {
|
||||||
case 0:
|
case 0:
|
||||||
|
@ -109,11 +109,9 @@ static int ad7780_read_raw(struct iio_dev *indio_dev,
|
||||||
!((smpl & AD7780_PAT0) && !(smpl & AD7780_PAT1)))
|
!((smpl & AD7780_PAT0) && !(smpl & AD7780_PAT1)))
|
||||||
return -EIO;
|
return -EIO;
|
||||||
|
|
||||||
*val = (smpl >> st->chip_info->channel.scan_type.shift) &
|
*val = (smpl >> channel.scan_type.shift) &
|
||||||
((1 << (st->chip_info->channel.scan_type.realbits))
|
((1 << (channel.scan_type.realbits)) - 1);
|
||||||
- 1);
|
*val -= (1 << (channel.scan_type.realbits - 1));
|
||||||
*val -= (1 << (st->chip_info->channel.scan_type.realbits
|
|
||||||
- 1));
|
|
||||||
|
|
||||||
if (!(smpl & AD7780_GAIN))
|
if (!(smpl & AD7780_GAIN))
|
||||||
*val *= 128;
|
*val *= 128;
|
||||||
|
@ -121,7 +119,7 @@ static int ad7780_read_raw(struct iio_dev *indio_dev,
|
||||||
return IIO_VAL_INT;
|
return IIO_VAL_INT;
|
||||||
case (1 << IIO_CHAN_INFO_SCALE_SHARED):
|
case (1 << IIO_CHAN_INFO_SCALE_SHARED):
|
||||||
scale_uv = (st->int_vref_mv * 100000)
|
scale_uv = (st->int_vref_mv * 100000)
|
||||||
>> (st->chip_info->channel.scan_type.realbits - 1);
|
>> (channel.scan_type.realbits - 1);
|
||||||
*val = scale_uv / 100000;
|
*val = scale_uv / 100000;
|
||||||
*val2 = (scale_uv % 100000) * 10;
|
*val2 = (scale_uv % 100000) * 10;
|
||||||
return IIO_VAL_INT_PLUS_MICRO;
|
return IIO_VAL_INT_PLUS_MICRO;
|
||||||
|
@ -159,6 +157,7 @@ static int __devinit ad7780_probe(struct spi_device *spi)
|
||||||
{
|
{
|
||||||
struct ad7780_platform_data *pdata = spi->dev.platform_data;
|
struct ad7780_platform_data *pdata = spi->dev.platform_data;
|
||||||
struct ad7780_state *st;
|
struct ad7780_state *st;
|
||||||
|
struct iio_dev *indio_dev;
|
||||||
int ret, voltage_uv = 0;
|
int ret, voltage_uv = 0;
|
||||||
|
|
||||||
if (!pdata) {
|
if (!pdata) {
|
||||||
|
@ -166,11 +165,11 @@ static int __devinit ad7780_probe(struct spi_device *spi)
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
|
|
||||||
st = kzalloc(sizeof(*st), GFP_KERNEL);
|
indio_dev = iio_allocate_device(sizeof(*st));
|
||||||
if (st == NULL) {
|
if (indio_dev == NULL)
|
||||||
ret = -ENOMEM;
|
return -ENOMEM;
|
||||||
goto error_ret;
|
|
||||||
}
|
st = iio_priv(indio_dev);
|
||||||
|
|
||||||
st->reg = regulator_get(&spi->dev, "vcc");
|
st->reg = regulator_get(&spi->dev, "vcc");
|
||||||
if (!IS_ERR(st->reg)) {
|
if (!IS_ERR(st->reg)) {
|
||||||
|
@ -193,24 +192,16 @@ static int __devinit ad7780_probe(struct spi_device *spi)
|
||||||
else
|
else
|
||||||
dev_warn(&spi->dev, "reference voltage unspecified\n");
|
dev_warn(&spi->dev, "reference voltage unspecified\n");
|
||||||
|
|
||||||
spi_set_drvdata(spi, st);
|
spi_set_drvdata(spi, indio_dev);
|
||||||
st->spi = spi;
|
st->spi = spi;
|
||||||
|
|
||||||
st->indio_dev = iio_allocate_device(0);
|
indio_dev->dev.parent = &spi->dev;
|
||||||
if (st->indio_dev == NULL) {
|
indio_dev->name = spi_get_device_id(spi)->name;
|
||||||
ret = -ENOMEM;
|
indio_dev->driver_module = THIS_MODULE;
|
||||||
goto error_disable_reg;
|
indio_dev->modes = INDIO_DIRECT_MODE;
|
||||||
}
|
indio_dev->channels = &st->chip_info->channel;
|
||||||
|
indio_dev->num_channels = 1;
|
||||||
/* Establish that the iio_dev is a child of the spi device */
|
indio_dev->read_raw = &ad7780_read_raw;
|
||||||
st->indio_dev->dev.parent = &spi->dev;
|
|
||||||
st->indio_dev->name = spi_get_device_id(spi)->name;
|
|
||||||
st->indio_dev->dev_data = (void *)(st);
|
|
||||||
st->indio_dev->driver_module = THIS_MODULE;
|
|
||||||
st->indio_dev->modes = INDIO_DIRECT_MODE;
|
|
||||||
st->indio_dev->channels = &st->chip_info->channel;
|
|
||||||
st->indio_dev->num_channels = 1;
|
|
||||||
st->indio_dev->read_raw = &ad7780_read_raw;
|
|
||||||
|
|
||||||
init_waitqueue_head(&st->wq_data_avail);
|
init_waitqueue_head(&st->wq_data_avail);
|
||||||
|
|
||||||
|
@ -223,20 +214,20 @@ static int __devinit ad7780_probe(struct spi_device *spi)
|
||||||
spi_message_add_tail(&st->xfer, &st->msg);
|
spi_message_add_tail(&st->xfer, &st->msg);
|
||||||
|
|
||||||
ret = gpio_request_one(st->pdata->gpio_pdrst, GPIOF_OUT_INIT_LOW,
|
ret = gpio_request_one(st->pdata->gpio_pdrst, GPIOF_OUT_INIT_LOW,
|
||||||
"AD7877 /PDRST");
|
"AD7780 /PDRST");
|
||||||
if (ret) {
|
if (ret) {
|
||||||
dev_err(&spi->dev, "failed to request GPIO PDRST\n");
|
dev_err(&spi->dev, "failed to request GPIO PDRST\n");
|
||||||
goto error_free_device;
|
goto error_disable_reg;
|
||||||
}
|
}
|
||||||
|
|
||||||
ret = request_irq(spi->irq, ad7780_interrupt,
|
ret = request_irq(spi->irq, ad7780_interrupt,
|
||||||
IRQF_TRIGGER_FALLING, spi_get_device_id(spi)->name, st);
|
IRQF_TRIGGER_FALLING, spi_get_device_id(spi)->name, st);
|
||||||
if (ret)
|
if (ret)
|
||||||
goto error_free_device;
|
goto error_free_gpio;
|
||||||
|
|
||||||
disable_irq(spi->irq);
|
disable_irq(spi->irq);
|
||||||
|
|
||||||
ret = iio_device_register(st->indio_dev);
|
ret = iio_device_register(indio_dev);
|
||||||
if (ret)
|
if (ret)
|
||||||
goto error_free_irq;
|
goto error_free_irq;
|
||||||
|
|
||||||
|
@ -244,32 +235,33 @@ static int __devinit ad7780_probe(struct spi_device *spi)
|
||||||
|
|
||||||
error_free_irq:
|
error_free_irq:
|
||||||
free_irq(spi->irq, st);
|
free_irq(spi->irq, st);
|
||||||
|
error_free_gpio:
|
||||||
error_free_device:
|
gpio_free(st->pdata->gpio_pdrst);
|
||||||
iio_free_device(st->indio_dev);
|
|
||||||
error_disable_reg:
|
error_disable_reg:
|
||||||
if (!IS_ERR(st->reg))
|
if (!IS_ERR(st->reg))
|
||||||
regulator_disable(st->reg);
|
regulator_disable(st->reg);
|
||||||
error_put_reg:
|
error_put_reg:
|
||||||
if (!IS_ERR(st->reg))
|
if (!IS_ERR(st->reg))
|
||||||
regulator_put(st->reg);
|
regulator_put(st->reg);
|
||||||
kfree(st);
|
|
||||||
error_ret:
|
iio_free_device(indio_dev);
|
||||||
|
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int ad7780_remove(struct spi_device *spi)
|
static int ad7780_remove(struct spi_device *spi)
|
||||||
{
|
{
|
||||||
struct ad7780_state *st = spi_get_drvdata(spi);
|
struct iio_dev *indio_dev = spi_get_drvdata(spi);
|
||||||
struct iio_dev *indio_dev = st->indio_dev;
|
struct ad7780_state *st = iio_priv(indio_dev);
|
||||||
|
|
||||||
free_irq(spi->irq, st);
|
free_irq(spi->irq, st);
|
||||||
gpio_free(st->pdata->gpio_pdrst);
|
gpio_free(st->pdata->gpio_pdrst);
|
||||||
iio_device_unregister(indio_dev);
|
|
||||||
if (!IS_ERR(st->reg)) {
|
if (!IS_ERR(st->reg)) {
|
||||||
regulator_disable(st->reg);
|
regulator_disable(st->reg);
|
||||||
regulator_put(st->reg);
|
regulator_put(st->reg);
|
||||||
}
|
}
|
||||||
kfree(st);
|
iio_device_unregister(indio_dev);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
Loading…
Add table
Reference in a new issue