19ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron/** 29ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * Copyright (c) 2011 Jonathan Cameron 39ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * 49ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * This program is free software; you can redistribute it and/or modify it 59ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * under the terms of the GNU General Public License version 2 as published by 69ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * the Free Software Foundation. 79ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * 89ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * Buffer handling elements of industrial I/O reference driver. 99ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * Uses the kfifo buffer. 109ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * 119ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * To test without hardware use the sysfs trigger. 129ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron */ 139ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 149ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron#include <linux/kernel.h> 158e336a722bb234f9d7805647e0290f2a397ca04dPaul Gortmaker#include <linux/export.h> 169ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron#include <linux/slab.h> 179ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron#include <linux/interrupt.h> 189ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron#include <linux/irq.h> 199ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron#include <linux/bitmap.h> 209ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 2106458e277eac2b8761b0a04d3c808d57be281a2eJonathan Cameron#include <linux/iio/iio.h> 2206458e277eac2b8761b0a04d3c808d57be281a2eJonathan Cameron#include <linux/iio/trigger_consumer.h> 2306458e277eac2b8761b0a04d3c808d57be281a2eJonathan Cameron#include <linux/iio/kfifo_buf.h> 249ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 259ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron#include "iio_simple_dummy.h" 269ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 279ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron/* Some fake data */ 289ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 299ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameronstatic const s16 fakedata[] = { 309ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron [voltage0] = 7, 319ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron [diffvoltage1m2] = -33, 329ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron [diffvoltage3m4] = -2, 339ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron [accelx] = 344, 349ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron}; 359ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron/** 369ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * iio_simple_dummy_trigger_h() - the trigger handler function 379ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * @irq: the interrupt number 389ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * @p: private data - always a pointer to the poll func. 399ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * 4099de0c2b341fc2d0f41ca9eadaa752c651c06b83Masanari Iida * This is the guts of buffered capture. On a trigger event occurring, 419ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * if the pollfunc is attached then this handler is called as a threaded 429ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * interrupt (and hence may sleep). It is responsible for grabbing data 439ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * from the device and pushing it into the associated buffer. 449ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron */ 459ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameronstatic irqreturn_t iio_simple_dummy_trigger_h(int irq, void *p) 469ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron{ 479ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron struct iio_poll_func *pf = p; 489ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron struct iio_dev *indio_dev = pf->indio_dev; 499ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron int len = 0; 50420fe2e9471518f57a551d2114a54a0aa0c12ea3Jonathan Cameron u16 *data; 51420fe2e9471518f57a551d2114a54a0aa0c12ea3Jonathan Cameron 52420fe2e9471518f57a551d2114a54a0aa0c12ea3Jonathan Cameron data = kmalloc(indio_dev->scan_bytes, GFP_KERNEL); 539ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron if (data == NULL) 54a1bdeefd7bccabb265fa9c74811008a8582c1c7dLars-Peter Clausen goto done; 559ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 56550268ca1111a5b4737f15f7bf646cede9d1f0cdJonathan Cameron if (!bitmap_empty(indio_dev->active_scan_mask, indio_dev->masklength)) { 579ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron /* 589ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * Three common options here: 599ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * hardware scans: certain combinations of channels make 609ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * up a fast read. The capture will consist of all of them. 619ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * Hence we just call the grab data function and fill the 629ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * buffer without processing. 6399de0c2b341fc2d0f41ca9eadaa752c651c06b83Masanari Iida * software scans: can be considered to be random access 649ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * so efficient reading is just a case of minimal bus 659ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * transactions. 669ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * software culled hardware scans: 679ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * occasionally a driver may process the nearest hardware 689ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * scan to avoid storing elements that are not desired. This 6925c38aa3d17d6ccfca225fafce68401908a1ccb4Peter Meerwald * is the fiddliest option by far. 7025c38aa3d17d6ccfca225fafce68401908a1ccb4Peter Meerwald * Here let's pretend we have random access. And the values are 719ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * in the constant table fakedata. 729ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron */ 739ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron int i, j; 744b4c727519b510ab9d9b33de51ea41fc34b9ef27Catalina Mocanu 75550268ca1111a5b4737f15f7bf646cede9d1f0cdJonathan Cameron for (i = 0, j = 0; 76550268ca1111a5b4737f15f7bf646cede9d1f0cdJonathan Cameron i < bitmap_weight(indio_dev->active_scan_mask, 77550268ca1111a5b4737f15f7bf646cede9d1f0cdJonathan Cameron indio_dev->masklength); 78708706ff290545decbb7f43b533cb247e8ff64fdPeter Meerwald i++, j++) { 7984b36ce5f79c01f792c623f14e92ed86cdccb42fJonathan Cameron j = find_next_bit(indio_dev->active_scan_mask, 80708706ff290545decbb7f43b533cb247e8ff64fdPeter Meerwald indio_dev->masklength, j); 81d163a19d915e9bb3dfa01abc251bc4d5395dc118Peter Meerwald /* random access read from the 'device' */ 829ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron data[i] = fakedata[j]; 839ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron len += 2; 849ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron } 859ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron } 8609a799d04eb17e19bbc80cb0e350a3ec89552b01Lars-Peter Clausen 8709a799d04eb17e19bbc80cb0e350a3ec89552b01Lars-Peter Clausen iio_push_to_buffers_with_timestamp(indio_dev, data, iio_get_time_ns()); 889ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 899ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron kfree(data); 909ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 91a1bdeefd7bccabb265fa9c74811008a8582c1c7dLars-Peter Clausendone: 929ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron /* 939ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * Tell the core we are done with this trigger and ready for the 949ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * next one. 959ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron */ 969ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron iio_trigger_notify_done(indio_dev->trig); 979ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 989ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron return IRQ_HANDLED; 999ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron} 1009ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 1019ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameronstatic const struct iio_buffer_setup_ops iio_simple_dummy_buffer_setup_ops = { 1029ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron /* 1039ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * iio_triggered_buffer_postenable: 1049ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * Generic function that simply attaches the pollfunc to the trigger. 1059ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * Replace this to mess with hardware state before we attach the 1069ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * trigger. 1079ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron */ 1089ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron .postenable = &iio_triggered_buffer_postenable, 1099ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron /* 1109ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * iio_triggered_buffer_predisable: 1119ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * Generic function that simple detaches the pollfunc from the trigger. 1129ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * Replace this to put hardware state back again after the trigger is 1139ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * detached but before userspace knows we have disabled the ring. 1149ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron */ 1159ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron .predisable = &iio_triggered_buffer_predisable, 1169ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron}; 1179ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 1183fff22743640637c2b61473d3cc8d7dc2215984fLars-Peter Clausenint iio_simple_dummy_configure_buffer(struct iio_dev *indio_dev, 1193fff22743640637c2b61473d3cc8d7dc2215984fLars-Peter Clausen const struct iio_chan_spec *channels, unsigned int num_channels) 1209ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron{ 1219ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron int ret; 1229ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron struct iio_buffer *buffer; 1239ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 1249ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron /* Allocate a buffer to use - here a kfifo */ 1259ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron buffer = iio_kfifo_allocate(indio_dev); 1269ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron if (buffer == NULL) { 1279ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron ret = -ENOMEM; 1289ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron goto error_ret; 1299ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron } 1309ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 1319e69c935fad9fd5f0550c51e3bd251cd30033136Lars-Peter Clausen iio_device_attach_buffer(indio_dev, buffer); 1329ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 1339ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron /* Enable timestamps by default */ 1349ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron buffer->scan_timestamp = true; 1359ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 1369ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron /* 1379ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * Tell the core what device type specific functions should 1389ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * be run on either side of buffer capture enable / disable. 1399ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron */ 1401612244f8a70dae6a7f266e78c5ba22a3db75780Jonathan Cameron indio_dev->setup_ops = &iio_simple_dummy_buffer_setup_ops; 1419ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 1429ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron /* 1439ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * Configure a polling function. 1449ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * When a trigger event with this polling function connected 1459ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * occurs, this function is run. Typically this grabs data 1469ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * from the device. 1479ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * 148569c4ac21864d9576717650814c6d84fb0c8166aAlexander Stein * NULL for the bottom half. This is normally implemented only if we 1499ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * either want to ping a capture now pin (no sleeping) or grab 1509ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * a timestamp as close as possible to a data ready trigger firing. 1519ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * 1529ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * IRQF_ONESHOT ensures irqs are masked such that only one instance 1539ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * of the handler can run at a time. 1549ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * 1559ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * "iio_simple_dummy_consumer%d" formatting string for the irq 'name' 1569ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * as seen under /proc/interrupts. Remaining parameters as per printk. 1579ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron */ 1589ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron indio_dev->pollfunc = iio_alloc_pollfunc(NULL, 1599ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron &iio_simple_dummy_trigger_h, 1609ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron IRQF_ONESHOT, 1619ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron indio_dev, 1629ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron "iio_simple_dummy_consumer%d", 1639ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron indio_dev->id); 1649ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 1659ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron if (indio_dev->pollfunc == NULL) { 1669ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron ret = -ENOMEM; 1679ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron goto error_free_buffer; 1689ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron } 1699ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 1709ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron /* 1719ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * Notify the core that this device is capable of buffered capture 1729ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * driven by a trigger. 1739ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron */ 1749ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron indio_dev->modes |= INDIO_BUFFER_TRIGGERED; 1753fff22743640637c2b61473d3cc8d7dc2215984fLars-Peter Clausen 1763fff22743640637c2b61473d3cc8d7dc2215984fLars-Peter Clausen ret = iio_buffer_register(indio_dev, channels, num_channels); 1773fff22743640637c2b61473d3cc8d7dc2215984fLars-Peter Clausen if (ret) 1783fff22743640637c2b61473d3cc8d7dc2215984fLars-Peter Clausen goto error_dealloc_pollfunc; 1793fff22743640637c2b61473d3cc8d7dc2215984fLars-Peter Clausen 1809ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron return 0; 1819ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 1823fff22743640637c2b61473d3cc8d7dc2215984fLars-Peter Clausenerror_dealloc_pollfunc: 1833fff22743640637c2b61473d3cc8d7dc2215984fLars-Peter Clausen iio_dealloc_pollfunc(indio_dev->pollfunc); 1849ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameronerror_free_buffer: 1859ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron iio_kfifo_free(indio_dev->buffer); 1869ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameronerror_ret: 1879ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron return ret; 1889ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 1899ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron} 1909ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron 1919ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron/** 1929ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * iio_simple_dummy_unconfigure_buffer() - release buffer resources 1939ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron * @indo_dev: device instance state 1949ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron */ 1959ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameronvoid iio_simple_dummy_unconfigure_buffer(struct iio_dev *indio_dev) 1969ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron{ 1973fff22743640637c2b61473d3cc8d7dc2215984fLars-Peter Clausen iio_buffer_unregister(indio_dev); 1989ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron iio_dealloc_pollfunc(indio_dev->pollfunc); 1999ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron iio_kfifo_free(indio_dev->buffer); 2009ad2e2e1d6506252f31a142a9b04121992af25e3Jonathan Cameron} 201