Merge git://git.kernel.org/pub/scm/linux/kernel/git/davem/net
[deliverable/linux.git] / drivers / iio / industrialio-buffer.c
CommitLineData
7026ea4b
JC
1/* The industrial I/O core
2 *
3 * Copyright (c) 2008 Jonathan Cameron
4 *
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of the GNU General Public License version 2 as published by
7 * the Free Software Foundation.
8 *
14555b14 9 * Handling of buffer allocation / resizing.
7026ea4b
JC
10 *
11 *
12 * Things to look at here.
13 * - Better memory allocation techniques?
14 * - Alternative access techniques?
15 */
16#include <linux/kernel.h>
8e336a72 17#include <linux/export.h>
7026ea4b 18#include <linux/device.h>
7026ea4b 19#include <linux/fs.h>
7026ea4b 20#include <linux/cdev.h>
5a0e3ad6 21#include <linux/slab.h>
a7348347 22#include <linux/poll.h>
7026ea4b 23
06458e27 24#include <linux/iio/iio.h>
df9c1c42 25#include "iio_core.h"
06458e27
JC
26#include <linux/iio/sysfs.h>
27#include <linux/iio/buffer.h>
7026ea4b 28
8310b86c
JC
29static const char * const iio_endian_prefix[] = {
30 [IIO_BE] = "be",
31 [IIO_LE] = "le",
32};
7026ea4b
JC
33
34/**
14555b14 35 * iio_buffer_read_first_n_outer() - chrdev read for buffer access
7026ea4b 36 *
14555b14
JC
37 * This function relies on all buffer implementations having an
38 * iio_buffer as their first element.
7026ea4b 39 **/
14555b14
JC
40ssize_t iio_buffer_read_first_n_outer(struct file *filp, char __user *buf,
41 size_t n, loff_t *f_ps)
7026ea4b 42{
1aa04278 43 struct iio_dev *indio_dev = filp->private_data;
14555b14 44 struct iio_buffer *rb = indio_dev->buffer;
d5857d65 45
96e00f11 46 if (!rb || !rb->access->read_first_n)
7026ea4b 47 return -EINVAL;
8d213f24 48 return rb->access->read_first_n(rb, n, buf);
7026ea4b
JC
49}
50
a7348347 51/**
14555b14 52 * iio_buffer_poll() - poll the buffer to find out if it has data
a7348347 53 */
14555b14
JC
54unsigned int iio_buffer_poll(struct file *filp,
55 struct poll_table_struct *wait)
a7348347 56{
1aa04278 57 struct iio_dev *indio_dev = filp->private_data;
14555b14 58 struct iio_buffer *rb = indio_dev->buffer;
a7348347
JC
59
60 poll_wait(filp, &rb->pollq, wait);
61 if (rb->stufftoread)
62 return POLLIN | POLLRDNORM;
63 /* need a way of knowing if there may be enough data... */
8d213f24 64 return 0;
a7348347
JC
65}
66
f79a9098 67void iio_buffer_init(struct iio_buffer *buffer)
7026ea4b 68{
5ada4ea9 69 INIT_LIST_HEAD(&buffer->demux_list);
14555b14 70 init_waitqueue_head(&buffer->pollq);
7026ea4b 71}
14555b14 72EXPORT_SYMBOL(iio_buffer_init);
7026ea4b 73
1d892719 74static ssize_t iio_show_scan_index(struct device *dev,
8d213f24
JC
75 struct device_attribute *attr,
76 char *buf)
1d892719 77{
8d213f24 78 return sprintf(buf, "%u\n", to_iio_dev_attr(attr)->c->scan_index);
1d892719
JC
79}
80
81static ssize_t iio_show_fixed_type(struct device *dev,
82 struct device_attribute *attr,
83 char *buf)
84{
85 struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
8310b86c
JC
86 u8 type = this_attr->c->scan_type.endianness;
87
88 if (type == IIO_CPU) {
9d5d1153
JC
89#ifdef __LITTLE_ENDIAN
90 type = IIO_LE;
91#else
92 type = IIO_BE;
93#endif
8310b86c
JC
94 }
95 return sprintf(buf, "%s:%c%d/%d>>%u\n",
96 iio_endian_prefix[type],
1d892719
JC
97 this_attr->c->scan_type.sign,
98 this_attr->c->scan_type.realbits,
99 this_attr->c->scan_type.storagebits,
100 this_attr->c->scan_type.shift);
101}
102
8d213f24
JC
103static ssize_t iio_scan_el_show(struct device *dev,
104 struct device_attribute *attr,
105 char *buf)
106{
107 int ret;
e53f5ac5 108 struct iio_dev *indio_dev = dev_to_iio_dev(dev);
8d213f24 109
5ada4ea9
JC
110 ret = test_bit(to_iio_dev_attr(attr)->address,
111 indio_dev->buffer->scan_mask);
112
8d213f24
JC
113 return sprintf(buf, "%d\n", ret);
114}
115
14555b14 116static int iio_scan_mask_clear(struct iio_buffer *buffer, int bit)
8d213f24 117{
14555b14 118 clear_bit(bit, buffer->scan_mask);
8d213f24
JC
119 return 0;
120}
121
122static ssize_t iio_scan_el_store(struct device *dev,
123 struct device_attribute *attr,
124 const char *buf,
125 size_t len)
126{
a714af27 127 int ret;
8d213f24 128 bool state;
e53f5ac5 129 struct iio_dev *indio_dev = dev_to_iio_dev(dev);
14555b14 130 struct iio_buffer *buffer = indio_dev->buffer;
8d213f24
JC
131 struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
132
a714af27
JC
133 ret = strtobool(buf, &state);
134 if (ret < 0)
135 return ret;
8d213f24 136 mutex_lock(&indio_dev->mlock);
5fd6218c 137 if (iio_buffer_enabled(indio_dev)) {
8d213f24
JC
138 ret = -EBUSY;
139 goto error_ret;
140 }
f79a9098 141 ret = iio_scan_mask_query(indio_dev, buffer, this_attr->address);
8d213f24
JC
142 if (ret < 0)
143 goto error_ret;
144 if (!state && ret) {
14555b14 145 ret = iio_scan_mask_clear(buffer, this_attr->address);
8d213f24
JC
146 if (ret)
147 goto error_ret;
148 } else if (state && !ret) {
f79a9098 149 ret = iio_scan_mask_set(indio_dev, buffer, this_attr->address);
8d213f24
JC
150 if (ret)
151 goto error_ret;
152 }
153
154error_ret:
155 mutex_unlock(&indio_dev->mlock);
156
5a2a6e11 157 return ret < 0 ? ret : len;
8d213f24
JC
158
159}
160
161static ssize_t iio_scan_el_ts_show(struct device *dev,
162 struct device_attribute *attr,
163 char *buf)
164{
e53f5ac5 165 struct iio_dev *indio_dev = dev_to_iio_dev(dev);
f8c6f4e9 166 return sprintf(buf, "%d\n", indio_dev->buffer->scan_timestamp);
8d213f24
JC
167}
168
169static ssize_t iio_scan_el_ts_store(struct device *dev,
170 struct device_attribute *attr,
171 const char *buf,
172 size_t len)
173{
a714af27 174 int ret;
e53f5ac5 175 struct iio_dev *indio_dev = dev_to_iio_dev(dev);
8d213f24 176 bool state;
1aa04278 177
a714af27
JC
178 ret = strtobool(buf, &state);
179 if (ret < 0)
180 return ret;
181
8d213f24 182 mutex_lock(&indio_dev->mlock);
5fd6218c 183 if (iio_buffer_enabled(indio_dev)) {
8d213f24
JC
184 ret = -EBUSY;
185 goto error_ret;
186 }
14555b14 187 indio_dev->buffer->scan_timestamp = state;
fd6487f8 188 indio_dev->scan_timestamp = state;
8d213f24
JC
189error_ret:
190 mutex_unlock(&indio_dev->mlock);
191
192 return ret ? ret : len;
193}
194
14555b14
JC
195static int iio_buffer_add_channel_sysfs(struct iio_dev *indio_dev,
196 const struct iio_chan_spec *chan)
1d892719 197{
26d25ae3 198 int ret, attrcount = 0;
14555b14 199 struct iio_buffer *buffer = indio_dev->buffer;
1d892719 200
26d25ae3 201 ret = __iio_add_chan_devattr("index",
1d892719
JC
202 chan,
203 &iio_show_scan_index,
204 NULL,
205 0,
206 0,
1aa04278 207 &indio_dev->dev,
14555b14 208 &buffer->scan_el_dev_attr_list);
1d892719
JC
209 if (ret)
210 goto error_ret;
26d25ae3
JC
211 attrcount++;
212 ret = __iio_add_chan_devattr("type",
1d892719
JC
213 chan,
214 &iio_show_fixed_type,
215 NULL,
216 0,
217 0,
1aa04278 218 &indio_dev->dev,
14555b14 219 &buffer->scan_el_dev_attr_list);
1d892719
JC
220 if (ret)
221 goto error_ret;
26d25ae3 222 attrcount++;
a88b3ebc 223 if (chan->type != IIO_TIMESTAMP)
26d25ae3 224 ret = __iio_add_chan_devattr("en",
a88b3ebc
JC
225 chan,
226 &iio_scan_el_show,
227 &iio_scan_el_store,
228 chan->scan_index,
229 0,
1aa04278 230 &indio_dev->dev,
14555b14 231 &buffer->scan_el_dev_attr_list);
a88b3ebc 232 else
26d25ae3 233 ret = __iio_add_chan_devattr("en",
a88b3ebc
JC
234 chan,
235 &iio_scan_el_ts_show,
236 &iio_scan_el_ts_store,
237 chan->scan_index,
238 0,
1aa04278 239 &indio_dev->dev,
14555b14 240 &buffer->scan_el_dev_attr_list);
26d25ae3
JC
241 attrcount++;
242 ret = attrcount;
1d892719
JC
243error_ret:
244 return ret;
245}
246
14555b14
JC
247static void iio_buffer_remove_and_free_scan_dev_attr(struct iio_dev *indio_dev,
248 struct iio_dev_attr *p)
1d892719 249{
1d892719
JC
250 kfree(p->dev_attr.attr.name);
251 kfree(p);
252}
253
14555b14 254static void __iio_buffer_attr_cleanup(struct iio_dev *indio_dev)
1d892719
JC
255{
256 struct iio_dev_attr *p, *n;
14555b14 257 struct iio_buffer *buffer = indio_dev->buffer;
26d25ae3 258
1d892719 259 list_for_each_entry_safe(p, n,
14555b14
JC
260 &buffer->scan_el_dev_attr_list, l)
261 iio_buffer_remove_and_free_scan_dev_attr(indio_dev, p);
1d892719
JC
262}
263
26d25ae3
JC
264static const char * const iio_scan_elements_group_name = "scan_elements";
265
14555b14
JC
266int iio_buffer_register(struct iio_dev *indio_dev,
267 const struct iio_chan_spec *channels,
268 int num_channels)
1d892719 269{
26d25ae3
JC
270 struct iio_dev_attr *p;
271 struct attribute **attr;
14555b14 272 struct iio_buffer *buffer = indio_dev->buffer;
26d25ae3
JC
273 int ret, i, attrn, attrcount, attrcount_orig = 0;
274
14555b14
JC
275 if (buffer->attrs)
276 indio_dev->groups[indio_dev->groupcounter++] = buffer->attrs;
bf32963c 277
14555b14
JC
278 if (buffer->scan_el_attrs != NULL) {
279 attr = buffer->scan_el_attrs->attrs;
26d25ae3
JC
280 while (*attr++ != NULL)
281 attrcount_orig++;
282 }
283 attrcount = attrcount_orig;
14555b14 284 INIT_LIST_HEAD(&buffer->scan_el_dev_attr_list);
1d892719
JC
285 if (channels) {
286 /* new magic */
287 for (i = 0; i < num_channels; i++) {
f5b81ddd
LPC
288 if (channels[i].scan_index < 0)
289 continue;
290
32b5eeca
JC
291 /* Establish necessary mask length */
292 if (channels[i].scan_index >
293 (int)indio_dev->masklength - 1)
294 indio_dev->masklength
e1dc7bee 295 = channels[i].scan_index + 1;
32b5eeca 296
14555b14 297 ret = iio_buffer_add_channel_sysfs(indio_dev,
1aa04278 298 &channels[i]);
1d892719 299 if (ret < 0)
26d25ae3
JC
300 goto error_cleanup_dynamic;
301 attrcount += ret;
beb80600 302 if (channels[i].type == IIO_TIMESTAMP)
f1264809 303 indio_dev->scan_index_timestamp =
beb80600 304 channels[i].scan_index;
1d892719 305 }
14555b14 306 if (indio_dev->masklength && buffer->scan_mask == NULL) {
d83fb184
TM
307 buffer->scan_mask = kcalloc(BITS_TO_LONGS(indio_dev->masklength),
308 sizeof(*buffer->scan_mask),
309 GFP_KERNEL);
14555b14 310 if (buffer->scan_mask == NULL) {
32b5eeca 311 ret = -ENOMEM;
26d25ae3 312 goto error_cleanup_dynamic;
32b5eeca
JC
313 }
314 }
1d892719
JC
315 }
316
14555b14 317 buffer->scan_el_group.name = iio_scan_elements_group_name;
26d25ae3 318
d83fb184
TM
319 buffer->scan_el_group.attrs = kcalloc(attrcount + 1,
320 sizeof(buffer->scan_el_group.attrs[0]),
321 GFP_KERNEL);
14555b14 322 if (buffer->scan_el_group.attrs == NULL) {
26d25ae3
JC
323 ret = -ENOMEM;
324 goto error_free_scan_mask;
325 }
14555b14
JC
326 if (buffer->scan_el_attrs)
327 memcpy(buffer->scan_el_group.attrs, buffer->scan_el_attrs,
328 sizeof(buffer->scan_el_group.attrs[0])*attrcount_orig);
26d25ae3
JC
329 attrn = attrcount_orig;
330
14555b14
JC
331 list_for_each_entry(p, &buffer->scan_el_dev_attr_list, l)
332 buffer->scan_el_group.attrs[attrn++] = &p->dev_attr.attr;
333 indio_dev->groups[indio_dev->groupcounter++] = &buffer->scan_el_group;
26d25ae3 334
1d892719 335 return 0;
26d25ae3
JC
336
337error_free_scan_mask:
14555b14 338 kfree(buffer->scan_mask);
1d892719 339error_cleanup_dynamic:
14555b14 340 __iio_buffer_attr_cleanup(indio_dev);
26d25ae3 341
7026ea4b
JC
342 return ret;
343}
14555b14 344EXPORT_SYMBOL(iio_buffer_register);
1d892719 345
14555b14 346void iio_buffer_unregister(struct iio_dev *indio_dev)
7026ea4b 347{
14555b14
JC
348 kfree(indio_dev->buffer->scan_mask);
349 kfree(indio_dev->buffer->scan_el_group.attrs);
350 __iio_buffer_attr_cleanup(indio_dev);
7026ea4b 351}
14555b14 352EXPORT_SYMBOL(iio_buffer_unregister);
7026ea4b 353
14555b14
JC
354ssize_t iio_buffer_read_length(struct device *dev,
355 struct device_attribute *attr,
356 char *buf)
7026ea4b 357{
e53f5ac5 358 struct iio_dev *indio_dev = dev_to_iio_dev(dev);
14555b14 359 struct iio_buffer *buffer = indio_dev->buffer;
7026ea4b 360
14555b14 361 if (buffer->access->get_length)
8d213f24 362 return sprintf(buf, "%d\n",
14555b14 363 buffer->access->get_length(buffer));
7026ea4b 364
8d213f24 365 return 0;
7026ea4b 366}
14555b14 367EXPORT_SYMBOL(iio_buffer_read_length);
7026ea4b 368
14555b14
JC
369ssize_t iio_buffer_write_length(struct device *dev,
370 struct device_attribute *attr,
371 const char *buf,
372 size_t len)
7026ea4b
JC
373{
374 int ret;
375 ulong val;
e53f5ac5 376 struct iio_dev *indio_dev = dev_to_iio_dev(dev);
14555b14 377 struct iio_buffer *buffer = indio_dev->buffer;
8d213f24 378
7026ea4b
JC
379 ret = strict_strtoul(buf, 10, &val);
380 if (ret)
381 return ret;
382
14555b14
JC
383 if (buffer->access->get_length)
384 if (val == buffer->access->get_length(buffer))
7026ea4b
JC
385 return len;
386
e38c79e0
LPC
387 mutex_lock(&indio_dev->mlock);
388 if (iio_buffer_enabled(indio_dev)) {
389 ret = -EBUSY;
390 } else {
869871b5 391 if (buffer->access->set_length)
e38c79e0 392 buffer->access->set_length(buffer, val);
e38c79e0 393 ret = 0;
7026ea4b 394 }
e38c79e0 395 mutex_unlock(&indio_dev->mlock);
7026ea4b 396
e38c79e0 397 return ret ? ret : len;
7026ea4b 398}
14555b14 399EXPORT_SYMBOL(iio_buffer_write_length);
7026ea4b 400
14555b14
JC
401ssize_t iio_buffer_store_enable(struct device *dev,
402 struct device_attribute *attr,
403 const char *buf,
404 size_t len)
7026ea4b
JC
405{
406 int ret;
407 bool requested_state, current_state;
408 int previous_mode;
e53f5ac5 409 struct iio_dev *indio_dev = dev_to_iio_dev(dev);
f8c6f4e9 410 struct iio_buffer *buffer = indio_dev->buffer;
7026ea4b 411
f8c6f4e9
JC
412 mutex_lock(&indio_dev->mlock);
413 previous_mode = indio_dev->currentmode;
7026ea4b 414 requested_state = !(buf[0] == '0');
d4a6882e 415 current_state = iio_buffer_enabled(indio_dev);
7026ea4b 416 if (current_state == requested_state) {
14555b14 417 printk(KERN_INFO "iio-buffer, current state requested again\n");
7026ea4b
JC
418 goto done;
419 }
420 if (requested_state) {
1612244f
JC
421 if (indio_dev->setup_ops->preenable) {
422 ret = indio_dev->setup_ops->preenable(indio_dev);
7026ea4b
JC
423 if (ret) {
424 printk(KERN_ERR
99698b45 425 "Buffer not started: "
14555b14 426 "buffer preenable failed\n");
7026ea4b
JC
427 goto error_ret;
428 }
429 }
14555b14
JC
430 if (buffer->access->request_update) {
431 ret = buffer->access->request_update(buffer);
7026ea4b
JC
432 if (ret) {
433 printk(KERN_INFO
99698b45 434 "Buffer not started: "
14555b14 435 "buffer parameter update failed\n");
7026ea4b
JC
436 goto error_ret;
437 }
438 }
99698b45 439 /* Definitely possible for devices to support both of these. */
f8c6f4e9
JC
440 if (indio_dev->modes & INDIO_BUFFER_TRIGGERED) {
441 if (!indio_dev->trig) {
7026ea4b
JC
442 printk(KERN_INFO
443 "Buffer not started: no trigger\n");
444 ret = -EINVAL;
7026ea4b
JC
445 goto error_ret;
446 }
f8c6f4e9
JC
447 indio_dev->currentmode = INDIO_BUFFER_TRIGGERED;
448 } else if (indio_dev->modes & INDIO_BUFFER_HARDWARE)
449 indio_dev->currentmode = INDIO_BUFFER_HARDWARE;
7026ea4b
JC
450 else { /* should never be reached */
451 ret = -EINVAL;
452 goto error_ret;
453 }
454
1612244f
JC
455 if (indio_dev->setup_ops->postenable) {
456 ret = indio_dev->setup_ops->postenable(indio_dev);
7026ea4b
JC
457 if (ret) {
458 printk(KERN_INFO
99698b45 459 "Buffer not started: "
7026ea4b 460 "postenable failed\n");
f8c6f4e9 461 indio_dev->currentmode = previous_mode;
1612244f
JC
462 if (indio_dev->setup_ops->postdisable)
463 indio_dev->setup_ops->
f8c6f4e9 464 postdisable(indio_dev);
7026ea4b
JC
465 goto error_ret;
466 }
467 }
468 } else {
1612244f
JC
469 if (indio_dev->setup_ops->predisable) {
470 ret = indio_dev->setup_ops->predisable(indio_dev);
7026ea4b
JC
471 if (ret)
472 goto error_ret;
473 }
f8c6f4e9 474 indio_dev->currentmode = INDIO_DIRECT_MODE;
1612244f
JC
475 if (indio_dev->setup_ops->postdisable) {
476 ret = indio_dev->setup_ops->postdisable(indio_dev);
7026ea4b
JC
477 if (ret)
478 goto error_ret;
479 }
480 }
481done:
f8c6f4e9 482 mutex_unlock(&indio_dev->mlock);
7026ea4b
JC
483 return len;
484
485error_ret:
f8c6f4e9 486 mutex_unlock(&indio_dev->mlock);
7026ea4b
JC
487 return ret;
488}
14555b14 489EXPORT_SYMBOL(iio_buffer_store_enable);
8d213f24 490
14555b14
JC
491ssize_t iio_buffer_show_enable(struct device *dev,
492 struct device_attribute *attr,
493 char *buf)
7026ea4b 494{
e53f5ac5 495 struct iio_dev *indio_dev = dev_to_iio_dev(dev);
d4a6882e 496 return sprintf(buf, "%d\n", iio_buffer_enabled(indio_dev));
7026ea4b 497}
14555b14 498EXPORT_SYMBOL(iio_buffer_show_enable);
7026ea4b 499
32b5eeca 500/* note NULL used as error indicator as it doesn't make sense. */
cd4361c7 501static const unsigned long *iio_scan_mask_match(const unsigned long *av_masks,
32b5eeca 502 unsigned int masklength,
cd4361c7 503 const unsigned long *mask)
32b5eeca
JC
504{
505 if (bitmap_empty(mask, masklength))
506 return NULL;
507 while (*av_masks) {
508 if (bitmap_subset(mask, av_masks, masklength))
509 return av_masks;
510 av_masks += BITS_TO_LONGS(masklength);
511 }
512 return NULL;
513}
514
6b3b58ed
JC
515static int iio_compute_scan_bytes(struct iio_dev *indio_dev, const long *mask,
516 bool timestamp)
959d2952 517{
959d2952
JC
518 const struct iio_chan_spec *ch;
519 unsigned bytes = 0;
520 int length, i;
959d2952
JC
521
522 /* How much space will the demuxed element take? */
6b3b58ed 523 for_each_set_bit(i, mask,
959d2952
JC
524 indio_dev->masklength) {
525 ch = iio_find_channel_from_si(indio_dev, i);
6b3b58ed 526 length = ch->scan_type.storagebits / 8;
959d2952
JC
527 bytes = ALIGN(bytes, length);
528 bytes += length;
529 }
6b3b58ed 530 if (timestamp) {
959d2952 531 ch = iio_find_channel_from_si(indio_dev,
f1264809 532 indio_dev->scan_index_timestamp);
6b3b58ed 533 length = ch->scan_type.storagebits / 8;
959d2952
JC
534 bytes = ALIGN(bytes, length);
535 bytes += length;
536 }
6b3b58ed
JC
537 return bytes;
538}
539
540int iio_sw_buffer_preenable(struct iio_dev *indio_dev)
541{
542 struct iio_buffer *buffer = indio_dev->buffer;
6b3b58ed
JC
543 dev_dbg(&indio_dev->dev, "%s\n", __func__);
544
545 /* How much space will the demuxed element take? */
420fe2e9
JC
546 indio_dev->scan_bytes =
547 iio_compute_scan_bytes(indio_dev, buffer->scan_mask,
6b3b58ed 548 buffer->scan_timestamp);
420fe2e9 549 buffer->access->set_bytes_per_datum(buffer, indio_dev->scan_bytes);
959d2952
JC
550
551 /* What scan mask do we actually have ?*/
552 if (indio_dev->available_scan_masks)
553 indio_dev->active_scan_mask =
554 iio_scan_mask_match(indio_dev->available_scan_masks,
555 indio_dev->masklength,
556 buffer->scan_mask);
557 else
558 indio_dev->active_scan_mask = buffer->scan_mask;
aff1eb4e
LPC
559
560 if (indio_dev->active_scan_mask == NULL)
561 return -EINVAL;
562
5ada4ea9
JC
563 iio_update_demux(indio_dev);
564
565 if (indio_dev->info->update_scan_mode)
566 return indio_dev->info
567 ->update_scan_mode(indio_dev,
568 indio_dev->active_scan_mask);
959d2952
JC
569 return 0;
570}
571EXPORT_SYMBOL(iio_sw_buffer_preenable);
572
81636632
LPC
573/**
574 * iio_validate_scan_mask_onehot() - Validates that exactly one channel is selected
575 * @indio_dev: the iio device
576 * @mask: scan mask to be checked
577 *
578 * Return true if exactly one bit is set in the scan mask, false otherwise. It
579 * can be used for devices where only one channel can be active for sampling at
580 * a time.
581 */
582bool iio_validate_scan_mask_onehot(struct iio_dev *indio_dev,
583 const unsigned long *mask)
584{
585 return bitmap_weight(mask, indio_dev->masklength) == 1;
586}
587EXPORT_SYMBOL_GPL(iio_validate_scan_mask_onehot);
588
939546d1
LPC
589static bool iio_validate_scan_mask(struct iio_dev *indio_dev,
590 const unsigned long *mask)
591{
592 if (!indio_dev->setup_ops->validate_scan_mask)
593 return true;
594
595 return indio_dev->setup_ops->validate_scan_mask(indio_dev, mask);
596}
597
32b5eeca
JC
598/**
599 * iio_scan_mask_set() - set particular bit in the scan mask
14555b14 600 * @buffer: the buffer whose scan mask we are interested in
32b5eeca
JC
601 * @bit: the bit to be set.
602 **/
f79a9098
JC
603int iio_scan_mask_set(struct iio_dev *indio_dev,
604 struct iio_buffer *buffer, int bit)
32b5eeca 605{
cd4361c7 606 const unsigned long *mask;
32b5eeca
JC
607 unsigned long *trialmask;
608
609 trialmask = kmalloc(sizeof(*trialmask)*
f8c6f4e9 610 BITS_TO_LONGS(indio_dev->masklength),
32b5eeca
JC
611 GFP_KERNEL);
612
613 if (trialmask == NULL)
614 return -ENOMEM;
f8c6f4e9 615 if (!indio_dev->masklength) {
14555b14 616 WARN_ON("trying to set scanmask prior to registering buffer\n");
939546d1 617 goto err_invalid_mask;
32b5eeca 618 }
f8c6f4e9 619 bitmap_copy(trialmask, buffer->scan_mask, indio_dev->masklength);
32b5eeca
JC
620 set_bit(bit, trialmask);
621
939546d1
LPC
622 if (!iio_validate_scan_mask(indio_dev, trialmask))
623 goto err_invalid_mask;
624
f8c6f4e9
JC
625 if (indio_dev->available_scan_masks) {
626 mask = iio_scan_mask_match(indio_dev->available_scan_masks,
627 indio_dev->masklength,
32b5eeca 628 trialmask);
939546d1
LPC
629 if (!mask)
630 goto err_invalid_mask;
32b5eeca 631 }
f8c6f4e9 632 bitmap_copy(buffer->scan_mask, trialmask, indio_dev->masklength);
32b5eeca
JC
633
634 kfree(trialmask);
635
636 return 0;
939546d1
LPC
637
638err_invalid_mask:
639 kfree(trialmask);
640 return -EINVAL;
641}
32b5eeca
JC
642EXPORT_SYMBOL_GPL(iio_scan_mask_set);
643
f79a9098
JC
644int iio_scan_mask_query(struct iio_dev *indio_dev,
645 struct iio_buffer *buffer, int bit)
32b5eeca 646{
f8c6f4e9 647 if (bit > indio_dev->masklength)
32b5eeca
JC
648 return -EINVAL;
649
14555b14 650 if (!buffer->scan_mask)
32b5eeca 651 return 0;
32b5eeca 652
5a2a6e11 653 return test_bit(bit, buffer->scan_mask);
32b5eeca
JC
654};
655EXPORT_SYMBOL_GPL(iio_scan_mask_query);
5ada4ea9
JC
656
657/**
658 * struct iio_demux_table() - table describing demux memcpy ops
659 * @from: index to copy from
99698b45 660 * @to: index to copy to
5ada4ea9
JC
661 * @length: how many bytes to copy
662 * @l: list head used for management
663 */
664struct iio_demux_table {
665 unsigned from;
666 unsigned to;
667 unsigned length;
668 struct list_head l;
669};
670
671static unsigned char *iio_demux(struct iio_buffer *buffer,
672 unsigned char *datain)
673{
674 struct iio_demux_table *t;
675
676 if (list_empty(&buffer->demux_list))
677 return datain;
678 list_for_each_entry(t, &buffer->demux_list, l)
679 memcpy(buffer->demux_bounce + t->to,
680 datain + t->from, t->length);
681
682 return buffer->demux_bounce;
683}
684
ce56ade6 685int iio_push_to_buffer(struct iio_buffer *buffer, unsigned char *data)
5ada4ea9
JC
686{
687 unsigned char *dataout = iio_demux(buffer, data);
688
ce56ade6 689 return buffer->access->store_to(buffer, dataout);
5ada4ea9
JC
690}
691EXPORT_SYMBOL_GPL(iio_push_to_buffer);
692
842cd100
JC
693static void iio_buffer_demux_free(struct iio_buffer *buffer)
694{
695 struct iio_demux_table *p, *q;
696 list_for_each_entry_safe(p, q, &buffer->demux_list, l) {
697 list_del(&p->l);
698 kfree(p);
699 }
700}
701
5ada4ea9
JC
702int iio_update_demux(struct iio_dev *indio_dev)
703{
704 const struct iio_chan_spec *ch;
705 struct iio_buffer *buffer = indio_dev->buffer;
706 int ret, in_ind = -1, out_ind, length;
707 unsigned in_loc = 0, out_loc = 0;
842cd100 708 struct iio_demux_table *p;
5ada4ea9
JC
709
710 /* Clear out any old demux */
842cd100 711 iio_buffer_demux_free(buffer);
5ada4ea9
JC
712 kfree(buffer->demux_bounce);
713 buffer->demux_bounce = NULL;
714
715 /* First work out which scan mode we will actually have */
716 if (bitmap_equal(indio_dev->active_scan_mask,
717 buffer->scan_mask,
718 indio_dev->masklength))
719 return 0;
720
721 /* Now we have the two masks, work from least sig and build up sizes */
722 for_each_set_bit(out_ind,
723 indio_dev->active_scan_mask,
724 indio_dev->masklength) {
725 in_ind = find_next_bit(indio_dev->active_scan_mask,
726 indio_dev->masklength,
727 in_ind + 1);
728 while (in_ind != out_ind) {
729 in_ind = find_next_bit(indio_dev->active_scan_mask,
730 indio_dev->masklength,
731 in_ind + 1);
732 ch = iio_find_channel_from_si(indio_dev, in_ind);
733 length = ch->scan_type.storagebits/8;
734 /* Make sure we are aligned */
735 in_loc += length;
736 if (in_loc % length)
737 in_loc += length - in_loc % length;
738 }
739 p = kmalloc(sizeof(*p), GFP_KERNEL);
740 if (p == NULL) {
741 ret = -ENOMEM;
742 goto error_clear_mux_table;
743 }
744 ch = iio_find_channel_from_si(indio_dev, in_ind);
745 length = ch->scan_type.storagebits/8;
746 if (out_loc % length)
747 out_loc += length - out_loc % length;
748 if (in_loc % length)
749 in_loc += length - in_loc % length;
750 p->from = in_loc;
751 p->to = out_loc;
752 p->length = length;
753 list_add_tail(&p->l, &buffer->demux_list);
754 out_loc += length;
755 in_loc += length;
756 }
757 /* Relies on scan_timestamp being last */
758 if (buffer->scan_timestamp) {
759 p = kmalloc(sizeof(*p), GFP_KERNEL);
760 if (p == NULL) {
761 ret = -ENOMEM;
762 goto error_clear_mux_table;
763 }
764 ch = iio_find_channel_from_si(indio_dev,
f1264809 765 indio_dev->scan_index_timestamp);
5ada4ea9
JC
766 length = ch->scan_type.storagebits/8;
767 if (out_loc % length)
768 out_loc += length - out_loc % length;
769 if (in_loc % length)
770 in_loc += length - in_loc % length;
771 p->from = in_loc;
772 p->to = out_loc;
773 p->length = length;
774 list_add_tail(&p->l, &buffer->demux_list);
775 out_loc += length;
776 in_loc += length;
777 }
778 buffer->demux_bounce = kzalloc(out_loc, GFP_KERNEL);
779 if (buffer->demux_bounce == NULL) {
780 ret = -ENOMEM;
781 goto error_clear_mux_table;
782 }
783 return 0;
784
785error_clear_mux_table:
842cd100
JC
786 iio_buffer_demux_free(buffer);
787
5ada4ea9
JC
788 return ret;
789}
790EXPORT_SYMBOL_GPL(iio_update_demux);
This page took 0.361711 seconds and 5 git commands to generate.