Commit 59883ba1 authored by Jonathan Cameron's avatar Jonathan Cameron Committed by Greg Kroah-Hartman
Browse files

staging: iio: Add iio_sw_ring_helper_state and functions to cover common case. 



Signed-off-by: default avatarJonathan Cameron <jic23@cam.ac.uk>
Acked-by: default avatarBarry Song <21cnbao@gmail.com>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@suse.de>
parent 43c11b43

drivers/staging/iio/ring_sw.c

+44 −0
Original line number Diff line number Diff line
@@ -13,6 +13,7 @@ 
#include <linux/device.h>

#include <linux/workqueue.h>

#include "ring_sw.h"

#include "trigger.h"



static inline int __iio_allocate_sw_ring_buffer(struct iio_sw_ring_buffer *ring,

						int bytes_per_datum, int length)
@@ -456,5 +457,48 @@ int iio_sw_ring_preenable(struct iio_dev *indio_dev) 
}

EXPORT_SYMBOL(iio_sw_ring_preenable);



void iio_sw_trigger_bh_to_ring(struct work_struct *work_s)

{

	struct iio_sw_ring_helper_state *st

		= container_of(work_s, struct iio_sw_ring_helper_state,

			work_trigger_to_ring);

	int len = 0;

	size_t datasize = st->indio_dev

		->ring->access.get_bpd(st->indio_dev->ring);

	char *data = kmalloc(datasize, GFP_KERNEL);



	if (data == NULL) {

		dev_err(st->indio_dev->dev.parent,

			"memory alloc failed in ring bh");

		return;

	}



	if (st->indio_dev->scan_count)

		len = st->get_ring_element(st, data);



	  /* Guaranteed to be aligned with 8 byte boundary */

	if (st->indio_dev->scan_timestamp)

		*(s64 *)(((u32)data + len

				+ sizeof(s64) - 1) & ~(sizeof(s64) - 1))

			= st->last_timestamp;

	  st->indio_dev->ring->access.store_to(st->indio_dev->ring,

					(u8 *)data,

			st->last_timestamp);



	iio_trigger_notify_done(st->indio_dev->trig);

	kfree(data);



	return;

}

EXPORT_SYMBOL(iio_sw_trigger_bh_to_ring);



void iio_sw_poll_func_th(struct iio_dev *indio_dev, s64 time)

{	struct iio_sw_ring_helper_state *h

		= iio_dev_get_devdata(indio_dev);

	h->last_timestamp = time;

	schedule_work(&h->work_trigger_to_ring);

}

EXPORT_SYMBOL(iio_sw_poll_func_th);



MODULE_DESCRIPTION("Industrialio I/O software ring buffer");

MODULE_LICENSE("GPL");

drivers/staging/iio/ring_sw.h

+10 −0
Original line number Diff line number Diff line
@@ -209,6 +209,16 @@ void iio_sw_rb_free(struct iio_ring_buffer *ring); 


int iio_sw_ring_preenable(struct iio_dev *indio_dev);



struct iio_sw_ring_helper_state {

	struct work_struct		work_trigger_to_ring;

	struct iio_dev			*indio_dev;

	int (*get_ring_element)(struct iio_sw_ring_helper_state *st, u8 *buf);

	s64				last_timestamp;

};



void iio_sw_poll_func_th(struct iio_dev *indio_dev, s64 time);

void iio_sw_trigger_bh_to_ring(struct work_struct *work_s);



#else /* CONFIG_IIO_RING_BUFFER*/

static inline void iio_ring_sw_register_funcs(struct iio_ring_access_funcs *ra)

{};