Lars-Peter Clausen | 050ee2f | 2015-08-14 16:54:54 +0200 | [diff] [blame] | 1 | /* The industrial I/O callback buffer |
| 2 | * |
| 3 | * This program is free software; you can redistribute it and/or modify it |
| 4 | * under the terms of the GNU General Public License version 2 as published by |
| 5 | * the Free Software Foundation. |
| 6 | */ |
| 7 | |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 8 | #include <linux/kernel.h> |
Lars-Peter Clausen | 050ee2f | 2015-08-14 16:54:54 +0200 | [diff] [blame] | 9 | #include <linux/module.h> |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 10 | #include <linux/slab.h> |
| 11 | #include <linux/err.h> |
| 12 | #include <linux/export.h> |
| 13 | #include <linux/iio/buffer.h> |
| 14 | #include <linux/iio/consumer.h> |
| 15 | |
| 16 | struct iio_cb_buffer { |
| 17 | struct iio_buffer buffer; |
Lars-Peter Clausen | 5d65d92 | 2013-09-15 17:50:00 +0100 | [diff] [blame] | 18 | int (*cb)(const void *data, void *private); |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 19 | void *private; |
| 20 | struct iio_channel *channels; |
Matt Ranostay | adca058 | 2016-08-19 20:17:02 -0700 | [diff] [blame] | 21 | struct iio_dev *indio_dev; |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 22 | }; |
| 23 | |
Lars-Peter Clausen | 9e69c93 | 2013-10-04 12:06:00 +0100 | [diff] [blame] | 24 | static struct iio_cb_buffer *buffer_to_cb_buffer(struct iio_buffer *buffer) |
| 25 | { |
| 26 | return container_of(buffer, struct iio_cb_buffer, buffer); |
| 27 | } |
| 28 | |
Lars-Peter Clausen | 5d65d92 | 2013-09-15 17:50:00 +0100 | [diff] [blame] | 29 | static int iio_buffer_cb_store_to(struct iio_buffer *buffer, const void *data) |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 30 | { |
Lars-Peter Clausen | 9e69c93 | 2013-10-04 12:06:00 +0100 | [diff] [blame] | 31 | struct iio_cb_buffer *cb_buff = buffer_to_cb_buffer(buffer); |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 32 | return cb_buff->cb(data, cb_buff->private); |
| 33 | } |
| 34 | |
Lars-Peter Clausen | 9e69c93 | 2013-10-04 12:06:00 +0100 | [diff] [blame] | 35 | static void iio_buffer_cb_release(struct iio_buffer *buffer) |
| 36 | { |
| 37 | struct iio_cb_buffer *cb_buff = buffer_to_cb_buffer(buffer); |
| 38 | kfree(cb_buff->buffer.scan_mask); |
| 39 | kfree(cb_buff); |
| 40 | } |
| 41 | |
Lars-Peter Clausen | c7a22c3 | 2013-09-15 17:09:00 +0100 | [diff] [blame] | 42 | static const struct iio_buffer_access_funcs iio_cb_access = { |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 43 | .store_to = &iio_buffer_cb_store_to, |
Lars-Peter Clausen | 9e69c93 | 2013-10-04 12:06:00 +0100 | [diff] [blame] | 44 | .release = &iio_buffer_cb_release, |
Lars-Peter Clausen | 225d59a | 2015-05-29 18:14:21 +0200 | [diff] [blame] | 45 | |
| 46 | .modes = INDIO_BUFFER_SOFTWARE | INDIO_BUFFER_TRIGGERED, |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 47 | }; |
| 48 | |
Guenter Roeck | ca7d98d | 2013-01-31 21:43:00 +0000 | [diff] [blame] | 49 | struct iio_cb_buffer *iio_channel_get_all_cb(struct device *dev, |
Lars-Peter Clausen | 5d65d92 | 2013-09-15 17:50:00 +0100 | [diff] [blame] | 50 | int (*cb)(const void *data, |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 51 | void *private), |
| 52 | void *private) |
| 53 | { |
| 54 | int ret; |
| 55 | struct iio_cb_buffer *cb_buff; |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 56 | struct iio_channel *chan; |
| 57 | |
| 58 | cb_buff = kzalloc(sizeof(*cb_buff), GFP_KERNEL); |
Hartmut Knaack | 92825ff | 2014-02-16 11:53:00 +0000 | [diff] [blame] | 59 | if (cb_buff == NULL) |
| 60 | return ERR_PTR(-ENOMEM); |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 61 | |
Lars-Peter Clausen | bda2f8f | 2013-09-18 21:02:00 +0100 | [diff] [blame] | 62 | iio_buffer_init(&cb_buff->buffer); |
| 63 | |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 64 | cb_buff->private = private; |
| 65 | cb_buff->cb = cb; |
| 66 | cb_buff->buffer.access = &iio_cb_access; |
| 67 | INIT_LIST_HEAD(&cb_buff->buffer.demux_list); |
| 68 | |
Guenter Roeck | ca7d98d | 2013-01-31 21:43:00 +0000 | [diff] [blame] | 69 | cb_buff->channels = iio_channel_get_all(dev); |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 70 | if (IS_ERR(cb_buff->channels)) { |
| 71 | ret = PTR_ERR(cb_buff->channels); |
| 72 | goto error_free_cb_buff; |
| 73 | } |
| 74 | |
Matt Ranostay | adca058 | 2016-08-19 20:17:02 -0700 | [diff] [blame] | 75 | cb_buff->indio_dev = cb_buff->channels[0].indio_dev; |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 76 | cb_buff->buffer.scan_mask |
Matt Ranostay | adca058 | 2016-08-19 20:17:02 -0700 | [diff] [blame] | 77 | = kcalloc(BITS_TO_LONGS(cb_buff->indio_dev->masklength), |
| 78 | sizeof(long), GFP_KERNEL); |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 79 | if (cb_buff->buffer.scan_mask == NULL) { |
| 80 | ret = -ENOMEM; |
| 81 | goto error_release_channels; |
| 82 | } |
| 83 | chan = &cb_buff->channels[0]; |
| 84 | while (chan->indio_dev) { |
Matt Ranostay | adca058 | 2016-08-19 20:17:02 -0700 | [diff] [blame] | 85 | if (chan->indio_dev != cb_buff->indio_dev) { |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 86 | ret = -EINVAL; |
Jonathan Cameron | 702df9f | 2013-05-22 22:41:00 +0100 | [diff] [blame] | 87 | goto error_free_scan_mask; |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 88 | } |
| 89 | set_bit(chan->channel->scan_index, |
| 90 | cb_buff->buffer.scan_mask); |
| 91 | chan++; |
| 92 | } |
| 93 | |
| 94 | return cb_buff; |
| 95 | |
Jonathan Cameron | 702df9f | 2013-05-22 22:41:00 +0100 | [diff] [blame] | 96 | error_free_scan_mask: |
| 97 | kfree(cb_buff->buffer.scan_mask); |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 98 | error_release_channels: |
| 99 | iio_channel_release_all(cb_buff->channels); |
| 100 | error_free_cb_buff: |
| 101 | kfree(cb_buff); |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 102 | return ERR_PTR(ret); |
| 103 | } |
| 104 | EXPORT_SYMBOL_GPL(iio_channel_get_all_cb); |
| 105 | |
| 106 | int iio_channel_start_all_cb(struct iio_cb_buffer *cb_buff) |
| 107 | { |
Matt Ranostay | adca058 | 2016-08-19 20:17:02 -0700 | [diff] [blame] | 108 | return iio_update_buffers(cb_buff->indio_dev, &cb_buff->buffer, |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 109 | NULL); |
| 110 | } |
| 111 | EXPORT_SYMBOL_GPL(iio_channel_start_all_cb); |
| 112 | |
| 113 | void iio_channel_stop_all_cb(struct iio_cb_buffer *cb_buff) |
| 114 | { |
Matt Ranostay | adca058 | 2016-08-19 20:17:02 -0700 | [diff] [blame] | 115 | iio_update_buffers(cb_buff->indio_dev, NULL, &cb_buff->buffer); |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 116 | } |
| 117 | EXPORT_SYMBOL_GPL(iio_channel_stop_all_cb); |
| 118 | |
| 119 | void iio_channel_release_all_cb(struct iio_cb_buffer *cb_buff) |
| 120 | { |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 121 | iio_channel_release_all(cb_buff->channels); |
Lars-Peter Clausen | 9e69c93 | 2013-10-04 12:06:00 +0100 | [diff] [blame] | 122 | iio_buffer_put(&cb_buff->buffer); |
Jonathan Cameron | 92d1079 | 2012-06-30 20:06:00 +0100 | [diff] [blame] | 123 | } |
| 124 | EXPORT_SYMBOL_GPL(iio_channel_release_all_cb); |
| 125 | |
| 126 | struct iio_channel |
| 127 | *iio_channel_cb_get_channels(const struct iio_cb_buffer *cb_buffer) |
| 128 | { |
| 129 | return cb_buffer->channels; |
| 130 | } |
| 131 | EXPORT_SYMBOL_GPL(iio_channel_cb_get_channels); |
Lars-Peter Clausen | 050ee2f | 2015-08-14 16:54:54 +0200 | [diff] [blame] | 132 | |
Matt Ranostay | adca058 | 2016-08-19 20:17:02 -0700 | [diff] [blame] | 133 | struct iio_dev |
| 134 | *iio_channel_cb_get_iio_dev(const struct iio_cb_buffer *cb_buffer) |
| 135 | { |
| 136 | return cb_buffer->indio_dev; |
| 137 | } |
| 138 | EXPORT_SYMBOL_GPL(iio_channel_cb_get_iio_dev); |
| 139 | |
Lars-Peter Clausen | 050ee2f | 2015-08-14 16:54:54 +0200 | [diff] [blame] | 140 | MODULE_AUTHOR("Jonathan Cameron <jic23@kernel.org>"); |
| 141 | MODULE_DESCRIPTION("Industrial I/O callback buffer"); |
| 142 | MODULE_LICENSE("GPL"); |