1 #include <linux/kernel.h>
2 #include <linux/slab.h>
4 #include <linux/export.h>
5 #include <linux/iio/buffer.h>
6 #include <linux/iio/consumer.h>
9 struct iio_buffer buffer
;
10 int (*cb
)(const void *data
, void *private);
12 struct iio_channel
*channels
;
15 static struct iio_cb_buffer
*buffer_to_cb_buffer(struct iio_buffer
*buffer
)
17 return container_of(buffer
, struct iio_cb_buffer
, buffer
);
20 static int iio_buffer_cb_store_to(struct iio_buffer
*buffer
, const void *data
)
22 struct iio_cb_buffer
*cb_buff
= buffer_to_cb_buffer(buffer
);
23 return cb_buff
->cb(data
, cb_buff
->private);
26 static void iio_buffer_cb_release(struct iio_buffer
*buffer
)
28 struct iio_cb_buffer
*cb_buff
= buffer_to_cb_buffer(buffer
);
29 kfree(cb_buff
->buffer
.scan_mask
);
33 static const struct iio_buffer_access_funcs iio_cb_access
= {
34 .store_to
= &iio_buffer_cb_store_to
,
35 .release
= &iio_buffer_cb_release
,
38 struct iio_cb_buffer
*iio_channel_get_all_cb(struct device
*dev
,
39 int (*cb
)(const void *data
,
44 struct iio_cb_buffer
*cb_buff
;
45 struct iio_dev
*indio_dev
;
46 struct iio_channel
*chan
;
48 cb_buff
= kzalloc(sizeof(*cb_buff
), GFP_KERNEL
);
49 if (cb_buff
== NULL
) {
54 iio_buffer_init(&cb_buff
->buffer
);
56 cb_buff
->private = private;
58 cb_buff
->buffer
.access
= &iio_cb_access
;
59 INIT_LIST_HEAD(&cb_buff
->buffer
.demux_list
);
61 cb_buff
->channels
= iio_channel_get_all(dev
);
62 if (IS_ERR(cb_buff
->channels
)) {
63 ret
= PTR_ERR(cb_buff
->channels
);
64 goto error_free_cb_buff
;
67 indio_dev
= cb_buff
->channels
[0].indio_dev
;
68 cb_buff
->buffer
.scan_mask
69 = kcalloc(BITS_TO_LONGS(indio_dev
->masklength
), sizeof(long),
71 if (cb_buff
->buffer
.scan_mask
== NULL
) {
73 goto error_release_channels
;
75 chan
= &cb_buff
->channels
[0];
76 while (chan
->indio_dev
) {
77 if (chan
->indio_dev
!= indio_dev
) {
79 goto error_free_scan_mask
;
81 set_bit(chan
->channel
->scan_index
,
82 cb_buff
->buffer
.scan_mask
);
89 kfree(cb_buff
->buffer
.scan_mask
);
90 error_release_channels
:
91 iio_channel_release_all(cb_buff
->channels
);
97 EXPORT_SYMBOL_GPL(iio_channel_get_all_cb
);
99 int iio_channel_start_all_cb(struct iio_cb_buffer
*cb_buff
)
101 return iio_update_buffers(cb_buff
->channels
[0].indio_dev
,
105 EXPORT_SYMBOL_GPL(iio_channel_start_all_cb
);
107 void iio_channel_stop_all_cb(struct iio_cb_buffer
*cb_buff
)
109 iio_update_buffers(cb_buff
->channels
[0].indio_dev
,
113 EXPORT_SYMBOL_GPL(iio_channel_stop_all_cb
);
115 void iio_channel_release_all_cb(struct iio_cb_buffer
*cb_buff
)
117 iio_channel_release_all(cb_buff
->channels
);
118 iio_buffer_put(&cb_buff
->buffer
);
120 EXPORT_SYMBOL_GPL(iio_channel_release_all_cb
);
123 *iio_channel_cb_get_channels(const struct iio_cb_buffer
*cb_buffer
)
125 return cb_buffer
->channels
;
127 EXPORT_SYMBOL_GPL(iio_channel_cb_get_channels
);