|
@@ -41,7 +41,7 @@ static int adis16260_spi_write_reg_8(struct iio_dev *indio_dev,
|
|
|
u8 val)
|
|
|
{
|
|
|
int ret;
|
|
|
- struct adis16260_state *st = iio_dev_get_devdata(indio_dev);
|
|
|
+ struct adis16260_state *st = iio_priv(indio_dev);
|
|
|
|
|
|
mutex_lock(&st->buf_lock);
|
|
|
st->tx[0] = ADIS16260_WRITE_REG(reg_address);
|
|
@@ -66,7 +66,7 @@ static int adis16260_spi_write_reg_16(struct iio_dev *indio_dev,
|
|
|
{
|
|
|
int ret;
|
|
|
struct spi_message msg;
|
|
|
- struct adis16260_state *st = iio_dev_get_devdata(indio_dev);
|
|
|
+ struct adis16260_state *st = iio_priv(indio_dev);
|
|
|
struct spi_transfer xfers[] = {
|
|
|
{
|
|
|
.tx_buf = st->tx,
|
|
@@ -109,7 +109,7 @@ static int adis16260_spi_read_reg_16(struct iio_dev *indio_dev,
|
|
|
u16 *val)
|
|
|
{
|
|
|
struct spi_message msg;
|
|
|
- struct adis16260_state *st = iio_dev_get_devdata(indio_dev);
|
|
|
+ struct adis16260_state *st = iio_priv(indio_dev);
|
|
|
int ret;
|
|
|
struct spi_transfer xfers[] = {
|
|
|
{
|
|
@@ -152,7 +152,7 @@ static ssize_t adis16260_read_frequency_available(struct device *dev,
|
|
|
char *buf)
|
|
|
{
|
|
|
struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
|
|
- struct adis16260_state *st = iio_dev_get_devdata(indio_dev);
|
|
|
+ struct adis16260_state *st = iio_priv(indio_dev);
|
|
|
if (spi_get_device_id(st->us)->driver_data)
|
|
|
return sprintf(buf, "%s\n", "0.129 ~ 256");
|
|
|
else
|
|
@@ -164,7 +164,7 @@ static ssize_t adis16260_read_frequency(struct device *dev,
|
|
|
char *buf)
|
|
|
{
|
|
|
struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
|
|
- struct adis16260_state *st = iio_dev_get_devdata(indio_dev);
|
|
|
+ struct adis16260_state *st = iio_priv(indio_dev);
|
|
|
int ret, len = 0;
|
|
|
u16 t;
|
|
|
int sps;
|
|
@@ -189,7 +189,7 @@ static ssize_t adis16260_write_frequency(struct device *dev,
|
|
|
size_t len)
|
|
|
{
|
|
|
struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
|
|
- struct adis16260_state *st = iio_dev_get_devdata(indio_dev);
|
|
|
+ struct adis16260_state *st = iio_priv(indio_dev);
|
|
|
long val;
|
|
|
int ret;
|
|
|
u8 t;
|
|
@@ -435,7 +435,7 @@ static int adis16260_read_raw(struct iio_dev *indio_dev,
|
|
|
int *val, int *val2,
|
|
|
long mask)
|
|
|
{
|
|
|
- struct adis16260_state *st = iio_dev_get_devdata(indio_dev);
|
|
|
+ struct adis16260_state *st = iio_priv(indio_dev);
|
|
|
int ret;
|
|
|
int bits;
|
|
|
u8 addr;
|
|
@@ -576,71 +576,58 @@ static int __devinit adis16260_probe(struct spi_device *spi)
|
|
|
{
|
|
|
int ret, regdone = 0;
|
|
|
struct adis16260_platform_data *pd = spi->dev.platform_data;
|
|
|
- struct adis16260_state *st = kzalloc(sizeof *st, GFP_KERNEL);
|
|
|
- if (!st) {
|
|
|
- ret = -ENOMEM;
|
|
|
+ struct adis16260_state *st;
|
|
|
+ struct iio_dev *indio_dev;
|
|
|
+
|
|
|
+ /* setup the industrialio driver allocated elements */
|
|
|
+ indio_dev = iio_allocate_device(sizeof(*st));
|
|
|
+ if (indio_dev == NULL) {
|
|
|
+ ret = -ENOMEM;
|
|
|
goto error_ret;
|
|
|
}
|
|
|
+ st = iio_priv(indio_dev);
|
|
|
if (pd)
|
|
|
st->negate = pd->negate;
|
|
|
/* this is only used for removal purposes */
|
|
|
spi_set_drvdata(spi, st);
|
|
|
|
|
|
- /* Allocate the comms buffers */
|
|
|
- st->rx = kzalloc(sizeof(*st->rx)*ADIS16260_MAX_RX, GFP_KERNEL);
|
|
|
- if (st->rx == NULL) {
|
|
|
- ret = -ENOMEM;
|
|
|
- goto error_free_st;
|
|
|
- }
|
|
|
- st->tx = kzalloc(sizeof(*st->tx)*ADIS16260_MAX_TX, GFP_KERNEL);
|
|
|
- if (st->tx == NULL) {
|
|
|
- ret = -ENOMEM;
|
|
|
- goto error_free_rx;
|
|
|
- }
|
|
|
st->us = spi;
|
|
|
mutex_init(&st->buf_lock);
|
|
|
- /* setup the industrialio driver allocated elements */
|
|
|
- st->indio_dev = iio_allocate_device(0);
|
|
|
- if (st->indio_dev == NULL) {
|
|
|
- ret = -ENOMEM;
|
|
|
- goto error_free_tx;
|
|
|
- }
|
|
|
|
|
|
- st->indio_dev->name = spi_get_device_id(st->us)->name;
|
|
|
- st->indio_dev->dev.parent = &spi->dev;
|
|
|
- st->indio_dev->info = &adis16260_info;
|
|
|
- st->indio_dev->num_channels
|
|
|
+ indio_dev->name = spi_get_device_id(st->us)->name;
|
|
|
+ indio_dev->dev.parent = &spi->dev;
|
|
|
+ indio_dev->info = &adis16260_info;
|
|
|
+ indio_dev->num_channels
|
|
|
= ARRAY_SIZE(adis16260_channels_x);
|
|
|
if (pd && pd->direction)
|
|
|
switch (pd->direction) {
|
|
|
case 'x':
|
|
|
- st->indio_dev->channels = adis16260_channels_x;
|
|
|
+ indio_dev->channels = adis16260_channels_x;
|
|
|
break;
|
|
|
case 'y':
|
|
|
- st->indio_dev->channels = adis16260_channels_y;
|
|
|
+ indio_dev->channels = adis16260_channels_y;
|
|
|
break;
|
|
|
case 'z':
|
|
|
- st->indio_dev->channels = adis16260_channels_z;
|
|
|
+ indio_dev->channels = adis16260_channels_z;
|
|
|
break;
|
|
|
default:
|
|
|
return -EINVAL;
|
|
|
}
|
|
|
else
|
|
|
- st->indio_dev->channels = adis16260_channels_x;
|
|
|
+ indio_dev->channels = adis16260_channels_x;
|
|
|
|
|
|
- st->indio_dev->dev_data = (void *)(st);
|
|
|
- st->indio_dev->modes = INDIO_DIRECT_MODE;
|
|
|
+ indio_dev->modes = INDIO_DIRECT_MODE;
|
|
|
|
|
|
- ret = adis16260_configure_ring(st->indio_dev);
|
|
|
+ ret = adis16260_configure_ring(indio_dev);
|
|
|
if (ret)
|
|
|
goto error_free_dev;
|
|
|
|
|
|
- ret = iio_device_register(st->indio_dev);
|
|
|
+ ret = iio_device_register(indio_dev);
|
|
|
if (ret)
|
|
|
goto error_unreg_ring_funcs;
|
|
|
regdone = 1;
|
|
|
- ret = iio_ring_buffer_register_ex(st->indio_dev->ring, 0,
|
|
|
- st->indio_dev->channels,
|
|
|
+ ret = iio_ring_buffer_register_ex(indio_dev->ring, 0,
|
|
|
+ indio_dev->channels,
|
|
|
ARRAY_SIZE(adis16260_channels_x));
|
|
|
if (ret) {
|
|
|
printk(KERN_ERR "failed to initialize the ring\n");
|
|
@@ -648,34 +635,28 @@ static int __devinit adis16260_probe(struct spi_device *spi)
|
|
|
}
|
|
|
|
|
|
if (spi->irq) {
|
|
|
- ret = adis16260_probe_trigger(st->indio_dev);
|
|
|
+ ret = adis16260_probe_trigger(indio_dev);
|
|
|
if (ret)
|
|
|
goto error_uninitialize_ring;
|
|
|
}
|
|
|
|
|
|
/* Get the device into a sane initial state */
|
|
|
- ret = adis16260_initial_setup(st->indio_dev);
|
|
|
+ ret = adis16260_initial_setup(indio_dev);
|
|
|
if (ret)
|
|
|
goto error_remove_trigger;
|
|
|
return 0;
|
|
|
|
|
|
error_remove_trigger:
|
|
|
- adis16260_remove_trigger(st->indio_dev);
|
|
|
+ adis16260_remove_trigger(indio_dev);
|
|
|
error_uninitialize_ring:
|
|
|
- iio_ring_buffer_unregister(st->indio_dev->ring);
|
|
|
+ iio_ring_buffer_unregister(indio_dev->ring);
|
|
|
error_unreg_ring_funcs:
|
|
|
- adis16260_unconfigure_ring(st->indio_dev);
|
|
|
+ adis16260_unconfigure_ring(indio_dev);
|
|
|
error_free_dev:
|
|
|
if (regdone)
|
|
|
- iio_device_unregister(st->indio_dev);
|
|
|
+ iio_device_unregister(indio_dev);
|
|
|
else
|
|
|
- iio_free_device(st->indio_dev);
|
|
|
-error_free_tx:
|
|
|
- kfree(st->tx);
|
|
|
-error_free_rx:
|
|
|
- kfree(st->rx);
|
|
|
-error_free_st:
|
|
|
- kfree(st);
|
|
|
+ iio_free_device(indio_dev);
|
|
|
error_ret:
|
|
|
return ret;
|
|
|
}
|
|
@@ -683,8 +664,7 @@ error_ret:
|
|
|
static int adis16260_remove(struct spi_device *spi)
|
|
|
{
|
|
|
int ret;
|
|
|
- struct adis16260_state *st = spi_get_drvdata(spi);
|
|
|
- struct iio_dev *indio_dev = st->indio_dev;
|
|
|
+ struct iio_dev *indio_dev = spi_get_drvdata(spi);
|
|
|
|
|
|
ret = adis16260_stop_device(indio_dev);
|
|
|
if (ret)
|
|
@@ -693,13 +673,9 @@ static int adis16260_remove(struct spi_device *spi)
|
|
|
flush_scheduled_work();
|
|
|
|
|
|
adis16260_remove_trigger(indio_dev);
|
|
|
-
|
|
|
- iio_ring_buffer_unregister(st->indio_dev->ring);
|
|
|
+ iio_ring_buffer_unregister(indio_dev->ring);
|
|
|
iio_device_unregister(indio_dev);
|
|
|
adis16260_unconfigure_ring(indio_dev);
|
|
|
- kfree(st->tx);
|
|
|
- kfree(st->rx);
|
|
|
- kfree(st);
|
|
|
|
|
|
err_ret:
|
|
|
return ret;
|