^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /* The industrial I/O callback buffer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/err.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/export.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/iio/iio.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/iio/buffer_impl.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/iio/consumer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) struct iio_cb_buffer {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) struct iio_buffer buffer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) int (*cb)(const void *data, void *private);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) void *private;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) struct iio_channel *channels;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) struct iio_dev *indio_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) static struct iio_cb_buffer *buffer_to_cb_buffer(struct iio_buffer *buffer)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) return container_of(buffer, struct iio_cb_buffer, buffer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) static int iio_buffer_cb_store_to(struct iio_buffer *buffer, const void *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) struct iio_cb_buffer *cb_buff = buffer_to_cb_buffer(buffer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) return cb_buff->cb(data, cb_buff->private);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) static void iio_buffer_cb_release(struct iio_buffer *buffer)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) struct iio_cb_buffer *cb_buff = buffer_to_cb_buffer(buffer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) bitmap_free(cb_buff->buffer.scan_mask);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) kfree(cb_buff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) static const struct iio_buffer_access_funcs iio_cb_access = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) .store_to = &iio_buffer_cb_store_to,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) .release = &iio_buffer_cb_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) .modes = INDIO_BUFFER_SOFTWARE | INDIO_BUFFER_TRIGGERED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) struct iio_cb_buffer *iio_channel_get_all_cb(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) int (*cb)(const void *data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) void *private),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) void *private)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) struct iio_cb_buffer *cb_buff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) struct iio_channel *chan;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) cb_buff = kzalloc(sizeof(*cb_buff), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) if (cb_buff == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) return ERR_PTR(-ENOMEM);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) iio_buffer_init(&cb_buff->buffer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) cb_buff->private = private;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) cb_buff->cb = cb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) cb_buff->buffer.access = &iio_cb_access;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) INIT_LIST_HEAD(&cb_buff->buffer.demux_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) cb_buff->channels = iio_channel_get_all(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) if (IS_ERR(cb_buff->channels)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) ret = PTR_ERR(cb_buff->channels);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) goto error_free_cb_buff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) cb_buff->indio_dev = cb_buff->channels[0].indio_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) cb_buff->buffer.scan_mask = bitmap_zalloc(cb_buff->indio_dev->masklength,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) if (cb_buff->buffer.scan_mask == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) ret = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) goto error_release_channels;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) chan = &cb_buff->channels[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) while (chan->indio_dev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) if (chan->indio_dev != cb_buff->indio_dev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) goto error_free_scan_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) set_bit(chan->channel->scan_index,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) cb_buff->buffer.scan_mask);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) chan++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) return cb_buff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) error_free_scan_mask:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) bitmap_free(cb_buff->buffer.scan_mask);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) error_release_channels:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) iio_channel_release_all(cb_buff->channels);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) error_free_cb_buff:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) kfree(cb_buff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) return ERR_PTR(ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) EXPORT_SYMBOL_GPL(iio_channel_get_all_cb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) int iio_channel_cb_set_buffer_watermark(struct iio_cb_buffer *cb_buff,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) size_t watermark)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) if (!watermark)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) cb_buff->buffer.watermark = watermark;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) EXPORT_SYMBOL_GPL(iio_channel_cb_set_buffer_watermark);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) int iio_channel_start_all_cb(struct iio_cb_buffer *cb_buff)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) return iio_update_buffers(cb_buff->indio_dev, &cb_buff->buffer,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) EXPORT_SYMBOL_GPL(iio_channel_start_all_cb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) void iio_channel_stop_all_cb(struct iio_cb_buffer *cb_buff)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) iio_update_buffers(cb_buff->indio_dev, NULL, &cb_buff->buffer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) EXPORT_SYMBOL_GPL(iio_channel_stop_all_cb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) void iio_channel_release_all_cb(struct iio_cb_buffer *cb_buff)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) iio_channel_release_all(cb_buff->channels);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) iio_buffer_put(&cb_buff->buffer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) EXPORT_SYMBOL_GPL(iio_channel_release_all_cb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) struct iio_channel
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) *iio_channel_cb_get_channels(const struct iio_cb_buffer *cb_buffer)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) return cb_buffer->channels;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) EXPORT_SYMBOL_GPL(iio_channel_cb_get_channels);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) struct iio_dev
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) *iio_channel_cb_get_iio_dev(const struct iio_cb_buffer *cb_buffer)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) return cb_buffer->indio_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) EXPORT_SYMBOL_GPL(iio_channel_cb_get_iio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) MODULE_AUTHOR("Jonathan Cameron <jic23@kernel.org>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) MODULE_DESCRIPTION("Industrial I/O callback buffer");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) MODULE_LICENSE("GPL");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags