Skip to content

Commit

Permalink
---
Browse files Browse the repository at this point in the history
yaml
---
r: 338003
b: refs/heads/master
c: a458c55
h: refs/heads/master
i:
  338001: df4f710
  337999: 31fed06
v: v3
  • Loading branch information
Lars-Peter Clausen authored and Jonathan Cameron committed Nov 19, 2012
1 parent 1443320 commit aa0dc47
Show file tree
Hide file tree
Showing 3 changed files with 12 additions and 71 deletions.
2 changes: 1 addition & 1 deletion [refs]
Original file line number Diff line number Diff line change
@@ -1,2 +1,2 @@
---
refs/heads/master: 9d5e9fdf0f8846e014125f8e57fe5f3e03c8839f
refs/heads/master: a458c55c107c5e467ab5b7e471f77ec5868afcb9
3 changes: 1 addition & 2 deletions trunk/drivers/staging/iio/imu/Kconfig
Original file line number Diff line number Diff line change
Expand Up @@ -23,8 +23,7 @@ config IIO_ADIS_LIB

config IIO_ADIS_LIB_BUFFER
bool
select IIO_TRIGGER
select IIO_SW_RING
select IIO_TRIGGERED_BUFFER
help
A set of buffer helper functions for the Analog Devices ADIS* device
family.
78 changes: 10 additions & 68 deletions trunk/drivers/staging/iio/imu/adis_buffer.c
Original file line number Diff line number Diff line change
Expand Up @@ -7,8 +7,8 @@

#include <linux/iio/iio.h>
#include <linux/iio/buffer.h>
#include "../ring_sw.h"
#include <linux/iio/trigger_consumer.h>
#include <linux/iio/triggered_buffer.h>

#include "adis.h"

Expand Down Expand Up @@ -83,56 +83,6 @@ static irqreturn_t adis_trigger_handler(int irq, void *p)
return IRQ_HANDLED;
}

static const struct iio_buffer_setup_ops adis_buffer_setup_ops = {
.preenable = &iio_sw_buffer_preenable,
.postenable = &iio_triggered_buffer_postenable,
.predisable = &iio_triggered_buffer_predisable,
};

static int adis_buffer_setup(struct iio_dev *indio_dev,
irqreturn_t (*trigger_handler)(int, void *))
{
int ret = 0;
struct iio_buffer *buffer;

if (!trigger_handler)
trigger_handler = &adis_trigger_handler;

buffer = iio_sw_rb_allocate(indio_dev);
if (!buffer) {
ret = -ENOMEM;
return ret;
}

indio_dev->buffer = buffer;
indio_dev->setup_ops = &adis_buffer_setup_ops;

indio_dev->pollfunc = iio_alloc_pollfunc(&iio_pollfunc_store_time,
trigger_handler,
IRQF_ONESHOT,
indio_dev,
"%s_consumer%d",
indio_dev->name,
indio_dev->id);
if (indio_dev->pollfunc == NULL) {
ret = -ENOMEM;
goto error_iio_sw_rb_free;
}

indio_dev->modes |= INDIO_BUFFER_TRIGGERED;
return 0;

error_iio_sw_rb_free:
iio_sw_rb_free(indio_dev->buffer);
return ret;
}

static void adis_buffer_cleanup(struct iio_dev *indio_dev)
{
iio_dealloc_pollfunc(indio_dev->pollfunc);
iio_sw_rb_free(indio_dev->buffer);
}

/**
* adis_setup_buffer_and_trigger() - Sets up buffer and trigger for the adis device
* @adis: The adis device.
Expand All @@ -154,30 +104,23 @@ int adis_setup_buffer_and_trigger(struct adis *adis, struct iio_dev *indio_dev,
{
int ret;

ret = adis_buffer_setup(indio_dev, trigger_handler);
if (!trigger_handler)
trigger_handler = adis_trigger_handler;

ret = iio_triggered_buffer_setup(indio_dev, &iio_pollfunc_store_time,
trigger_handler, NULL);
if (ret)
return ret;

ret = iio_buffer_register(indio_dev,
indio_dev->channels,
indio_dev->num_channels);
if (ret) {
dev_err(&adis->spi->dev, "Failed to initialize buffer %d\n",
ret);
goto error_unreg_buffer_funcs;
}

if (adis->spi->irq) {
ret = adis_probe_trigger(adis, indio_dev);
if (ret)
goto error_uninitialize_buffer;
goto error_buffer_cleanup;
}
return 0;

error_uninitialize_buffer:
iio_buffer_unregister(indio_dev);
error_unreg_buffer_funcs:
adis_buffer_cleanup(indio_dev);
error_buffer_cleanup:
iio_triggered_buffer_cleanup(indio_dev);
return ret;
}
EXPORT_SYMBOL_GPL(adis_setup_buffer_and_trigger);
Expand All @@ -194,7 +137,6 @@ void adis_cleanup_buffer_and_trigger(struct adis *adis,
{
if (adis->spi->irq)
adis_remove_trigger(adis);
iio_buffer_unregister(indio_dev);
adis_buffer_cleanup(indio_dev);
iio_triggered_buffer_cleanup(indio_dev);
}
EXPORT_SYMBOL_GPL(adis_cleanup_buffer_and_trigger);

0 comments on commit aa0dc47

Please sign in to comment.