1d2912cb1SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only 265659a8dSAndy Shevchenko /* 365659a8dSAndy Shevchenko * The industrial I/O core 4a980e046SJonathan Cameron * 5a980e046SJonathan Cameron * Copyright (c) 2008 Jonathan Cameron 6a980e046SJonathan Cameron * 7a980e046SJonathan Cameron * Based on elements of hwmon and input subsystems. 8a980e046SJonathan Cameron */ 9a980e046SJonathan Cameron 103176dd5dSSachin Kamat #define pr_fmt(fmt) "iio-core: " fmt 113176dd5dSSachin Kamat 1205f59abaSAndy Shevchenko #include <linux/anon_inodes.h> 1305f59abaSAndy Shevchenko #include <linux/cdev.h> 1405f59abaSAndy Shevchenko #include <linux/debugfs.h> 1505f59abaSAndy Shevchenko #include <linux/device.h> 1605f59abaSAndy Shevchenko #include <linux/err.h> 1705f59abaSAndy Shevchenko #include <linux/fs.h> 18a980e046SJonathan Cameron #include <linux/idr.h> 19a980e046SJonathan Cameron #include <linux/kdev_t.h> 2005f59abaSAndy Shevchenko #include <linux/kernel.h> 2105f59abaSAndy Shevchenko #include <linux/module.h> 2205f59abaSAndy Shevchenko #include <linux/mutex.h> 23a980e046SJonathan Cameron #include <linux/poll.h> 24fb158971SAndy Shevchenko #include <linux/property.h> 25a980e046SJonathan Cameron #include <linux/sched.h> 26a980e046SJonathan Cameron #include <linux/slab.h> 2705f59abaSAndy Shevchenko #include <linux/wait.h> 2805f59abaSAndy Shevchenko 299e69c935SLars-Peter Clausen #include <linux/iio/buffer.h> 3033dd94cbSJonathan Cameron #include <linux/iio/buffer_impl.h> 3105f59abaSAndy Shevchenko #include <linux/iio/events.h> 3205f59abaSAndy Shevchenko #include <linux/iio/iio-opaque.h> 3305f59abaSAndy Shevchenko #include <linux/iio/iio.h> 3405f59abaSAndy Shevchenko #include <linux/iio/sysfs.h> 3505f59abaSAndy Shevchenko 3605f59abaSAndy Shevchenko #include "iio_core.h" 3705f59abaSAndy Shevchenko #include "iio_core_trigger.h" 38a980e046SJonathan Cameron 39a980e046SJonathan Cameron /* IDA to assign each registered device a unique id */ 40a980e046SJonathan Cameron static DEFINE_IDA(iio_ida); 41a980e046SJonathan Cameron 42a980e046SJonathan Cameron static dev_t iio_devt; 43a980e046SJonathan Cameron 44a980e046SJonathan Cameron #define IIO_DEV_MAX 256 45a980e046SJonathan Cameron struct bus_type iio_bus_type = { 46a980e046SJonathan Cameron .name = "iio", 47a980e046SJonathan Cameron }; 48a980e046SJonathan Cameron EXPORT_SYMBOL(iio_bus_type); 49a980e046SJonathan Cameron 50a980e046SJonathan Cameron static struct dentry *iio_debugfs_dentry; 51a980e046SJonathan Cameron 52a980e046SJonathan Cameron static const char * const iio_direction[] = { 53a980e046SJonathan Cameron [0] = "in", 54a980e046SJonathan Cameron [1] = "out", 55a980e046SJonathan Cameron }; 56a980e046SJonathan Cameron 57a980e046SJonathan Cameron static const char * const iio_chan_type_name_spec[] = { 58a980e046SJonathan Cameron [IIO_VOLTAGE] = "voltage", 59a980e046SJonathan Cameron [IIO_CURRENT] = "current", 60a980e046SJonathan Cameron [IIO_POWER] = "power", 61a980e046SJonathan Cameron [IIO_ACCEL] = "accel", 62a980e046SJonathan Cameron [IIO_ANGL_VEL] = "anglvel", 63a980e046SJonathan Cameron [IIO_MAGN] = "magn", 64a980e046SJonathan Cameron [IIO_LIGHT] = "illuminance", 65a980e046SJonathan Cameron [IIO_INTENSITY] = "intensity", 66a980e046SJonathan Cameron [IIO_PROXIMITY] = "proximity", 67a980e046SJonathan Cameron [IIO_TEMP] = "temp", 68a980e046SJonathan Cameron [IIO_INCLI] = "incli", 69a980e046SJonathan Cameron [IIO_ROT] = "rot", 70a980e046SJonathan Cameron [IIO_ANGL] = "angl", 71a980e046SJonathan Cameron [IIO_TIMESTAMP] = "timestamp", 72a980e046SJonathan Cameron [IIO_CAPACITANCE] = "capacitance", 73a6b12855SMichael Hennerich [IIO_ALTVOLTAGE] = "altvoltage", 7421cd1fabSJon Brenner [IIO_CCT] = "cct", 75c4f0c693SLars-Peter Clausen [IIO_PRESSURE] = "pressure", 76ac216aa2SHarald Geyer [IIO_HUMIDITYRELATIVE] = "humidityrelative", 7755aebeb9SDaniel Baluta [IIO_ACTIVITY] = "activity", 78a88bfe78SIrina Tirdea [IIO_STEPS] = "steps", 7972c66644SIrina Tirdea [IIO_ENERGY] = "energy", 80cc3c9eecSIrina Tirdea [IIO_DISTANCE] = "distance", 815a1a9329SIrina Tirdea [IIO_VELOCITY] = "velocity", 828ff6b3bcSMatt Ranostay [IIO_CONCENTRATION] = "concentration", 83d38d5469SMatt Ranostay [IIO_RESISTANCE] = "resistance", 84ecb3a7ccSMatt Ranostay [IIO_PH] = "ph", 85d409404cSPeter Meerwald-Stadler [IIO_UVINDEX] = "uvindex", 864b9d2090SMatt Ranostay [IIO_ELECTRICALCONDUCTIVITY] = "electricalconductivity", 871a8f324aSWilliam Breathitt Gray [IIO_COUNT] = "count", 881a8f324aSWilliam Breathitt Gray [IIO_INDEX] = "index", 89571299d0SSong Hongyan [IIO_GRAVITY] = "gravity", 903055a6cfSEugen Hristev [IIO_POSITIONRELATIVE] = "positionrelative", 91c73314e6SMathieu Othacehe [IIO_PHASE] = "phase", 9217abc9ecSTomasz Duszynski [IIO_MASSCONCENTRATION] = "massconcentration", 93744f4990SRamona Bolboaca [IIO_DELTA_ANGL] = "deltaangl", 9494a39f2cSRamona Bolboaca [IIO_DELTA_VELOCITY] = "deltavelocity", 9542f31175SBasavaraj Natikar [IIO_COLORTEMP] = "colortemp", 9606790d4cSBasavaraj Natikar [IIO_CHROMATICITY] = "chromaticity", 97a980e046SJonathan Cameron }; 98a980e046SJonathan Cameron 99a980e046SJonathan Cameron static const char * const iio_modifier_names[] = { 100a980e046SJonathan Cameron [IIO_MOD_X] = "x", 101a980e046SJonathan Cameron [IIO_MOD_Y] = "y", 102a980e046SJonathan Cameron [IIO_MOD_Z] = "z", 1034b8d8015SPeter Meerwald [IIO_MOD_X_AND_Y] = "x&y", 1044b8d8015SPeter Meerwald [IIO_MOD_X_AND_Z] = "x&z", 1054b8d8015SPeter Meerwald [IIO_MOD_Y_AND_Z] = "y&z", 1064b8d8015SPeter Meerwald [IIO_MOD_X_AND_Y_AND_Z] = "x&y&z", 1074b8d8015SPeter Meerwald [IIO_MOD_X_OR_Y] = "x|y", 1084b8d8015SPeter Meerwald [IIO_MOD_X_OR_Z] = "x|z", 1094b8d8015SPeter Meerwald [IIO_MOD_Y_OR_Z] = "y|z", 1104b8d8015SPeter Meerwald [IIO_MOD_X_OR_Y_OR_Z] = "x|y|z", 1118f5879b2SJonathan Cameron [IIO_MOD_ROOT_SUM_SQUARED_X_Y] = "sqrt(x^2+y^2)", 112cf82cb81SJonathan Cameron [IIO_MOD_SUM_SQUARED_X_Y_Z] = "x^2+y^2+z^2", 113a980e046SJonathan Cameron [IIO_MOD_LIGHT_BOTH] = "both", 114a980e046SJonathan Cameron [IIO_MOD_LIGHT_IR] = "ir", 11521cd1fabSJon Brenner [IIO_MOD_LIGHT_CLEAR] = "clear", 11621cd1fabSJon Brenner [IIO_MOD_LIGHT_RED] = "red", 11721cd1fabSJon Brenner [IIO_MOD_LIGHT_GREEN] = "green", 11821cd1fabSJon Brenner [IIO_MOD_LIGHT_BLUE] = "blue", 1192c5ff1f9SPeter Meerwald-Stadler [IIO_MOD_LIGHT_UV] = "uv", 120b89710bdSJavier Carrasco [IIO_MOD_LIGHT_UVA] = "uva", 121b89710bdSJavier Carrasco [IIO_MOD_LIGHT_UVB] = "uvb", 122c0e4e0fdSMaxime Roussin-Bélanger [IIO_MOD_LIGHT_DUV] = "duv", 1235082f405SSrinivas Pandruvada [IIO_MOD_QUATERNION] = "quaternion", 124638b43b3SPeter Meerwald [IIO_MOD_TEMP_AMBIENT] = "ambient", 125638b43b3SPeter Meerwald [IIO_MOD_TEMP_OBJECT] = "object", 12611b8ddabSReyad Attiyat [IIO_MOD_NORTH_MAGN] = "from_north_magnetic", 12711b8ddabSReyad Attiyat [IIO_MOD_NORTH_TRUE] = "from_north_true", 12811b8ddabSReyad Attiyat [IIO_MOD_NORTH_MAGN_TILT_COMP] = "from_north_magnetic_tilt_comp", 12911b8ddabSReyad Attiyat [IIO_MOD_NORTH_TRUE_TILT_COMP] = "from_north_true_tilt_comp", 13055aebeb9SDaniel Baluta [IIO_MOD_RUNNING] = "running", 13155aebeb9SDaniel Baluta [IIO_MOD_JOGGING] = "jogging", 13255aebeb9SDaniel Baluta [IIO_MOD_WALKING] = "walking", 13355aebeb9SDaniel Baluta [IIO_MOD_STILL] = "still", 1345a1a9329SIrina Tirdea [IIO_MOD_ROOT_SUM_SQUARED_X_Y_Z] = "sqrt(x^2+y^2+z^2)", 1351ce87f21SLars-Peter Clausen [IIO_MOD_I] = "i", 1361ce87f21SLars-Peter Clausen [IIO_MOD_Q] = "q", 1378ff6b3bcSMatt Ranostay [IIO_MOD_CO2] = "co2", 1388ff6b3bcSMatt Ranostay [IIO_MOD_VOC] = "voc", 13917abc9ecSTomasz Duszynski [IIO_MOD_PM1] = "pm1", 14017abc9ecSTomasz Duszynski [IIO_MOD_PM2P5] = "pm2p5", 14117abc9ecSTomasz Duszynski [IIO_MOD_PM4] = "pm4", 14217abc9ecSTomasz Duszynski [IIO_MOD_PM10] = "pm10", 14325f02d32SMatt Ranostay [IIO_MOD_ETHANOL] = "ethanol", 14425f02d32SMatt Ranostay [IIO_MOD_H2] = "h2", 1454ffa22fdSMatt Ranostay [IIO_MOD_O2] = "o2", 146bcc57a48SAndrea Merello [IIO_MOD_LINEAR_X] = "linear_x", 147bcc57a48SAndrea Merello [IIO_MOD_LINEAR_Y] = "linear_y", 148bcc57a48SAndrea Merello [IIO_MOD_LINEAR_Z] = "linear_z", 149dcedf145SAndrea Merello [IIO_MOD_PITCH] = "pitch", 150dcedf145SAndrea Merello [IIO_MOD_YAW] = "yaw", 151dcedf145SAndrea Merello [IIO_MOD_ROLL] = "roll", 152a980e046SJonathan Cameron }; 153a980e046SJonathan Cameron 154a980e046SJonathan Cameron /* relies on pairs of these shared then separate */ 155a980e046SJonathan Cameron static const char * const iio_chan_info_postfix[] = { 156a980e046SJonathan Cameron [IIO_CHAN_INFO_RAW] = "raw", 157a980e046SJonathan Cameron [IIO_CHAN_INFO_PROCESSED] = "input", 158a980e046SJonathan Cameron [IIO_CHAN_INFO_SCALE] = "scale", 159a980e046SJonathan Cameron [IIO_CHAN_INFO_OFFSET] = "offset", 160a980e046SJonathan Cameron [IIO_CHAN_INFO_CALIBSCALE] = "calibscale", 161a980e046SJonathan Cameron [IIO_CHAN_INFO_CALIBBIAS] = "calibbias", 162a980e046SJonathan Cameron [IIO_CHAN_INFO_PEAK] = "peak_raw", 163a980e046SJonathan Cameron [IIO_CHAN_INFO_PEAK_SCALE] = "peak_scale", 164a980e046SJonathan Cameron [IIO_CHAN_INFO_QUADRATURE_CORRECTION_RAW] = "quadrature_correction_raw", 165a980e046SJonathan Cameron [IIO_CHAN_INFO_AVERAGE_RAW] = "mean_raw", 166a980e046SJonathan Cameron [IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY] 167a980e046SJonathan Cameron = "filter_low_pass_3db_frequency", 1683f7f642bSMartin Fuzzey [IIO_CHAN_INFO_HIGH_PASS_FILTER_3DB_FREQUENCY] 1693f7f642bSMartin Fuzzey = "filter_high_pass_3db_frequency", 170a980e046SJonathan Cameron [IIO_CHAN_INFO_SAMP_FREQ] = "sampling_frequency", 171a6b12855SMichael Hennerich [IIO_CHAN_INFO_FREQUENCY] = "frequency", 172a6b12855SMichael Hennerich [IIO_CHAN_INFO_PHASE] = "phase", 173b65d6212SMichael Hennerich [IIO_CHAN_INFO_HARDWAREGAIN] = "hardwaregain", 1747c9ab035Ssrinivas pandruvada [IIO_CHAN_INFO_HYSTERESIS] = "hysteresis", 1751c71a286SYe Xiang [IIO_CHAN_INFO_HYSTERESIS_RELATIVE] = "hysteresis_relative", 176899d90bdSPeter Meerwald [IIO_CHAN_INFO_INT_TIME] = "integration_time", 177a88bfe78SIrina Tirdea [IIO_CHAN_INFO_ENABLE] = "en", 178bcdf28fbSIrina Tirdea [IIO_CHAN_INFO_CALIBHEIGHT] = "calibheight", 179d37f6836SIrina Tirdea [IIO_CHAN_INFO_CALIBWEIGHT] = "calibweight", 1802f0ecb7cSIrina Tirdea [IIO_CHAN_INFO_DEBOUNCE_COUNT] = "debounce_count", 1812f0ecb7cSIrina Tirdea [IIO_CHAN_INFO_DEBOUNCE_TIME] = "debounce_time", 182c8a85854SVianney le Clément de Saint-Marcq [IIO_CHAN_INFO_CALIBEMISSIVITY] = "calibemissivity", 183faaa4495SIrina Tirdea [IIO_CHAN_INFO_OVERSAMPLING_RATIO] = "oversampling_ratio", 184ddfb97d8SAndrea Merello [IIO_CHAN_INFO_THERMOCOUPLE_TYPE] = "thermocouple_type", 185dde8ceecSCrt Mori [IIO_CHAN_INFO_CALIBAMBIENT] = "calibambient", 1865c64990bSJonathan Cameron [IIO_CHAN_INFO_ZEROPOINT] = "zeropoint", 1875bc2ea60SJavier Carrasco [IIO_CHAN_INFO_TROUGH] = "trough_raw", 188a980e046SJonathan Cameron }; 18915ea2878SJonathan Cameron /** 19015ea2878SJonathan Cameron * iio_device_id() - query the unique ID for the device 19115ea2878SJonathan Cameron * @indio_dev: Device structure whose ID is being queried 19215ea2878SJonathan Cameron * 19315ea2878SJonathan Cameron * The IIO device ID is a unique index used for example for the naming 19465659a8dSAndy Shevchenko * of the character device /dev/iio\:device[ID]. 19565659a8dSAndy Shevchenko * 19665659a8dSAndy Shevchenko * Returns: Unique ID for the device. 19715ea2878SJonathan Cameron */ 19815ea2878SJonathan Cameron int iio_device_id(struct iio_dev *indio_dev) 19915ea2878SJonathan Cameron { 20015ea2878SJonathan Cameron struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 20115ea2878SJonathan Cameron 20215ea2878SJonathan Cameron return iio_dev_opaque->id; 20315ea2878SJonathan Cameron } 20415ea2878SJonathan Cameron EXPORT_SYMBOL_GPL(iio_device_id); 205a980e046SJonathan Cameron 206d9a0e73cSLars-Peter Clausen /** 2072f53b4adSMiquel Raynal * iio_buffer_enabled() - helper function to test if the buffer is enabled 2082f53b4adSMiquel Raynal * @indio_dev: IIO device structure for device 20965659a8dSAndy Shevchenko * 21065659a8dSAndy Shevchenko * Returns: True, if the buffer is enabled. 2112f53b4adSMiquel Raynal */ 2122f53b4adSMiquel Raynal bool iio_buffer_enabled(struct iio_dev *indio_dev) 2132f53b4adSMiquel Raynal { 21451570c9dSMiquel Raynal struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 21551570c9dSMiquel Raynal 216*e7748c17SDavid Lechner return iio_dev_opaque->currentmode & INDIO_ALL_BUFFER_MODES; 2172f53b4adSMiquel Raynal } 2182f53b4adSMiquel Raynal EXPORT_SYMBOL_GPL(iio_buffer_enabled); 2192f53b4adSMiquel Raynal 22096fb1b67SAlexandru Ardelean #if defined(CONFIG_DEBUG_FS) 221c9561fd2SJonathan Cameron /* 22296fb1b67SAlexandru Ardelean * There's also a CONFIG_DEBUG_FS guard in include/linux/iio/iio.h for 22396fb1b67SAlexandru Ardelean * iio_get_debugfs_dentry() to make it inline if CONFIG_DEBUG_FS is undefined 22496fb1b67SAlexandru Ardelean */ 22596fb1b67SAlexandru Ardelean struct dentry *iio_get_debugfs_dentry(struct iio_dev *indio_dev) 22696fb1b67SAlexandru Ardelean { 22796fb1b67SAlexandru Ardelean struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 2289d9ec8d0SJoe Simmons-Talbott 22996fb1b67SAlexandru Ardelean return iio_dev_opaque->debugfs_dentry; 23096fb1b67SAlexandru Ardelean } 23196fb1b67SAlexandru Ardelean EXPORT_SYMBOL_GPL(iio_get_debugfs_dentry); 23296fb1b67SAlexandru Ardelean #endif 23396fb1b67SAlexandru Ardelean 234a7e57dceSSachin Kamat /** 235a7e57dceSSachin Kamat * iio_find_channel_from_si() - get channel from its scan index 236a7e57dceSSachin Kamat * @indio_dev: device 237a7e57dceSSachin Kamat * @si: scan index to match 23865659a8dSAndy Shevchenko * 23965659a8dSAndy Shevchenko * Returns: 24065659a8dSAndy Shevchenko * Constant pointer to iio_chan_spec, if scan index matches, NULL on failure. 241a7e57dceSSachin Kamat */ 242a980e046SJonathan Cameron const struct iio_chan_spec 243a980e046SJonathan Cameron *iio_find_channel_from_si(struct iio_dev *indio_dev, int si) 244a980e046SJonathan Cameron { 245a980e046SJonathan Cameron int i; 246a980e046SJonathan Cameron 247a980e046SJonathan Cameron for (i = 0; i < indio_dev->num_channels; i++) 248a980e046SJonathan Cameron if (indio_dev->channels[i].scan_index == si) 249a980e046SJonathan Cameron return &indio_dev->channels[i]; 250a980e046SJonathan Cameron return NULL; 251a980e046SJonathan Cameron } 252a980e046SJonathan Cameron 253a980e046SJonathan Cameron /* This turns up an awful lot */ 254a980e046SJonathan Cameron ssize_t iio_read_const_attr(struct device *dev, 255a980e046SJonathan Cameron struct device_attribute *attr, 256a980e046SJonathan Cameron char *buf) 257a980e046SJonathan Cameron { 25883ca56b6SLars-Peter Clausen return sysfs_emit(buf, "%s\n", to_iio_const_attr(attr)->string); 259a980e046SJonathan Cameron } 260a980e046SJonathan Cameron EXPORT_SYMBOL(iio_read_const_attr); 261a980e046SJonathan Cameron 26269f0793eSGwendal Grignou /** 26369f0793eSGwendal Grignou * iio_device_set_clock() - Set current timestamping clock for the device 26469f0793eSGwendal Grignou * @indio_dev: IIO device structure containing the device 26565659a8dSAndy Shevchenko * @clock_id: timestamping clock POSIX identifier to set. 26665659a8dSAndy Shevchenko * 26765659a8dSAndy Shevchenko * Returns: 0 on success, or a negative error code. 26869f0793eSGwendal Grignou */ 26969f0793eSGwendal Grignou int iio_device_set_clock(struct iio_dev *indio_dev, clockid_t clock_id) 270bc2b7dabSGregor Boirie { 271bc2b7dabSGregor Boirie int ret; 272fa83c3baSAlexandru Ardelean struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 273fa83c3baSAlexandru Ardelean const struct iio_event_interface *ev_int = iio_dev_opaque->event_interface; 274bc2b7dabSGregor Boirie 27516afe125SNuno Sá ret = mutex_lock_interruptible(&iio_dev_opaque->mlock); 276bc2b7dabSGregor Boirie if (ret) 277bc2b7dabSGregor Boirie return ret; 278bc2b7dabSGregor Boirie if ((ev_int && iio_event_enabled(ev_int)) || 279bc2b7dabSGregor Boirie iio_buffer_enabled(indio_dev)) { 28016afe125SNuno Sá mutex_unlock(&iio_dev_opaque->mlock); 281bc2b7dabSGregor Boirie return -EBUSY; 282bc2b7dabSGregor Boirie } 28362a486c4SJonathan Cameron iio_dev_opaque->clock_id = clock_id; 28416afe125SNuno Sá mutex_unlock(&iio_dev_opaque->mlock); 285bc2b7dabSGregor Boirie 286bc2b7dabSGregor Boirie return 0; 287bc2b7dabSGregor Boirie } 28869f0793eSGwendal Grignou EXPORT_SYMBOL(iio_device_set_clock); 289bc2b7dabSGregor Boirie 290bc2b7dabSGregor Boirie /** 29162a486c4SJonathan Cameron * iio_device_get_clock() - Retrieve current timestamping clock for the device 29262a486c4SJonathan Cameron * @indio_dev: IIO device structure containing the device 29365659a8dSAndy Shevchenko * 29465659a8dSAndy Shevchenko * Returns: Clock ID of the current timestamping clock for the device. 29562a486c4SJonathan Cameron */ 29662a486c4SJonathan Cameron clockid_t iio_device_get_clock(const struct iio_dev *indio_dev) 29762a486c4SJonathan Cameron { 29862a486c4SJonathan Cameron struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 29962a486c4SJonathan Cameron 30062a486c4SJonathan Cameron return iio_dev_opaque->clock_id; 30162a486c4SJonathan Cameron } 30262a486c4SJonathan Cameron EXPORT_SYMBOL(iio_device_get_clock); 30362a486c4SJonathan Cameron 30462a486c4SJonathan Cameron /** 305bc2b7dabSGregor Boirie * iio_get_time_ns() - utility function to get a time stamp for events etc 306bc2b7dabSGregor Boirie * @indio_dev: device 30765659a8dSAndy Shevchenko * 30865659a8dSAndy Shevchenko * Returns: Timestamp of the event in nanoseconds. 309bc2b7dabSGregor Boirie */ 310bc2b7dabSGregor Boirie s64 iio_get_time_ns(const struct iio_dev *indio_dev) 311bc2b7dabSGregor Boirie { 31245e7f5d2SArnd Bergmann struct timespec64 tp; 313bc2b7dabSGregor Boirie 314bc2b7dabSGregor Boirie switch (iio_device_get_clock(indio_dev)) { 315bc2b7dabSGregor Boirie case CLOCK_REALTIME: 31645e7f5d2SArnd Bergmann return ktime_get_real_ns(); 317bc2b7dabSGregor Boirie case CLOCK_MONOTONIC: 31845e7f5d2SArnd Bergmann return ktime_get_ns(); 319bc2b7dabSGregor Boirie case CLOCK_MONOTONIC_RAW: 32045e7f5d2SArnd Bergmann return ktime_get_raw_ns(); 321bc2b7dabSGregor Boirie case CLOCK_REALTIME_COARSE: 32245e7f5d2SArnd Bergmann return ktime_to_ns(ktime_get_coarse_real()); 323bc2b7dabSGregor Boirie case CLOCK_MONOTONIC_COARSE: 32445e7f5d2SArnd Bergmann ktime_get_coarse_ts64(&tp); 32545e7f5d2SArnd Bergmann return timespec64_to_ns(&tp); 326bc2b7dabSGregor Boirie case CLOCK_BOOTTIME: 3279285ec4cSJason A. Donenfeld return ktime_get_boottime_ns(); 328bc2b7dabSGregor Boirie case CLOCK_TAI: 3299285ec4cSJason A. Donenfeld return ktime_get_clocktai_ns(); 330bc2b7dabSGregor Boirie default: 331bc2b7dabSGregor Boirie BUG(); 332bc2b7dabSGregor Boirie } 333bc2b7dabSGregor Boirie } 334bc2b7dabSGregor Boirie EXPORT_SYMBOL(iio_get_time_ns); 335bc2b7dabSGregor Boirie 336a980e046SJonathan Cameron static int __init iio_init(void) 337a980e046SJonathan Cameron { 338a980e046SJonathan Cameron int ret; 339a980e046SJonathan Cameron 340a980e046SJonathan Cameron /* Register sysfs bus */ 341a980e046SJonathan Cameron ret = bus_register(&iio_bus_type); 342a980e046SJonathan Cameron if (ret < 0) { 3433176dd5dSSachin Kamat pr_err("could not register bus type\n"); 344a980e046SJonathan Cameron goto error_nothing; 345a980e046SJonathan Cameron } 346a980e046SJonathan Cameron 347a980e046SJonathan Cameron ret = alloc_chrdev_region(&iio_devt, 0, IIO_DEV_MAX, "iio"); 348a980e046SJonathan Cameron if (ret < 0) { 3493176dd5dSSachin Kamat pr_err("failed to allocate char dev region\n"); 350a980e046SJonathan Cameron goto error_unregister_bus_type; 351a980e046SJonathan Cameron } 352a980e046SJonathan Cameron 353a980e046SJonathan Cameron iio_debugfs_dentry = debugfs_create_dir("iio", NULL); 354a980e046SJonathan Cameron 355a980e046SJonathan Cameron return 0; 356a980e046SJonathan Cameron 357a980e046SJonathan Cameron error_unregister_bus_type: 358a980e046SJonathan Cameron bus_unregister(&iio_bus_type); 359a980e046SJonathan Cameron error_nothing: 360a980e046SJonathan Cameron return ret; 361a980e046SJonathan Cameron } 362a980e046SJonathan Cameron 363a980e046SJonathan Cameron static void __exit iio_exit(void) 364a980e046SJonathan Cameron { 365a980e046SJonathan Cameron if (iio_devt) 366a980e046SJonathan Cameron unregister_chrdev_region(iio_devt, IIO_DEV_MAX); 367a980e046SJonathan Cameron bus_unregister(&iio_bus_type); 368a980e046SJonathan Cameron debugfs_remove(iio_debugfs_dentry); 369a980e046SJonathan Cameron } 370a980e046SJonathan Cameron 371a980e046SJonathan Cameron #if defined(CONFIG_DEBUG_FS) 372a980e046SJonathan Cameron static ssize_t iio_debugfs_read_reg(struct file *file, char __user *userbuf, 373a980e046SJonathan Cameron size_t count, loff_t *ppos) 374a980e046SJonathan Cameron { 375a980e046SJonathan Cameron struct iio_dev *indio_dev = file->private_data; 37696fb1b67SAlexandru Ardelean struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 377abeba59fSJoe Simmons-Talbott unsigned int val = 0; 378a980e046SJonathan Cameron int ret; 379a980e046SJonathan Cameron 3802ddc982aSAlexandru Tachici if (*ppos > 0) 3812ddc982aSAlexandru Tachici return simple_read_from_buffer(userbuf, count, ppos, 38296fb1b67SAlexandru Ardelean iio_dev_opaque->read_buf, 38396fb1b67SAlexandru Ardelean iio_dev_opaque->read_buf_len); 3842ddc982aSAlexandru Tachici 385a980e046SJonathan Cameron ret = indio_dev->info->debugfs_reg_access(indio_dev, 38696fb1b67SAlexandru Ardelean iio_dev_opaque->cached_reg_addr, 387a980e046SJonathan Cameron 0, &val); 3883d62c78aSMatt Fornero if (ret) { 389a980e046SJonathan Cameron dev_err(indio_dev->dev.parent, "%s: read failed\n", __func__); 3903d62c78aSMatt Fornero return ret; 3913d62c78aSMatt Fornero } 392a980e046SJonathan Cameron 39396fb1b67SAlexandru Ardelean iio_dev_opaque->read_buf_len = snprintf(iio_dev_opaque->read_buf, 39496fb1b67SAlexandru Ardelean sizeof(iio_dev_opaque->read_buf), 3952ddc982aSAlexandru Tachici "0x%X\n", val); 396a980e046SJonathan Cameron 3972ddc982aSAlexandru Tachici return simple_read_from_buffer(userbuf, count, ppos, 39896fb1b67SAlexandru Ardelean iio_dev_opaque->read_buf, 39996fb1b67SAlexandru Ardelean iio_dev_opaque->read_buf_len); 400a980e046SJonathan Cameron } 401a980e046SJonathan Cameron 402a980e046SJonathan Cameron static ssize_t iio_debugfs_write_reg(struct file *file, 403a980e046SJonathan Cameron const char __user *userbuf, size_t count, loff_t *ppos) 404a980e046SJonathan Cameron { 405a980e046SJonathan Cameron struct iio_dev *indio_dev = file->private_data; 40696fb1b67SAlexandru Ardelean struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 407abeba59fSJoe Simmons-Talbott unsigned int reg, val; 408a980e046SJonathan Cameron char buf[80]; 409a980e046SJonathan Cameron int ret; 410a980e046SJonathan Cameron 411cb1d1753SAndy Shevchenko count = min(count, sizeof(buf) - 1); 412a980e046SJonathan Cameron if (copy_from_user(buf, userbuf, count)) 413a980e046SJonathan Cameron return -EFAULT; 414a980e046SJonathan Cameron 415a980e046SJonathan Cameron buf[count] = 0; 416a980e046SJonathan Cameron 417a980e046SJonathan Cameron ret = sscanf(buf, "%i %i", ®, &val); 418a980e046SJonathan Cameron 419a980e046SJonathan Cameron switch (ret) { 420a980e046SJonathan Cameron case 1: 42196fb1b67SAlexandru Ardelean iio_dev_opaque->cached_reg_addr = reg; 422a980e046SJonathan Cameron break; 423a980e046SJonathan Cameron case 2: 42496fb1b67SAlexandru Ardelean iio_dev_opaque->cached_reg_addr = reg; 425a980e046SJonathan Cameron ret = indio_dev->info->debugfs_reg_access(indio_dev, reg, 426a980e046SJonathan Cameron val, NULL); 427a980e046SJonathan Cameron if (ret) { 428a980e046SJonathan Cameron dev_err(indio_dev->dev.parent, "%s: write failed\n", 429a980e046SJonathan Cameron __func__); 430a980e046SJonathan Cameron return ret; 431a980e046SJonathan Cameron } 432a980e046SJonathan Cameron break; 433a980e046SJonathan Cameron default: 434a980e046SJonathan Cameron return -EINVAL; 435a980e046SJonathan Cameron } 436a980e046SJonathan Cameron 437a980e046SJonathan Cameron return count; 438a980e046SJonathan Cameron } 439a980e046SJonathan Cameron 440a980e046SJonathan Cameron static const struct file_operations iio_debugfs_reg_fops = { 4415a28c873SAxel Lin .open = simple_open, 442a980e046SJonathan Cameron .read = iio_debugfs_read_reg, 443a980e046SJonathan Cameron .write = iio_debugfs_write_reg, 444a980e046SJonathan Cameron }; 445a980e046SJonathan Cameron 446a980e046SJonathan Cameron static void iio_device_unregister_debugfs(struct iio_dev *indio_dev) 447a980e046SJonathan Cameron { 44896fb1b67SAlexandru Ardelean struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 4499d9ec8d0SJoe Simmons-Talbott 45096fb1b67SAlexandru Ardelean debugfs_remove_recursive(iio_dev_opaque->debugfs_dentry); 451a980e046SJonathan Cameron } 452a980e046SJonathan Cameron 4538915aacaSGreg Kroah-Hartman static void iio_device_register_debugfs(struct iio_dev *indio_dev) 454a980e046SJonathan Cameron { 45596fb1b67SAlexandru Ardelean struct iio_dev_opaque *iio_dev_opaque; 45696fb1b67SAlexandru Ardelean 457a980e046SJonathan Cameron if (indio_dev->info->debugfs_reg_access == NULL) 4588915aacaSGreg Kroah-Hartman return; 459a980e046SJonathan Cameron 460abd5a2fbSAxel Lin if (!iio_debugfs_dentry) 4618915aacaSGreg Kroah-Hartman return; 462a980e046SJonathan Cameron 46396fb1b67SAlexandru Ardelean iio_dev_opaque = to_iio_dev_opaque(indio_dev); 46496fb1b67SAlexandru Ardelean 46596fb1b67SAlexandru Ardelean iio_dev_opaque->debugfs_dentry = 466a980e046SJonathan Cameron debugfs_create_dir(dev_name(&indio_dev->dev), 467a980e046SJonathan Cameron iio_debugfs_dentry); 468a980e046SJonathan Cameron 4698915aacaSGreg Kroah-Hartman debugfs_create_file("direct_reg_access", 0644, 47096fb1b67SAlexandru Ardelean iio_dev_opaque->debugfs_dentry, indio_dev, 4718915aacaSGreg Kroah-Hartman &iio_debugfs_reg_fops); 472a980e046SJonathan Cameron } 473a980e046SJonathan Cameron #else 4748915aacaSGreg Kroah-Hartman static void iio_device_register_debugfs(struct iio_dev *indio_dev) 475a980e046SJonathan Cameron { 476a980e046SJonathan Cameron } 477a980e046SJonathan Cameron 478a980e046SJonathan Cameron static void iio_device_unregister_debugfs(struct iio_dev *indio_dev) 479a980e046SJonathan Cameron { 480a980e046SJonathan Cameron } 481a980e046SJonathan Cameron #endif /* CONFIG_DEBUG_FS */ 482a980e046SJonathan Cameron 483a980e046SJonathan Cameron static ssize_t iio_read_channel_ext_info(struct device *dev, 484a980e046SJonathan Cameron struct device_attribute *attr, 485a980e046SJonathan Cameron char *buf) 486a980e046SJonathan Cameron { 487e53f5ac5SLars-Peter Clausen struct iio_dev *indio_dev = dev_to_iio_dev(dev); 488a980e046SJonathan Cameron struct iio_dev_attr *this_attr = to_iio_dev_attr(attr); 489a980e046SJonathan Cameron const struct iio_chan_spec_ext_info *ext_info; 490a980e046SJonathan Cameron 491a980e046SJonathan Cameron ext_info = &this_attr->c->ext_info[this_attr->address]; 492a980e046SJonathan Cameron 493fc6d1139SMichael Hennerich return ext_info->read(indio_dev, ext_info->private, this_attr->c, buf); 494a980e046SJonathan Cameron } 495a980e046SJonathan Cameron 496a980e046SJonathan Cameron static ssize_t iio_write_channel_ext_info(struct device *dev, 497a980e046SJonathan Cameron struct device_attribute *attr, 498b662f4baSAndy Shevchenko const char *buf, size_t len) 499a980e046SJonathan Cameron { 500e53f5ac5SLars-Peter Clausen struct iio_dev *indio_dev = dev_to_iio_dev(dev); 501a980e046SJonathan Cameron struct iio_dev_attr *this_attr = to_iio_dev_attr(attr); 502a980e046SJonathan Cameron const struct iio_chan_spec_ext_info *ext_info; 503a980e046SJonathan Cameron 504a980e046SJonathan Cameron ext_info = &this_attr->c->ext_info[this_attr->address]; 505a980e046SJonathan Cameron 506fc6d1139SMichael Hennerich return ext_info->write(indio_dev, ext_info->private, 507fc6d1139SMichael Hennerich this_attr->c, buf, len); 508a980e046SJonathan Cameron } 509a980e046SJonathan Cameron 5105212cc8aSLars-Peter Clausen ssize_t iio_enum_available_read(struct iio_dev *indio_dev, 5115212cc8aSLars-Peter Clausen uintptr_t priv, const struct iio_chan_spec *chan, char *buf) 5125212cc8aSLars-Peter Clausen { 5135212cc8aSLars-Peter Clausen const struct iio_enum *e = (const struct iio_enum *)priv; 5145212cc8aSLars-Peter Clausen unsigned int i; 5155212cc8aSLars-Peter Clausen size_t len = 0; 5165212cc8aSLars-Peter Clausen 5175212cc8aSLars-Peter Clausen if (!e->num_items) 5185212cc8aSLars-Peter Clausen return 0; 5195212cc8aSLars-Peter Clausen 520d9a0e73cSLars-Peter Clausen for (i = 0; i < e->num_items; ++i) { 521d9a0e73cSLars-Peter Clausen if (!e->items[i]) 522d9a0e73cSLars-Peter Clausen continue; 5230207483bSLars-Peter Clausen len += sysfs_emit_at(buf, len, "%s ", e->items[i]); 524d9a0e73cSLars-Peter Clausen } 5255212cc8aSLars-Peter Clausen 5265212cc8aSLars-Peter Clausen /* replace last space with a newline */ 5275212cc8aSLars-Peter Clausen buf[len - 1] = '\n'; 5285212cc8aSLars-Peter Clausen 5295212cc8aSLars-Peter Clausen return len; 5305212cc8aSLars-Peter Clausen } 5315212cc8aSLars-Peter Clausen EXPORT_SYMBOL_GPL(iio_enum_available_read); 5325212cc8aSLars-Peter Clausen 5335212cc8aSLars-Peter Clausen ssize_t iio_enum_read(struct iio_dev *indio_dev, 5345212cc8aSLars-Peter Clausen uintptr_t priv, const struct iio_chan_spec *chan, char *buf) 5355212cc8aSLars-Peter Clausen { 5365212cc8aSLars-Peter Clausen const struct iio_enum *e = (const struct iio_enum *)priv; 5375212cc8aSLars-Peter Clausen int i; 5385212cc8aSLars-Peter Clausen 5395212cc8aSLars-Peter Clausen if (!e->get) 5405212cc8aSLars-Peter Clausen return -EINVAL; 5415212cc8aSLars-Peter Clausen 5425212cc8aSLars-Peter Clausen i = e->get(indio_dev, chan); 5435212cc8aSLars-Peter Clausen if (i < 0) 5445212cc8aSLars-Peter Clausen return i; 5451702df5dSAndy Shevchenko if (i >= e->num_items || !e->items[i]) 5465212cc8aSLars-Peter Clausen return -EINVAL; 5475212cc8aSLars-Peter Clausen 54883ca56b6SLars-Peter Clausen return sysfs_emit(buf, "%s\n", e->items[i]); 5495212cc8aSLars-Peter Clausen } 5505212cc8aSLars-Peter Clausen EXPORT_SYMBOL_GPL(iio_enum_read); 5515212cc8aSLars-Peter Clausen 5525212cc8aSLars-Peter Clausen ssize_t iio_enum_write(struct iio_dev *indio_dev, 5535212cc8aSLars-Peter Clausen uintptr_t priv, const struct iio_chan_spec *chan, const char *buf, 5545212cc8aSLars-Peter Clausen size_t len) 5555212cc8aSLars-Peter Clausen { 5565212cc8aSLars-Peter Clausen const struct iio_enum *e = (const struct iio_enum *)priv; 5575212cc8aSLars-Peter Clausen int ret; 5585212cc8aSLars-Peter Clausen 5595212cc8aSLars-Peter Clausen if (!e->set) 5605212cc8aSLars-Peter Clausen return -EINVAL; 5615212cc8aSLars-Peter Clausen 562122fb873SAndy Shevchenko ret = __sysfs_match_string(e->items, e->num_items, buf); 56302e9a0ffSAndy Shevchenko if (ret < 0) 56402e9a0ffSAndy Shevchenko return ret; 5655212cc8aSLars-Peter Clausen 56602e9a0ffSAndy Shevchenko ret = e->set(indio_dev, chan, ret); 5675212cc8aSLars-Peter Clausen return ret ? ret : len; 5685212cc8aSLars-Peter Clausen } 5695212cc8aSLars-Peter Clausen EXPORT_SYMBOL_GPL(iio_enum_write); 5705212cc8aSLars-Peter Clausen 571dfc57732SGregor Boirie static const struct iio_mount_matrix iio_mount_idmatrix = { 572dfc57732SGregor Boirie .rotation = { 573dfc57732SGregor Boirie "1", "0", "0", 574dfc57732SGregor Boirie "0", "1", "0", 575dfc57732SGregor Boirie "0", "0", "1" 576dfc57732SGregor Boirie } 577dfc57732SGregor Boirie }; 578dfc57732SGregor Boirie 579dfc57732SGregor Boirie static int iio_setup_mount_idmatrix(const struct device *dev, 580dfc57732SGregor Boirie struct iio_mount_matrix *matrix) 581dfc57732SGregor Boirie { 582dfc57732SGregor Boirie *matrix = iio_mount_idmatrix; 583dfc57732SGregor Boirie dev_info(dev, "mounting matrix not found: using identity...\n"); 584dfc57732SGregor Boirie return 0; 585dfc57732SGregor Boirie } 586dfc57732SGregor Boirie 587dfc57732SGregor Boirie ssize_t iio_show_mount_matrix(struct iio_dev *indio_dev, uintptr_t priv, 588dfc57732SGregor Boirie const struct iio_chan_spec *chan, char *buf) 589dfc57732SGregor Boirie { 590b662f4baSAndy Shevchenko const struct iio_mount_matrix *mtx; 591dfc57732SGregor Boirie 592b662f4baSAndy Shevchenko mtx = ((iio_get_mount_matrix_t *)priv)(indio_dev, chan); 593dfc57732SGregor Boirie if (IS_ERR(mtx)) 594dfc57732SGregor Boirie return PTR_ERR(mtx); 595dfc57732SGregor Boirie 596dfc57732SGregor Boirie if (!mtx) 597dfc57732SGregor Boirie mtx = &iio_mount_idmatrix; 598dfc57732SGregor Boirie 59983ca56b6SLars-Peter Clausen return sysfs_emit(buf, "%s, %s, %s; %s, %s, %s; %s, %s, %s\n", 600dfc57732SGregor Boirie mtx->rotation[0], mtx->rotation[1], mtx->rotation[2], 601dfc57732SGregor Boirie mtx->rotation[3], mtx->rotation[4], mtx->rotation[5], 602dfc57732SGregor Boirie mtx->rotation[6], mtx->rotation[7], mtx->rotation[8]); 603dfc57732SGregor Boirie } 604dfc57732SGregor Boirie EXPORT_SYMBOL_GPL(iio_show_mount_matrix); 605dfc57732SGregor Boirie 606dfc57732SGregor Boirie /** 607fb158971SAndy Shevchenko * iio_read_mount_matrix() - retrieve iio device mounting matrix from 608fb158971SAndy Shevchenko * device "mount-matrix" property 609dfc57732SGregor Boirie * @dev: device the mounting matrix property is assigned to 610dfc57732SGregor Boirie * @matrix: where to store retrieved matrix 611dfc57732SGregor Boirie * 612dfc57732SGregor Boirie * If device is assigned no mounting matrix property, a default 3x3 identity 613dfc57732SGregor Boirie * matrix will be filled in. 614dfc57732SGregor Boirie * 61565659a8dSAndy Shevchenko * Returns: 0 if success, or a negative error code on failure. 616dfc57732SGregor Boirie */ 617b892770aSAndy Shevchenko int iio_read_mount_matrix(struct device *dev, struct iio_mount_matrix *matrix) 618dfc57732SGregor Boirie { 619fb158971SAndy Shevchenko size_t len = ARRAY_SIZE(iio_mount_idmatrix.rotation); 620fb158971SAndy Shevchenko int err; 621dfc57732SGregor Boirie 622b892770aSAndy Shevchenko err = device_property_read_string_array(dev, "mount-matrix", matrix->rotation, len); 623fb158971SAndy Shevchenko if (err == len) 624dfc57732SGregor Boirie return 0; 625dfc57732SGregor Boirie 626dfc57732SGregor Boirie if (err >= 0) 627dfc57732SGregor Boirie /* Invalid number of matrix entries. */ 628dfc57732SGregor Boirie return -EINVAL; 629dfc57732SGregor Boirie 630dfc57732SGregor Boirie if (err != -EINVAL) 631dfc57732SGregor Boirie /* Invalid matrix declaration format. */ 632dfc57732SGregor Boirie return err; 633dfc57732SGregor Boirie 634dfc57732SGregor Boirie /* Matrix was not declared at all: fallback to identity. */ 635dfc57732SGregor Boirie return iio_setup_mount_idmatrix(dev, matrix); 636dfc57732SGregor Boirie } 637fb158971SAndy Shevchenko EXPORT_SYMBOL(iio_read_mount_matrix); 638dfc57732SGregor Boirie 6396b92ba0aSLars-Peter Clausen static ssize_t __iio_format_value(char *buf, size_t offset, unsigned int type, 64051239600SJonathan Cameron int size, const int *vals) 64151239600SJonathan Cameron { 64251239600SJonathan Cameron int tmp0, tmp1; 6430e7a3978SAnand Ashok Dumbre s64 tmp2; 64451239600SJonathan Cameron bool scale_db = false; 64551239600SJonathan Cameron 64651239600SJonathan Cameron switch (type) { 64751239600SJonathan Cameron case IIO_VAL_INT: 6486b92ba0aSLars-Peter Clausen return sysfs_emit_at(buf, offset, "%d", vals[0]); 64951239600SJonathan Cameron case IIO_VAL_INT_PLUS_MICRO_DB: 65051239600SJonathan Cameron scale_db = true; 651df561f66SGustavo A. R. Silva fallthrough; 65251239600SJonathan Cameron case IIO_VAL_INT_PLUS_MICRO: 65351239600SJonathan Cameron if (vals[1] < 0) 6546b92ba0aSLars-Peter Clausen return sysfs_emit_at(buf, offset, "-%d.%06u%s", 6556b92ba0aSLars-Peter Clausen abs(vals[0]), -vals[1], 65651239600SJonathan Cameron scale_db ? " dB" : ""); 6576b92ba0aSLars-Peter Clausen else 6586b92ba0aSLars-Peter Clausen return sysfs_emit_at(buf, offset, "%d.%06u%s", vals[0], 6596b92ba0aSLars-Peter Clausen vals[1], scale_db ? " dB" : ""); 66051239600SJonathan Cameron case IIO_VAL_INT_PLUS_NANO: 66151239600SJonathan Cameron if (vals[1] < 0) 6626b92ba0aSLars-Peter Clausen return sysfs_emit_at(buf, offset, "-%d.%09u", 6636b92ba0aSLars-Peter Clausen abs(vals[0]), -vals[1]); 66451239600SJonathan Cameron else 6656b92ba0aSLars-Peter Clausen return sysfs_emit_at(buf, offset, "%d.%09u", vals[0], 6666b92ba0aSLars-Peter Clausen vals[1]); 66751239600SJonathan Cameron case IIO_VAL_FRACTIONAL: 6680e7a3978SAnand Ashok Dumbre tmp2 = div_s64((s64)vals[0] * 1000000000LL, vals[1]); 66951239600SJonathan Cameron tmp1 = vals[1]; 6700e7a3978SAnand Ashok Dumbre tmp0 = (int)div_s64_rem(tmp2, 1000000000, &tmp1); 6710e7a3978SAnand Ashok Dumbre if ((tmp2 < 0) && (tmp0 == 0)) 6726b92ba0aSLars-Peter Clausen return sysfs_emit_at(buf, offset, "-0.%09u", abs(tmp1)); 6730e7a3978SAnand Ashok Dumbre else 6746b92ba0aSLars-Peter Clausen return sysfs_emit_at(buf, offset, "%d.%09u", tmp0, 6756b92ba0aSLars-Peter Clausen abs(tmp1)); 67651239600SJonathan Cameron case IIO_VAL_FRACTIONAL_LOG2: 6772646a95dSLars-Peter Clausen tmp2 = shift_right((s64)vals[0] * 1000000000LL, vals[1]); 6782646a95dSLars-Peter Clausen tmp0 = (int)div_s64_rem(tmp2, 1000000000LL, &tmp1); 67938a52cdeSLars-Peter Clausen if (tmp0 == 0 && tmp2 < 0) 6806b92ba0aSLars-Peter Clausen return sysfs_emit_at(buf, offset, "-0.%09u", abs(tmp1)); 68138a52cdeSLars-Peter Clausen else 6826b92ba0aSLars-Peter Clausen return sysfs_emit_at(buf, offset, "%d.%09u", tmp0, 6836b92ba0aSLars-Peter Clausen abs(tmp1)); 68451239600SJonathan Cameron case IIO_VAL_INT_MULTIPLE: 68551239600SJonathan Cameron { 68651239600SJonathan Cameron int i; 68751239600SJonathan Cameron int l = 0; 68851239600SJonathan Cameron 6896b92ba0aSLars-Peter Clausen for (i = 0; i < size; ++i) 6906b92ba0aSLars-Peter Clausen l += sysfs_emit_at(buf, offset + l, "%d ", vals[i]); 69151239600SJonathan Cameron return l; 69251239600SJonathan Cameron } 6938cb34036SAndrea Merello case IIO_VAL_CHAR: 6946b92ba0aSLars-Peter Clausen return sysfs_emit_at(buf, offset, "%c", (char)vals[0]); 6956bb835f3SAndriy Tryshnivskyy case IIO_VAL_INT_64: 6966bb835f3SAndriy Tryshnivskyy tmp2 = (s64)((((u64)vals[1]) << 32) | (u32)vals[0]); 6976bb835f3SAndriy Tryshnivskyy return sysfs_emit_at(buf, offset, "%lld", tmp2); 69851239600SJonathan Cameron default: 69951239600SJonathan Cameron return 0; 70051239600SJonathan Cameron } 70151239600SJonathan Cameron } 70251239600SJonathan Cameron 7033661f3f5SLars-Peter Clausen /** 7043661f3f5SLars-Peter Clausen * iio_format_value() - Formats a IIO value into its string representation 7052498dcf6SCristina Opriceana * @buf: The buffer to which the formatted value gets written 70651239600SJonathan Cameron * which is assumed to be big enough (i.e. PAGE_SIZE). 707c175cb7cSRandy Dunlap * @type: One of the IIO_VAL_* constants. This decides how the val 7082498dcf6SCristina Opriceana * and val2 parameters are formatted. 7092498dcf6SCristina Opriceana * @size: Number of IIO value entries contained in vals 7102498dcf6SCristina Opriceana * @vals: Pointer to the values, exact meaning depends on the 7112498dcf6SCristina Opriceana * type parameter. 7122498dcf6SCristina Opriceana * 71365659a8dSAndy Shevchenko * Returns: 71465659a8dSAndy Shevchenko * 0 by default, a negative number on failure or the total number of characters 71565659a8dSAndy Shevchenko * written for a type that belongs to the IIO_VAL_* constant. 7163661f3f5SLars-Peter Clausen */ 7179fbfb4b3SSrinivas Pandruvada ssize_t iio_format_value(char *buf, unsigned int type, int size, int *vals) 718a980e046SJonathan Cameron { 71951239600SJonathan Cameron ssize_t len; 720a980e046SJonathan Cameron 7216b92ba0aSLars-Peter Clausen len = __iio_format_value(buf, 0, type, size, vals); 72251239600SJonathan Cameron if (len >= PAGE_SIZE - 1) 72351239600SJonathan Cameron return -EFBIG; 7249fbfb4b3SSrinivas Pandruvada 7256b92ba0aSLars-Peter Clausen return len + sysfs_emit_at(buf, len, "\n"); 72667eedba3SMichael Hennerich } 7277d2c2acaSAndrew F. Davis EXPORT_SYMBOL_GPL(iio_format_value); 728a980e046SJonathan Cameron 7291d4ef9b3SCristian Pop static ssize_t iio_read_channel_label(struct device *dev, 7301d4ef9b3SCristian Pop struct device_attribute *attr, 7311d4ef9b3SCristian Pop char *buf) 7321d4ef9b3SCristian Pop { 7331d4ef9b3SCristian Pop struct iio_dev *indio_dev = dev_to_iio_dev(dev); 7341d4ef9b3SCristian Pop struct iio_dev_attr *this_attr = to_iio_dev_attr(attr); 7351d4ef9b3SCristian Pop 73613efdc3dSPaul Cercueil if (indio_dev->info->read_label) 7371d4ef9b3SCristian Pop return indio_dev->info->read_label(indio_dev, this_attr->c, buf); 73813efdc3dSPaul Cercueil 73913efdc3dSPaul Cercueil if (this_attr->c->extend_name) 740c3154defSLars-Peter Clausen return sysfs_emit(buf, "%s\n", this_attr->c->extend_name); 74113efdc3dSPaul Cercueil 74213efdc3dSPaul Cercueil return -EINVAL; 7431d4ef9b3SCristian Pop } 7441d4ef9b3SCristian Pop 7453661f3f5SLars-Peter Clausen static ssize_t iio_read_channel_info(struct device *dev, 7463661f3f5SLars-Peter Clausen struct device_attribute *attr, 7473661f3f5SLars-Peter Clausen char *buf) 7483661f3f5SLars-Peter Clausen { 7493661f3f5SLars-Peter Clausen struct iio_dev *indio_dev = dev_to_iio_dev(dev); 7503661f3f5SLars-Peter Clausen struct iio_dev_attr *this_attr = to_iio_dev_attr(attr); 7519fbfb4b3SSrinivas Pandruvada int vals[INDIO_MAX_RAW_ELEMENTS]; 7529fbfb4b3SSrinivas Pandruvada int ret; 7539fbfb4b3SSrinivas Pandruvada int val_len = 2; 7549fbfb4b3SSrinivas Pandruvada 7559fbfb4b3SSrinivas Pandruvada if (indio_dev->info->read_raw_multi) 7569fbfb4b3SSrinivas Pandruvada ret = indio_dev->info->read_raw_multi(indio_dev, this_attr->c, 7579fbfb4b3SSrinivas Pandruvada INDIO_MAX_RAW_ELEMENTS, 7589fbfb4b3SSrinivas Pandruvada vals, &val_len, 7599fbfb4b3SSrinivas Pandruvada this_attr->address); 7609fbfb4b3SSrinivas Pandruvada else 7619fbfb4b3SSrinivas Pandruvada ret = indio_dev->info->read_raw(indio_dev, this_attr->c, 7629fbfb4b3SSrinivas Pandruvada &vals[0], &vals[1], this_attr->address); 7633661f3f5SLars-Peter Clausen 7643661f3f5SLars-Peter Clausen if (ret < 0) 7653661f3f5SLars-Peter Clausen return ret; 7663661f3f5SLars-Peter Clausen 7679fbfb4b3SSrinivas Pandruvada return iio_format_value(buf, ret, val_len, vals); 7683661f3f5SLars-Peter Clausen } 7693661f3f5SLars-Peter Clausen 770eda20ba1SLars-Peter Clausen static ssize_t iio_format_list(char *buf, const int *vals, int type, int length, 771eda20ba1SLars-Peter Clausen const char *prefix, const char *suffix) 77251239600SJonathan Cameron { 773eda20ba1SLars-Peter Clausen ssize_t len; 774e08b60d3SLars-Peter Clausen int stride; 77551239600SJonathan Cameron int i; 776eda20ba1SLars-Peter Clausen 77751239600SJonathan Cameron switch (type) { 77851239600SJonathan Cameron case IIO_VAL_INT: 779e08b60d3SLars-Peter Clausen stride = 1; 78051239600SJonathan Cameron break; 78151239600SJonathan Cameron default: 782e08b60d3SLars-Peter Clausen stride = 2; 783e08b60d3SLars-Peter Clausen break; 784e08b60d3SLars-Peter Clausen } 785e08b60d3SLars-Peter Clausen 7866b92ba0aSLars-Peter Clausen len = sysfs_emit(buf, prefix); 787e08b60d3SLars-Peter Clausen 788e08b60d3SLars-Peter Clausen for (i = 0; i <= length - stride; i += stride) { 789e08b60d3SLars-Peter Clausen if (i != 0) { 7906b92ba0aSLars-Peter Clausen len += sysfs_emit_at(buf, len, " "); 79151239600SJonathan Cameron if (len >= PAGE_SIZE) 79251239600SJonathan Cameron return -EFBIG; 79351239600SJonathan Cameron } 794e08b60d3SLars-Peter Clausen 7956b92ba0aSLars-Peter Clausen len += __iio_format_value(buf, len, type, stride, &vals[i]); 796e08b60d3SLars-Peter Clausen if (len >= PAGE_SIZE) 797e08b60d3SLars-Peter Clausen return -EFBIG; 79851239600SJonathan Cameron } 79951239600SJonathan Cameron 8006b92ba0aSLars-Peter Clausen len += sysfs_emit_at(buf, len, "%s\n", suffix); 801e08b60d3SLars-Peter Clausen 80251239600SJonathan Cameron return len; 80351239600SJonathan Cameron } 80451239600SJonathan Cameron 805eda20ba1SLars-Peter Clausen static ssize_t iio_format_avail_list(char *buf, const int *vals, 806eda20ba1SLars-Peter Clausen int type, int length) 807eda20ba1SLars-Peter Clausen { 808eda20ba1SLars-Peter Clausen 809eda20ba1SLars-Peter Clausen return iio_format_list(buf, vals, type, length, "", ""); 810eda20ba1SLars-Peter Clausen } 811eda20ba1SLars-Peter Clausen 81251239600SJonathan Cameron static ssize_t iio_format_avail_range(char *buf, const int *vals, int type) 81351239600SJonathan Cameron { 8145e1f9185SFawzi Khaber int length; 8155e1f9185SFawzi Khaber 8165e1f9185SFawzi Khaber /* 8175e1f9185SFawzi Khaber * length refers to the array size , not the number of elements. 8185e1f9185SFawzi Khaber * The purpose is to print the range [min , step ,max] so length should 8195e1f9185SFawzi Khaber * be 3 in case of int, and 6 for other types. 8205e1f9185SFawzi Khaber */ 8215e1f9185SFawzi Khaber switch (type) { 8225e1f9185SFawzi Khaber case IIO_VAL_INT: 8235e1f9185SFawzi Khaber length = 3; 8245e1f9185SFawzi Khaber break; 8255e1f9185SFawzi Khaber default: 8265e1f9185SFawzi Khaber length = 6; 8275e1f9185SFawzi Khaber break; 8285e1f9185SFawzi Khaber } 8295e1f9185SFawzi Khaber 8305e1f9185SFawzi Khaber return iio_format_list(buf, vals, type, length, "[", "]"); 83151239600SJonathan Cameron } 83251239600SJonathan Cameron 83351239600SJonathan Cameron static ssize_t iio_read_channel_info_avail(struct device *dev, 83451239600SJonathan Cameron struct device_attribute *attr, 83551239600SJonathan Cameron char *buf) 83651239600SJonathan Cameron { 83751239600SJonathan Cameron struct iio_dev *indio_dev = dev_to_iio_dev(dev); 83851239600SJonathan Cameron struct iio_dev_attr *this_attr = to_iio_dev_attr(attr); 83951239600SJonathan Cameron const int *vals; 84051239600SJonathan Cameron int ret; 84151239600SJonathan Cameron int length; 84251239600SJonathan Cameron int type; 84351239600SJonathan Cameron 84451239600SJonathan Cameron ret = indio_dev->info->read_avail(indio_dev, this_attr->c, 84551239600SJonathan Cameron &vals, &type, &length, 84651239600SJonathan Cameron this_attr->address); 84751239600SJonathan Cameron 84851239600SJonathan Cameron if (ret < 0) 84951239600SJonathan Cameron return ret; 85051239600SJonathan Cameron switch (ret) { 85151239600SJonathan Cameron case IIO_AVAIL_LIST: 85251239600SJonathan Cameron return iio_format_avail_list(buf, vals, type, length); 85351239600SJonathan Cameron case IIO_AVAIL_RANGE: 85451239600SJonathan Cameron return iio_format_avail_range(buf, vals, type); 85551239600SJonathan Cameron default: 85651239600SJonathan Cameron return -EINVAL; 85751239600SJonathan Cameron } 85851239600SJonathan Cameron } 85951239600SJonathan Cameron 8606807d721SLars-Peter Clausen /** 861b8528224SBeniamin Bia * __iio_str_to_fixpoint() - Parse a fixed-point number from a string 8626807d721SLars-Peter Clausen * @str: The string to parse 8636807d721SLars-Peter Clausen * @fract_mult: Multiplier for the first decimal place, should be a power of 10 8646807d721SLars-Peter Clausen * @integer: The integer part of the number 8656807d721SLars-Peter Clausen * @fract: The fractional part of the number 866b8528224SBeniamin Bia * @scale_db: True if this should parse as dB 8676807d721SLars-Peter Clausen * 86865659a8dSAndy Shevchenko * Returns: 86965659a8dSAndy Shevchenko * 0 on success, or a negative error code if the string could not be parsed. 8706807d721SLars-Peter Clausen */ 871b8528224SBeniamin Bia static int __iio_str_to_fixpoint(const char *str, int fract_mult, 872b8528224SBeniamin Bia int *integer, int *fract, bool scale_db) 8736807d721SLars-Peter Clausen { 8746807d721SLars-Peter Clausen int i = 0, f = 0; 8756807d721SLars-Peter Clausen bool integer_part = true, negative = false; 8766807d721SLars-Peter Clausen 877f47dff32SSean Nyekjaer if (fract_mult == 0) { 878f47dff32SSean Nyekjaer *fract = 0; 879f47dff32SSean Nyekjaer 880f47dff32SSean Nyekjaer return kstrtoint(str, 0, integer); 881f47dff32SSean Nyekjaer } 882f47dff32SSean Nyekjaer 8836807d721SLars-Peter Clausen if (str[0] == '-') { 8846807d721SLars-Peter Clausen negative = true; 8856807d721SLars-Peter Clausen str++; 8866807d721SLars-Peter Clausen } else if (str[0] == '+') { 8876807d721SLars-Peter Clausen str++; 8886807d721SLars-Peter Clausen } 8896807d721SLars-Peter Clausen 8906807d721SLars-Peter Clausen while (*str) { 8916807d721SLars-Peter Clausen if ('0' <= *str && *str <= '9') { 8926807d721SLars-Peter Clausen if (integer_part) { 8936807d721SLars-Peter Clausen i = i * 10 + *str - '0'; 8946807d721SLars-Peter Clausen } else { 8956807d721SLars-Peter Clausen f += fract_mult * (*str - '0'); 8966807d721SLars-Peter Clausen fract_mult /= 10; 8976807d721SLars-Peter Clausen } 8986807d721SLars-Peter Clausen } else if (*str == '\n') { 8996807d721SLars-Peter Clausen if (*(str + 1) == '\0') 9006807d721SLars-Peter Clausen break; 9016807d721SLars-Peter Clausen return -EINVAL; 902b8528224SBeniamin Bia } else if (!strncmp(str, " dB", sizeof(" dB") - 1) && scale_db) { 903b8528224SBeniamin Bia /* Ignore the dB suffix */ 904b8528224SBeniamin Bia str += sizeof(" dB") - 1; 905b8528224SBeniamin Bia continue; 906b8528224SBeniamin Bia } else if (!strncmp(str, "dB", sizeof("dB") - 1) && scale_db) { 907b8528224SBeniamin Bia /* Ignore the dB suffix */ 908b8528224SBeniamin Bia str += sizeof("dB") - 1; 909b8528224SBeniamin Bia continue; 9106807d721SLars-Peter Clausen } else if (*str == '.' && integer_part) { 9116807d721SLars-Peter Clausen integer_part = false; 9126807d721SLars-Peter Clausen } else { 9136807d721SLars-Peter Clausen return -EINVAL; 9146807d721SLars-Peter Clausen } 9156807d721SLars-Peter Clausen str++; 9166807d721SLars-Peter Clausen } 9176807d721SLars-Peter Clausen 9186807d721SLars-Peter Clausen if (negative) { 9196807d721SLars-Peter Clausen if (i) 9206807d721SLars-Peter Clausen i = -i; 9216807d721SLars-Peter Clausen else 9226807d721SLars-Peter Clausen f = -f; 9236807d721SLars-Peter Clausen } 9246807d721SLars-Peter Clausen 9256807d721SLars-Peter Clausen *integer = i; 9266807d721SLars-Peter Clausen *fract = f; 9276807d721SLars-Peter Clausen 9286807d721SLars-Peter Clausen return 0; 9296807d721SLars-Peter Clausen } 930b8528224SBeniamin Bia 931b8528224SBeniamin Bia /** 932b8528224SBeniamin Bia * iio_str_to_fixpoint() - Parse a fixed-point number from a string 933b8528224SBeniamin Bia * @str: The string to parse 934b8528224SBeniamin Bia * @fract_mult: Multiplier for the first decimal place, should be a power of 10 935b8528224SBeniamin Bia * @integer: The integer part of the number 936b8528224SBeniamin Bia * @fract: The fractional part of the number 937b8528224SBeniamin Bia * 93865659a8dSAndy Shevchenko * Returns: 93965659a8dSAndy Shevchenko * 0 on success, or a negative error code if the string could not be parsed. 940b8528224SBeniamin Bia */ 941b8528224SBeniamin Bia int iio_str_to_fixpoint(const char *str, int fract_mult, 942b8528224SBeniamin Bia int *integer, int *fract) 943b8528224SBeniamin Bia { 944b8528224SBeniamin Bia return __iio_str_to_fixpoint(str, fract_mult, integer, fract, false); 945b8528224SBeniamin Bia } 9466807d721SLars-Peter Clausen EXPORT_SYMBOL_GPL(iio_str_to_fixpoint); 9476807d721SLars-Peter Clausen 948a980e046SJonathan Cameron static ssize_t iio_write_channel_info(struct device *dev, 949a980e046SJonathan Cameron struct device_attribute *attr, 950a980e046SJonathan Cameron const char *buf, 951a980e046SJonathan Cameron size_t len) 952a980e046SJonathan Cameron { 953e53f5ac5SLars-Peter Clausen struct iio_dev *indio_dev = dev_to_iio_dev(dev); 954a980e046SJonathan Cameron struct iio_dev_attr *this_attr = to_iio_dev_attr(attr); 9556807d721SLars-Peter Clausen int ret, fract_mult = 100000; 9568cb34036SAndrea Merello int integer, fract = 0; 9578cb34036SAndrea Merello bool is_char = false; 958b8528224SBeniamin Bia bool scale_db = false; 959a980e046SJonathan Cameron 960a980e046SJonathan Cameron /* Assumes decimal - precision based on number of digits */ 961a980e046SJonathan Cameron if (!indio_dev->info->write_raw) 962a980e046SJonathan Cameron return -EINVAL; 963a980e046SJonathan Cameron 964a980e046SJonathan Cameron if (indio_dev->info->write_raw_get_fmt) 965a980e046SJonathan Cameron switch (indio_dev->info->write_raw_get_fmt(indio_dev, 966a980e046SJonathan Cameron this_attr->c, this_attr->address)) { 967f47dff32SSean Nyekjaer case IIO_VAL_INT: 968f47dff32SSean Nyekjaer fract_mult = 0; 969f47dff32SSean Nyekjaer break; 970b8528224SBeniamin Bia case IIO_VAL_INT_PLUS_MICRO_DB: 971b8528224SBeniamin Bia scale_db = true; 972df561f66SGustavo A. R. Silva fallthrough; 973a980e046SJonathan Cameron case IIO_VAL_INT_PLUS_MICRO: 974a980e046SJonathan Cameron fract_mult = 100000; 975a980e046SJonathan Cameron break; 976a980e046SJonathan Cameron case IIO_VAL_INT_PLUS_NANO: 977a980e046SJonathan Cameron fract_mult = 100000000; 978a980e046SJonathan Cameron break; 9798cb34036SAndrea Merello case IIO_VAL_CHAR: 9808cb34036SAndrea Merello is_char = true; 9818cb34036SAndrea Merello break; 982a980e046SJonathan Cameron default: 983a980e046SJonathan Cameron return -EINVAL; 984a980e046SJonathan Cameron } 985a980e046SJonathan Cameron 9868cb34036SAndrea Merello if (is_char) { 9878cb34036SAndrea Merello char ch; 9888cb34036SAndrea Merello 9898cb34036SAndrea Merello if (sscanf(buf, "%c", &ch) != 1) 9908cb34036SAndrea Merello return -EINVAL; 9918cb34036SAndrea Merello integer = ch; 9928cb34036SAndrea Merello } else { 993b8528224SBeniamin Bia ret = __iio_str_to_fixpoint(buf, fract_mult, &integer, &fract, 994b8528224SBeniamin Bia scale_db); 995b8528224SBeniamin Bia if (ret) 996b8528224SBeniamin Bia return ret; 9975403f280SMircea Caprioru } 998a980e046SJonathan Cameron 999a980e046SJonathan Cameron ret = indio_dev->info->write_raw(indio_dev, this_attr->c, 1000a980e046SJonathan Cameron integer, fract, this_attr->address); 1001a980e046SJonathan Cameron if (ret) 1002a980e046SJonathan Cameron return ret; 1003a980e046SJonathan Cameron 1004a980e046SJonathan Cameron return len; 1005a980e046SJonathan Cameron } 1006a980e046SJonathan Cameron 1007a980e046SJonathan Cameron static 1008a980e046SJonathan Cameron int __iio_device_attr_init(struct device_attribute *dev_attr, 1009a980e046SJonathan Cameron const char *postfix, 1010a980e046SJonathan Cameron struct iio_chan_spec const *chan, 1011a980e046SJonathan Cameron ssize_t (*readfunc)(struct device *dev, 1012a980e046SJonathan Cameron struct device_attribute *attr, 1013a980e046SJonathan Cameron char *buf), 1014a980e046SJonathan Cameron ssize_t (*writefunc)(struct device *dev, 1015a980e046SJonathan Cameron struct device_attribute *attr, 1016a980e046SJonathan Cameron const char *buf, 1017a980e046SJonathan Cameron size_t len), 10183704432fSJonathan Cameron enum iio_shared_by shared_by) 1019a980e046SJonathan Cameron { 10203704432fSJonathan Cameron int ret = 0; 10217bbcf7e1SLars-Peter Clausen char *name = NULL; 10223704432fSJonathan Cameron char *full_postfix; 10239d9ec8d0SJoe Simmons-Talbott 1024a980e046SJonathan Cameron sysfs_attr_init(&dev_attr->attr); 1025a980e046SJonathan Cameron 1026a980e046SJonathan Cameron /* Build up postfix of <extend_name>_<modifier>_postfix */ 10273704432fSJonathan Cameron if (chan->modified && (shared_by == IIO_SEPARATE)) { 1028a980e046SJonathan Cameron if (chan->extend_name) 1029a980e046SJonathan Cameron full_postfix = kasprintf(GFP_KERNEL, "%s_%s_%s", 1030b662f4baSAndy Shevchenko iio_modifier_names[chan->channel2], 1031a980e046SJonathan Cameron chan->extend_name, 1032a980e046SJonathan Cameron postfix); 1033a980e046SJonathan Cameron else 1034a980e046SJonathan Cameron full_postfix = kasprintf(GFP_KERNEL, "%s_%s", 1035b662f4baSAndy Shevchenko iio_modifier_names[chan->channel2], 1036a980e046SJonathan Cameron postfix); 1037a980e046SJonathan Cameron } else { 103877bfa8baSLars-Peter Clausen if (chan->extend_name == NULL || shared_by != IIO_SEPARATE) 1039a980e046SJonathan Cameron full_postfix = kstrdup(postfix, GFP_KERNEL); 1040a980e046SJonathan Cameron else 1041a980e046SJonathan Cameron full_postfix = kasprintf(GFP_KERNEL, 1042a980e046SJonathan Cameron "%s_%s", 1043a980e046SJonathan Cameron chan->extend_name, 1044a980e046SJonathan Cameron postfix); 1045a980e046SJonathan Cameron } 10463704432fSJonathan Cameron if (full_postfix == NULL) 10473704432fSJonathan Cameron return -ENOMEM; 1048a980e046SJonathan Cameron 1049a980e046SJonathan Cameron if (chan->differential) { /* Differential can not have modifier */ 10503704432fSJonathan Cameron switch (shared_by) { 1051c006ec83SJonathan Cameron case IIO_SHARED_BY_ALL: 10527bbcf7e1SLars-Peter Clausen name = kasprintf(GFP_KERNEL, "%s", full_postfix); 1053c006ec83SJonathan Cameron break; 1054c006ec83SJonathan Cameron case IIO_SHARED_BY_DIR: 10557bbcf7e1SLars-Peter Clausen name = kasprintf(GFP_KERNEL, "%s_%s", 1056c006ec83SJonathan Cameron iio_direction[chan->output], 1057c006ec83SJonathan Cameron full_postfix); 1058c006ec83SJonathan Cameron break; 10593704432fSJonathan Cameron case IIO_SHARED_BY_TYPE: 10607bbcf7e1SLars-Peter Clausen name = kasprintf(GFP_KERNEL, "%s_%s-%s_%s", 1061a980e046SJonathan Cameron iio_direction[chan->output], 1062a980e046SJonathan Cameron iio_chan_type_name_spec[chan->type], 1063a980e046SJonathan Cameron iio_chan_type_name_spec[chan->type], 1064a980e046SJonathan Cameron full_postfix); 10653704432fSJonathan Cameron break; 10663704432fSJonathan Cameron case IIO_SEPARATE: 10673704432fSJonathan Cameron if (!chan->indexed) { 1068231bfe53SDan Carpenter WARN(1, "Differential channels must be indexed\n"); 10693704432fSJonathan Cameron ret = -EINVAL; 10703704432fSJonathan Cameron goto error_free_full_postfix; 10713704432fSJonathan Cameron } 10727bbcf7e1SLars-Peter Clausen name = kasprintf(GFP_KERNEL, 10733704432fSJonathan Cameron "%s_%s%d-%s%d_%s", 1074a980e046SJonathan Cameron iio_direction[chan->output], 1075a980e046SJonathan Cameron iio_chan_type_name_spec[chan->type], 1076a980e046SJonathan Cameron chan->channel, 1077a980e046SJonathan Cameron iio_chan_type_name_spec[chan->type], 1078a980e046SJonathan Cameron chan->channel2, 1079a980e046SJonathan Cameron full_postfix); 10803704432fSJonathan Cameron break; 1081a980e046SJonathan Cameron } 1082a980e046SJonathan Cameron } else { /* Single ended */ 10833704432fSJonathan Cameron switch (shared_by) { 1084c006ec83SJonathan Cameron case IIO_SHARED_BY_ALL: 10857bbcf7e1SLars-Peter Clausen name = kasprintf(GFP_KERNEL, "%s", full_postfix); 1086c006ec83SJonathan Cameron break; 1087c006ec83SJonathan Cameron case IIO_SHARED_BY_DIR: 10887bbcf7e1SLars-Peter Clausen name = kasprintf(GFP_KERNEL, "%s_%s", 1089c006ec83SJonathan Cameron iio_direction[chan->output], 1090c006ec83SJonathan Cameron full_postfix); 1091c006ec83SJonathan Cameron break; 10923704432fSJonathan Cameron case IIO_SHARED_BY_TYPE: 10937bbcf7e1SLars-Peter Clausen name = kasprintf(GFP_KERNEL, "%s_%s_%s", 1094a980e046SJonathan Cameron iio_direction[chan->output], 1095a980e046SJonathan Cameron iio_chan_type_name_spec[chan->type], 1096a980e046SJonathan Cameron full_postfix); 10973704432fSJonathan Cameron break; 10983704432fSJonathan Cameron 10993704432fSJonathan Cameron case IIO_SEPARATE: 11003704432fSJonathan Cameron if (chan->indexed) 11017bbcf7e1SLars-Peter Clausen name = kasprintf(GFP_KERNEL, "%s_%s%d_%s", 1102a980e046SJonathan Cameron iio_direction[chan->output], 1103a980e046SJonathan Cameron iio_chan_type_name_spec[chan->type], 1104a980e046SJonathan Cameron chan->channel, 1105a980e046SJonathan Cameron full_postfix); 1106a980e046SJonathan Cameron else 11077bbcf7e1SLars-Peter Clausen name = kasprintf(GFP_KERNEL, "%s_%s_%s", 1108a980e046SJonathan Cameron iio_direction[chan->output], 1109a980e046SJonathan Cameron iio_chan_type_name_spec[chan->type], 1110a980e046SJonathan Cameron full_postfix); 11113704432fSJonathan Cameron break; 11123704432fSJonathan Cameron } 1113a980e046SJonathan Cameron } 11147bbcf7e1SLars-Peter Clausen if (name == NULL) { 1115a980e046SJonathan Cameron ret = -ENOMEM; 1116a980e046SJonathan Cameron goto error_free_full_postfix; 1117a980e046SJonathan Cameron } 11187bbcf7e1SLars-Peter Clausen dev_attr->attr.name = name; 1119a980e046SJonathan Cameron 1120a980e046SJonathan Cameron if (readfunc) { 11219cf0b618SJoe Simmons-Talbott dev_attr->attr.mode |= 0444; 1122a980e046SJonathan Cameron dev_attr->show = readfunc; 1123a980e046SJonathan Cameron } 1124a980e046SJonathan Cameron 1125a980e046SJonathan Cameron if (writefunc) { 11269cf0b618SJoe Simmons-Talbott dev_attr->attr.mode |= 0200; 1127a980e046SJonathan Cameron dev_attr->store = writefunc; 1128a980e046SJonathan Cameron } 11297bbcf7e1SLars-Peter Clausen 1130a980e046SJonathan Cameron error_free_full_postfix: 1131a980e046SJonathan Cameron kfree(full_postfix); 11323704432fSJonathan Cameron 1133a980e046SJonathan Cameron return ret; 1134a980e046SJonathan Cameron } 1135a980e046SJonathan Cameron 1136a980e046SJonathan Cameron static void __iio_device_attr_deinit(struct device_attribute *dev_attr) 1137a980e046SJonathan Cameron { 1138a980e046SJonathan Cameron kfree(dev_attr->attr.name); 1139a980e046SJonathan Cameron } 1140a980e046SJonathan Cameron 1141a980e046SJonathan Cameron int __iio_add_chan_devattr(const char *postfix, 1142a980e046SJonathan Cameron struct iio_chan_spec const *chan, 1143a980e046SJonathan Cameron ssize_t (*readfunc)(struct device *dev, 1144a980e046SJonathan Cameron struct device_attribute *attr, 1145a980e046SJonathan Cameron char *buf), 1146a980e046SJonathan Cameron ssize_t (*writefunc)(struct device *dev, 1147a980e046SJonathan Cameron struct device_attribute *attr, 1148a980e046SJonathan Cameron const char *buf, 1149a980e046SJonathan Cameron size_t len), 1150a980e046SJonathan Cameron u64 mask, 11513704432fSJonathan Cameron enum iio_shared_by shared_by, 1152a980e046SJonathan Cameron struct device *dev, 11533e3d11b2SAlexandru Ardelean struct iio_buffer *buffer, 1154a980e046SJonathan Cameron struct list_head *attr_list) 1155a980e046SJonathan Cameron { 1156a980e046SJonathan Cameron int ret; 1157a980e046SJonathan Cameron struct iio_dev_attr *iio_attr, *t; 1158a980e046SJonathan Cameron 1159670c1103SSachin Kamat iio_attr = kzalloc(sizeof(*iio_attr), GFP_KERNEL); 116092825ff9SHartmut Knaack if (iio_attr == NULL) 116192825ff9SHartmut Knaack return -ENOMEM; 1162a980e046SJonathan Cameron ret = __iio_device_attr_init(&iio_attr->dev_attr, 1163a980e046SJonathan Cameron postfix, chan, 11643704432fSJonathan Cameron readfunc, writefunc, shared_by); 1165a980e046SJonathan Cameron if (ret) 1166a980e046SJonathan Cameron goto error_iio_dev_attr_free; 1167a980e046SJonathan Cameron iio_attr->c = chan; 1168a980e046SJonathan Cameron iio_attr->address = mask; 11693e3d11b2SAlexandru Ardelean iio_attr->buffer = buffer; 1170a980e046SJonathan Cameron list_for_each_entry(t, attr_list, l) 1171a980e046SJonathan Cameron if (strcmp(t->dev_attr.attr.name, 1172a980e046SJonathan Cameron iio_attr->dev_attr.attr.name) == 0) { 11733704432fSJonathan Cameron if (shared_by == IIO_SEPARATE) 1174a980e046SJonathan Cameron dev_err(dev, "tried to double register : %s\n", 1175a980e046SJonathan Cameron t->dev_attr.attr.name); 1176a980e046SJonathan Cameron ret = -EBUSY; 1177a980e046SJonathan Cameron goto error_device_attr_deinit; 1178a980e046SJonathan Cameron } 1179a980e046SJonathan Cameron list_add(&iio_attr->l, attr_list); 1180a980e046SJonathan Cameron 1181a980e046SJonathan Cameron return 0; 1182a980e046SJonathan Cameron 1183a980e046SJonathan Cameron error_device_attr_deinit: 1184a980e046SJonathan Cameron __iio_device_attr_deinit(&iio_attr->dev_attr); 1185a980e046SJonathan Cameron error_iio_dev_attr_free: 1186a980e046SJonathan Cameron kfree(iio_attr); 1187a980e046SJonathan Cameron return ret; 1188a980e046SJonathan Cameron } 1189a980e046SJonathan Cameron 11901d4ef9b3SCristian Pop static int iio_device_add_channel_label(struct iio_dev *indio_dev, 11911d4ef9b3SCristian Pop struct iio_chan_spec const *chan) 11921d4ef9b3SCristian Pop { 11931d4ef9b3SCristian Pop struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 11941d4ef9b3SCristian Pop int ret; 11951d4ef9b3SCristian Pop 119613efdc3dSPaul Cercueil if (!indio_dev->info->read_label && !chan->extend_name) 11971d4ef9b3SCristian Pop return 0; 11981d4ef9b3SCristian Pop 11991d4ef9b3SCristian Pop ret = __iio_add_chan_devattr("label", 12001d4ef9b3SCristian Pop chan, 12011d4ef9b3SCristian Pop &iio_read_channel_label, 12021d4ef9b3SCristian Pop NULL, 12031d4ef9b3SCristian Pop 0, 12041d4ef9b3SCristian Pop IIO_SEPARATE, 12051d4ef9b3SCristian Pop &indio_dev->dev, 12063e3d11b2SAlexandru Ardelean NULL, 12071d4ef9b3SCristian Pop &iio_dev_opaque->channel_attr_list); 12081d4ef9b3SCristian Pop if (ret < 0) 12091d4ef9b3SCristian Pop return ret; 12101d4ef9b3SCristian Pop 12111d4ef9b3SCristian Pop return 1; 12121d4ef9b3SCristian Pop } 12131d4ef9b3SCristian Pop 12143704432fSJonathan Cameron static int iio_device_add_info_mask_type(struct iio_dev *indio_dev, 12153704432fSJonathan Cameron struct iio_chan_spec const *chan, 12163704432fSJonathan Cameron enum iio_shared_by shared_by, 12173704432fSJonathan Cameron const long *infomask) 12183704432fSJonathan Cameron { 1219207c2d27SAlexandru Ardelean struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 12203704432fSJonathan Cameron int i, ret, attrcount = 0; 12213704432fSJonathan Cameron 12221016d567SOrson Zhai for_each_set_bit(i, infomask, sizeof(*infomask)*8) { 1223ef4b4856SJonathan Cameron if (i >= ARRAY_SIZE(iio_chan_info_postfix)) 1224ef4b4856SJonathan Cameron return -EINVAL; 12253704432fSJonathan Cameron ret = __iio_add_chan_devattr(iio_chan_info_postfix[i], 12263704432fSJonathan Cameron chan, 12273704432fSJonathan Cameron &iio_read_channel_info, 12283704432fSJonathan Cameron &iio_write_channel_info, 12293704432fSJonathan Cameron i, 12303704432fSJonathan Cameron shared_by, 12313704432fSJonathan Cameron &indio_dev->dev, 12323e3d11b2SAlexandru Ardelean NULL, 1233207c2d27SAlexandru Ardelean &iio_dev_opaque->channel_attr_list); 12343704432fSJonathan Cameron if ((ret == -EBUSY) && (shared_by != IIO_SEPARATE)) 12353704432fSJonathan Cameron continue; 12361702df5dSAndy Shevchenko if (ret < 0) 12373704432fSJonathan Cameron return ret; 12383704432fSJonathan Cameron attrcount++; 12393704432fSJonathan Cameron } 12403704432fSJonathan Cameron 12413704432fSJonathan Cameron return attrcount; 12423704432fSJonathan Cameron } 12433704432fSJonathan Cameron 124451239600SJonathan Cameron static int iio_device_add_info_mask_type_avail(struct iio_dev *indio_dev, 124551239600SJonathan Cameron struct iio_chan_spec const *chan, 124651239600SJonathan Cameron enum iio_shared_by shared_by, 124751239600SJonathan Cameron const long *infomask) 124851239600SJonathan Cameron { 1249207c2d27SAlexandru Ardelean struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 125051239600SJonathan Cameron int i, ret, attrcount = 0; 125151239600SJonathan Cameron char *avail_postfix; 125251239600SJonathan Cameron 12531016d567SOrson Zhai for_each_set_bit(i, infomask, sizeof(*infomask) * 8) { 1254936d3e53SYoung Xiao if (i >= ARRAY_SIZE(iio_chan_info_postfix)) 1255936d3e53SYoung Xiao return -EINVAL; 125651239600SJonathan Cameron avail_postfix = kasprintf(GFP_KERNEL, 125751239600SJonathan Cameron "%s_available", 125851239600SJonathan Cameron iio_chan_info_postfix[i]); 125951239600SJonathan Cameron if (!avail_postfix) 126051239600SJonathan Cameron return -ENOMEM; 126151239600SJonathan Cameron 126251239600SJonathan Cameron ret = __iio_add_chan_devattr(avail_postfix, 126351239600SJonathan Cameron chan, 126451239600SJonathan Cameron &iio_read_channel_info_avail, 126551239600SJonathan Cameron NULL, 126651239600SJonathan Cameron i, 126751239600SJonathan Cameron shared_by, 126851239600SJonathan Cameron &indio_dev->dev, 12693e3d11b2SAlexandru Ardelean NULL, 1270207c2d27SAlexandru Ardelean &iio_dev_opaque->channel_attr_list); 127151239600SJonathan Cameron kfree(avail_postfix); 127251239600SJonathan Cameron if ((ret == -EBUSY) && (shared_by != IIO_SEPARATE)) 127351239600SJonathan Cameron continue; 12741702df5dSAndy Shevchenko if (ret < 0) 127551239600SJonathan Cameron return ret; 127651239600SJonathan Cameron attrcount++; 127751239600SJonathan Cameron } 127851239600SJonathan Cameron 127951239600SJonathan Cameron return attrcount; 128051239600SJonathan Cameron } 128151239600SJonathan Cameron 1282a980e046SJonathan Cameron static int iio_device_add_channel_sysfs(struct iio_dev *indio_dev, 1283a980e046SJonathan Cameron struct iio_chan_spec const *chan) 1284a980e046SJonathan Cameron { 1285207c2d27SAlexandru Ardelean struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 1286a980e046SJonathan Cameron int ret, attrcount = 0; 1287a980e046SJonathan Cameron const struct iio_chan_spec_ext_info *ext_info; 1288a980e046SJonathan Cameron 1289a980e046SJonathan Cameron if (chan->channel < 0) 1290a980e046SJonathan Cameron return 0; 12913704432fSJonathan Cameron ret = iio_device_add_info_mask_type(indio_dev, chan, 12923704432fSJonathan Cameron IIO_SEPARATE, 12933704432fSJonathan Cameron &chan->info_mask_separate); 12948655cc49SJonathan Cameron if (ret < 0) 12953704432fSJonathan Cameron return ret; 12963704432fSJonathan Cameron attrcount += ret; 12973704432fSJonathan Cameron 129851239600SJonathan Cameron ret = iio_device_add_info_mask_type_avail(indio_dev, chan, 129951239600SJonathan Cameron IIO_SEPARATE, 1300682ca76bSJoe Simmons-Talbott &chan->info_mask_separate_available); 130151239600SJonathan Cameron if (ret < 0) 130251239600SJonathan Cameron return ret; 130351239600SJonathan Cameron attrcount += ret; 130451239600SJonathan Cameron 13053704432fSJonathan Cameron ret = iio_device_add_info_mask_type(indio_dev, chan, 13063704432fSJonathan Cameron IIO_SHARED_BY_TYPE, 13073704432fSJonathan Cameron &chan->info_mask_shared_by_type); 13083704432fSJonathan Cameron if (ret < 0) 13093704432fSJonathan Cameron return ret; 13103704432fSJonathan Cameron attrcount += ret; 1311a980e046SJonathan Cameron 131251239600SJonathan Cameron ret = iio_device_add_info_mask_type_avail(indio_dev, chan, 131351239600SJonathan Cameron IIO_SHARED_BY_TYPE, 1314682ca76bSJoe Simmons-Talbott &chan->info_mask_shared_by_type_available); 131551239600SJonathan Cameron if (ret < 0) 131651239600SJonathan Cameron return ret; 131751239600SJonathan Cameron attrcount += ret; 131851239600SJonathan Cameron 1319c006ec83SJonathan Cameron ret = iio_device_add_info_mask_type(indio_dev, chan, 1320c006ec83SJonathan Cameron IIO_SHARED_BY_DIR, 1321c006ec83SJonathan Cameron &chan->info_mask_shared_by_dir); 1322c006ec83SJonathan Cameron if (ret < 0) 1323c006ec83SJonathan Cameron return ret; 1324c006ec83SJonathan Cameron attrcount += ret; 1325c006ec83SJonathan Cameron 132651239600SJonathan Cameron ret = iio_device_add_info_mask_type_avail(indio_dev, chan, 132751239600SJonathan Cameron IIO_SHARED_BY_DIR, 132851239600SJonathan Cameron &chan->info_mask_shared_by_dir_available); 132951239600SJonathan Cameron if (ret < 0) 133051239600SJonathan Cameron return ret; 133151239600SJonathan Cameron attrcount += ret; 133251239600SJonathan Cameron 1333c006ec83SJonathan Cameron ret = iio_device_add_info_mask_type(indio_dev, chan, 1334c006ec83SJonathan Cameron IIO_SHARED_BY_ALL, 1335c006ec83SJonathan Cameron &chan->info_mask_shared_by_all); 1336c006ec83SJonathan Cameron if (ret < 0) 1337c006ec83SJonathan Cameron return ret; 1338c006ec83SJonathan Cameron attrcount += ret; 1339c006ec83SJonathan Cameron 134051239600SJonathan Cameron ret = iio_device_add_info_mask_type_avail(indio_dev, chan, 134151239600SJonathan Cameron IIO_SHARED_BY_ALL, 134251239600SJonathan Cameron &chan->info_mask_shared_by_all_available); 134351239600SJonathan Cameron if (ret < 0) 134451239600SJonathan Cameron return ret; 134551239600SJonathan Cameron attrcount += ret; 134651239600SJonathan Cameron 13471d4ef9b3SCristian Pop ret = iio_device_add_channel_label(indio_dev, chan); 13481d4ef9b3SCristian Pop if (ret < 0) 13491d4ef9b3SCristian Pop return ret; 13501d4ef9b3SCristian Pop attrcount += ret; 13511d4ef9b3SCristian Pop 1352a980e046SJonathan Cameron if (chan->ext_info) { 1353a980e046SJonathan Cameron unsigned int i = 0; 13549d9ec8d0SJoe Simmons-Talbott 1355a980e046SJonathan Cameron for (ext_info = chan->ext_info; ext_info->name; ext_info++) { 1356a980e046SJonathan Cameron ret = __iio_add_chan_devattr(ext_info->name, 1357a980e046SJonathan Cameron chan, 1358a980e046SJonathan Cameron ext_info->read ? 1359a980e046SJonathan Cameron &iio_read_channel_ext_info : NULL, 1360a980e046SJonathan Cameron ext_info->write ? 1361a980e046SJonathan Cameron &iio_write_channel_ext_info : NULL, 1362a980e046SJonathan Cameron i, 1363a980e046SJonathan Cameron ext_info->shared, 1364a980e046SJonathan Cameron &indio_dev->dev, 13653e3d11b2SAlexandru Ardelean NULL, 1366207c2d27SAlexandru Ardelean &iio_dev_opaque->channel_attr_list); 1367a980e046SJonathan Cameron i++; 1368a980e046SJonathan Cameron if (ret == -EBUSY && ext_info->shared) 1369a980e046SJonathan Cameron continue; 1370a980e046SJonathan Cameron 1371a980e046SJonathan Cameron if (ret) 13723704432fSJonathan Cameron return ret; 1373a980e046SJonathan Cameron 1374a980e046SJonathan Cameron attrcount++; 1375a980e046SJonathan Cameron } 1376a980e046SJonathan Cameron } 1377a980e046SJonathan Cameron 13783704432fSJonathan Cameron return attrcount; 1379a980e046SJonathan Cameron } 1380a980e046SJonathan Cameron 138184088ebdSLars-Peter Clausen /** 138284088ebdSLars-Peter Clausen * iio_free_chan_devattr_list() - Free a list of IIO device attributes 138384088ebdSLars-Peter Clausen * @attr_list: List of IIO device attributes 138484088ebdSLars-Peter Clausen * 138584088ebdSLars-Peter Clausen * This function frees the memory allocated for each of the IIO device 1386c1b03ab5SMartin Fuzzey * attributes in the list. 138784088ebdSLars-Peter Clausen */ 138884088ebdSLars-Peter Clausen void iio_free_chan_devattr_list(struct list_head *attr_list) 1389a980e046SJonathan Cameron { 139084088ebdSLars-Peter Clausen struct iio_dev_attr *p, *n; 139184088ebdSLars-Peter Clausen 139284088ebdSLars-Peter Clausen list_for_each_entry_safe(p, n, attr_list, l) { 139315097c7aSAlexandru Ardelean kfree_const(p->dev_attr.attr.name); 1394c1b03ab5SMartin Fuzzey list_del(&p->l); 1395a980e046SJonathan Cameron kfree(p); 1396a980e046SJonathan Cameron } 139784088ebdSLars-Peter Clausen } 1398a980e046SJonathan Cameron 13999cf0b618SJoe Simmons-Talbott static ssize_t name_show(struct device *dev, struct device_attribute *attr, 1400a980e046SJonathan Cameron char *buf) 1401a980e046SJonathan Cameron { 1402e53f5ac5SLars-Peter Clausen struct iio_dev *indio_dev = dev_to_iio_dev(dev); 14039d9ec8d0SJoe Simmons-Talbott 140483ca56b6SLars-Peter Clausen return sysfs_emit(buf, "%s\n", indio_dev->name); 1405a980e046SJonathan Cameron } 1406a980e046SJonathan Cameron 14079cf0b618SJoe Simmons-Talbott static DEVICE_ATTR_RO(name); 1408a980e046SJonathan Cameron 14099cf0b618SJoe Simmons-Talbott static ssize_t label_show(struct device *dev, struct device_attribute *attr, 14102c3d0c9fSPhil Reid char *buf) 14112c3d0c9fSPhil Reid { 14122c3d0c9fSPhil Reid struct iio_dev *indio_dev = dev_to_iio_dev(dev); 14139d9ec8d0SJoe Simmons-Talbott 141483ca56b6SLars-Peter Clausen return sysfs_emit(buf, "%s\n", indio_dev->label); 14152c3d0c9fSPhil Reid } 14162c3d0c9fSPhil Reid 14179cf0b618SJoe Simmons-Talbott static DEVICE_ATTR_RO(label); 14182c3d0c9fSPhil Reid 1419971ddd4bSAndy Shevchenko static const char * const clock_names[] = { 1420971ddd4bSAndy Shevchenko [CLOCK_REALTIME] = "realtime", 1421971ddd4bSAndy Shevchenko [CLOCK_MONOTONIC] = "monotonic", 1422971ddd4bSAndy Shevchenko [CLOCK_PROCESS_CPUTIME_ID] = "process_cputime_id", 1423971ddd4bSAndy Shevchenko [CLOCK_THREAD_CPUTIME_ID] = "thread_cputime_id", 1424971ddd4bSAndy Shevchenko [CLOCK_MONOTONIC_RAW] = "monotonic_raw", 1425971ddd4bSAndy Shevchenko [CLOCK_REALTIME_COARSE] = "realtime_coarse", 1426971ddd4bSAndy Shevchenko [CLOCK_MONOTONIC_COARSE] = "monotonic_coarse", 1427971ddd4bSAndy Shevchenko [CLOCK_BOOTTIME] = "boottime", 1428971ddd4bSAndy Shevchenko [CLOCK_REALTIME_ALARM] = "realtime_alarm", 1429971ddd4bSAndy Shevchenko [CLOCK_BOOTTIME_ALARM] = "boottime_alarm", 1430971ddd4bSAndy Shevchenko [CLOCK_SGI_CYCLE] = "sgi_cycle", 1431971ddd4bSAndy Shevchenko [CLOCK_TAI] = "tai", 1432971ddd4bSAndy Shevchenko }; 1433971ddd4bSAndy Shevchenko 14349cf0b618SJoe Simmons-Talbott static ssize_t current_timestamp_clock_show(struct device *dev, 1435bc2b7dabSGregor Boirie struct device_attribute *attr, 1436bc2b7dabSGregor Boirie char *buf) 1437bc2b7dabSGregor Boirie { 1438bc2b7dabSGregor Boirie const struct iio_dev *indio_dev = dev_to_iio_dev(dev); 1439bc2b7dabSGregor Boirie const clockid_t clk = iio_device_get_clock(indio_dev); 1440bc2b7dabSGregor Boirie 1441bc2b7dabSGregor Boirie switch (clk) { 1442bc2b7dabSGregor Boirie case CLOCK_REALTIME: 1443bc2b7dabSGregor Boirie case CLOCK_MONOTONIC: 1444bc2b7dabSGregor Boirie case CLOCK_MONOTONIC_RAW: 1445bc2b7dabSGregor Boirie case CLOCK_REALTIME_COARSE: 1446bc2b7dabSGregor Boirie case CLOCK_MONOTONIC_COARSE: 1447bc2b7dabSGregor Boirie case CLOCK_BOOTTIME: 1448bc2b7dabSGregor Boirie case CLOCK_TAI: 1449bc2b7dabSGregor Boirie break; 1450bc2b7dabSGregor Boirie default: 1451bc2b7dabSGregor Boirie BUG(); 1452bc2b7dabSGregor Boirie } 1453bc2b7dabSGregor Boirie 1454971ddd4bSAndy Shevchenko return sysfs_emit(buf, "%s\n", clock_names[clk]); 1455bc2b7dabSGregor Boirie } 1456bc2b7dabSGregor Boirie 14579cf0b618SJoe Simmons-Talbott static ssize_t current_timestamp_clock_store(struct device *dev, 1458bc2b7dabSGregor Boirie struct device_attribute *attr, 1459bc2b7dabSGregor Boirie const char *buf, size_t len) 1460bc2b7dabSGregor Boirie { 1461bc2b7dabSGregor Boirie clockid_t clk; 1462bc2b7dabSGregor Boirie int ret; 1463bc2b7dabSGregor Boirie 1464971ddd4bSAndy Shevchenko ret = sysfs_match_string(clock_names, buf); 1465971ddd4bSAndy Shevchenko if (ret < 0) 1466971ddd4bSAndy Shevchenko return ret; 1467971ddd4bSAndy Shevchenko clk = ret; 1468971ddd4bSAndy Shevchenko 1469971ddd4bSAndy Shevchenko switch (clk) { 1470971ddd4bSAndy Shevchenko case CLOCK_REALTIME: 1471971ddd4bSAndy Shevchenko case CLOCK_MONOTONIC: 1472971ddd4bSAndy Shevchenko case CLOCK_MONOTONIC_RAW: 1473971ddd4bSAndy Shevchenko case CLOCK_REALTIME_COARSE: 1474971ddd4bSAndy Shevchenko case CLOCK_MONOTONIC_COARSE: 1475971ddd4bSAndy Shevchenko case CLOCK_BOOTTIME: 1476971ddd4bSAndy Shevchenko case CLOCK_TAI: 1477971ddd4bSAndy Shevchenko break; 1478971ddd4bSAndy Shevchenko default: 1479bc2b7dabSGregor Boirie return -EINVAL; 1480971ddd4bSAndy Shevchenko } 1481bc2b7dabSGregor Boirie 1482bc2b7dabSGregor Boirie ret = iio_device_set_clock(dev_to_iio_dev(dev), clk); 1483bc2b7dabSGregor Boirie if (ret) 1484bc2b7dabSGregor Boirie return ret; 1485bc2b7dabSGregor Boirie 1486bc2b7dabSGregor Boirie return len; 1487bc2b7dabSGregor Boirie } 1488bc2b7dabSGregor Boirie 148932f17172SAlexandru Ardelean int iio_device_register_sysfs_group(struct iio_dev *indio_dev, 149032f17172SAlexandru Ardelean const struct attribute_group *group) 149132f17172SAlexandru Ardelean { 149232f17172SAlexandru Ardelean struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 149332f17172SAlexandru Ardelean const struct attribute_group **new, **old = iio_dev_opaque->groups; 149432f17172SAlexandru Ardelean unsigned int cnt = iio_dev_opaque->groupcounter; 149532f17172SAlexandru Ardelean 14965a0821e0SAndy Shevchenko new = krealloc_array(old, cnt + 2, sizeof(*new), GFP_KERNEL); 149732f17172SAlexandru Ardelean if (!new) 149832f17172SAlexandru Ardelean return -ENOMEM; 149932f17172SAlexandru Ardelean 150032f17172SAlexandru Ardelean new[iio_dev_opaque->groupcounter++] = group; 150132f17172SAlexandru Ardelean new[iio_dev_opaque->groupcounter] = NULL; 150232f17172SAlexandru Ardelean 150332f17172SAlexandru Ardelean iio_dev_opaque->groups = new; 150432f17172SAlexandru Ardelean 150532f17172SAlexandru Ardelean return 0; 150632f17172SAlexandru Ardelean } 150732f17172SAlexandru Ardelean 15089cf0b618SJoe Simmons-Talbott static DEVICE_ATTR_RW(current_timestamp_clock); 1509bc2b7dabSGregor Boirie 1510a980e046SJonathan Cameron static int iio_device_register_sysfs(struct iio_dev *indio_dev) 1511a980e046SJonathan Cameron { 1512207c2d27SAlexandru Ardelean struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 1513a980e046SJonathan Cameron int i, ret = 0, attrcount, attrn, attrcount_orig = 0; 151484088ebdSLars-Peter Clausen struct iio_dev_attr *p; 1515bc2b7dabSGregor Boirie struct attribute **attr, *clk = NULL; 1516a980e046SJonathan Cameron 1517a980e046SJonathan Cameron /* First count elements in any existing group */ 1518a980e046SJonathan Cameron if (indio_dev->info->attrs) { 1519a980e046SJonathan Cameron attr = indio_dev->info->attrs->attrs; 1520a980e046SJonathan Cameron while (*attr++ != NULL) 1521a980e046SJonathan Cameron attrcount_orig++; 1522a980e046SJonathan Cameron } 1523a980e046SJonathan Cameron attrcount = attrcount_orig; 1524a980e046SJonathan Cameron /* 1525a980e046SJonathan Cameron * New channel registration method - relies on the fact a group does 1526d25b3808SPeter Meerwald * not need to be initialized if its name is NULL. 1527a980e046SJonathan Cameron */ 1528a980e046SJonathan Cameron if (indio_dev->channels) 1529a980e046SJonathan Cameron for (i = 0; i < indio_dev->num_channels; i++) { 1530bc2b7dabSGregor Boirie const struct iio_chan_spec *chan = 1531bc2b7dabSGregor Boirie &indio_dev->channels[i]; 1532bc2b7dabSGregor Boirie 1533bc2b7dabSGregor Boirie if (chan->type == IIO_TIMESTAMP) 1534bc2b7dabSGregor Boirie clk = &dev_attr_current_timestamp_clock.attr; 1535bc2b7dabSGregor Boirie 1536bc2b7dabSGregor Boirie ret = iio_device_add_channel_sysfs(indio_dev, chan); 1537a980e046SJonathan Cameron if (ret < 0) 1538a980e046SJonathan Cameron goto error_clear_attrs; 1539a980e046SJonathan Cameron attrcount += ret; 1540a980e046SJonathan Cameron } 1541a980e046SJonathan Cameron 1542fa83c3baSAlexandru Ardelean if (iio_dev_opaque->event_interface) 1543bc2b7dabSGregor Boirie clk = &dev_attr_current_timestamp_clock.attr; 1544bc2b7dabSGregor Boirie 1545a980e046SJonathan Cameron if (indio_dev->name) 1546a980e046SJonathan Cameron attrcount++; 15472c3d0c9fSPhil Reid if (indio_dev->label) 15482c3d0c9fSPhil Reid attrcount++; 1549bc2b7dabSGregor Boirie if (clk) 1550bc2b7dabSGregor Boirie attrcount++; 1551a980e046SJonathan Cameron 1552207c2d27SAlexandru Ardelean iio_dev_opaque->chan_attr_group.attrs = 1553207c2d27SAlexandru Ardelean kcalloc(attrcount + 1, 1554207c2d27SAlexandru Ardelean sizeof(iio_dev_opaque->chan_attr_group.attrs[0]), 1555a980e046SJonathan Cameron GFP_KERNEL); 1556207c2d27SAlexandru Ardelean if (iio_dev_opaque->chan_attr_group.attrs == NULL) { 1557a980e046SJonathan Cameron ret = -ENOMEM; 1558a980e046SJonathan Cameron goto error_clear_attrs; 1559a980e046SJonathan Cameron } 1560e0d27ea3SAndrea Merello /* Copy across original attributes, and point to original binary attributes */ 156118b4c9cdSHans de Goede if (indio_dev->info->attrs) { 1562207c2d27SAlexandru Ardelean memcpy(iio_dev_opaque->chan_attr_group.attrs, 1563a980e046SJonathan Cameron indio_dev->info->attrs->attrs, 1564207c2d27SAlexandru Ardelean sizeof(iio_dev_opaque->chan_attr_group.attrs[0]) 1565a980e046SJonathan Cameron *attrcount_orig); 156618b4c9cdSHans de Goede iio_dev_opaque->chan_attr_group.is_visible = 156718b4c9cdSHans de Goede indio_dev->info->attrs->is_visible; 1568e0d27ea3SAndrea Merello iio_dev_opaque->chan_attr_group.bin_attrs = 1569e0d27ea3SAndrea Merello indio_dev->info->attrs->bin_attrs; 157018b4c9cdSHans de Goede } 1571a980e046SJonathan Cameron attrn = attrcount_orig; 1572a980e046SJonathan Cameron /* Add all elements from the list. */ 1573207c2d27SAlexandru Ardelean list_for_each_entry(p, &iio_dev_opaque->channel_attr_list, l) 1574207c2d27SAlexandru Ardelean iio_dev_opaque->chan_attr_group.attrs[attrn++] = &p->dev_attr.attr; 1575a980e046SJonathan Cameron if (indio_dev->name) 1576207c2d27SAlexandru Ardelean iio_dev_opaque->chan_attr_group.attrs[attrn++] = &dev_attr_name.attr; 15772c3d0c9fSPhil Reid if (indio_dev->label) 1578207c2d27SAlexandru Ardelean iio_dev_opaque->chan_attr_group.attrs[attrn++] = &dev_attr_label.attr; 1579bc2b7dabSGregor Boirie if (clk) 1580207c2d27SAlexandru Ardelean iio_dev_opaque->chan_attr_group.attrs[attrn++] = clk; 1581a980e046SJonathan Cameron 158232f17172SAlexandru Ardelean ret = iio_device_register_sysfs_group(indio_dev, 158332f17172SAlexandru Ardelean &iio_dev_opaque->chan_attr_group); 158432f17172SAlexandru Ardelean if (ret) 158532f17172SAlexandru Ardelean goto error_clear_attrs; 1586a980e046SJonathan Cameron 1587a980e046SJonathan Cameron return 0; 1588a980e046SJonathan Cameron 1589a980e046SJonathan Cameron error_clear_attrs: 1590207c2d27SAlexandru Ardelean iio_free_chan_devattr_list(&iio_dev_opaque->channel_attr_list); 1591a980e046SJonathan Cameron 1592a980e046SJonathan Cameron return ret; 1593a980e046SJonathan Cameron } 1594a980e046SJonathan Cameron 1595a980e046SJonathan Cameron static void iio_device_unregister_sysfs(struct iio_dev *indio_dev) 1596a980e046SJonathan Cameron { 1597207c2d27SAlexandru Ardelean struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 1598a980e046SJonathan Cameron 1599207c2d27SAlexandru Ardelean iio_free_chan_devattr_list(&iio_dev_opaque->channel_attr_list); 1600207c2d27SAlexandru Ardelean kfree(iio_dev_opaque->chan_attr_group.attrs); 1601207c2d27SAlexandru Ardelean iio_dev_opaque->chan_attr_group.attrs = NULL; 160232f17172SAlexandru Ardelean kfree(iio_dev_opaque->groups); 160319833c40SYang Yingliang iio_dev_opaque->groups = NULL; 1604a980e046SJonathan Cameron } 1605a980e046SJonathan Cameron 1606a980e046SJonathan Cameron static void iio_dev_release(struct device *device) 1607a980e046SJonathan Cameron { 1608e53f5ac5SLars-Peter Clausen struct iio_dev *indio_dev = dev_to_iio_dev(device); 16096d4ebd56SAlexandru Ardelean struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 16106d4ebd56SAlexandru Ardelean 1611d89e119aSBenjamin Gaignard if (indio_dev->modes & INDIO_ALL_TRIGGERED_MODES) 1612a980e046SJonathan Cameron iio_device_unregister_trigger_consumer(indio_dev); 1613a980e046SJonathan Cameron iio_device_unregister_eventset(indio_dev); 1614a980e046SJonathan Cameron iio_device_unregister_sysfs(indio_dev); 1615e407fd65SLars-Peter Clausen 1616218bc53dSAlexandru Ardelean iio_device_detach_buffers(indio_dev); 16179e69c935SLars-Peter Clausen 16182bc9cd66SVincent Whitchurch lockdep_unregister_key(&iio_dev_opaque->mlock_key); 16192bc9cd66SVincent Whitchurch 1620319dbcd8Skeliu ida_free(&iio_ida, iio_dev_opaque->id); 16216d4ebd56SAlexandru Ardelean kfree(iio_dev_opaque); 1622a980e046SJonathan Cameron } 1623a980e046SJonathan Cameron 16243c33b7b8SLars-Peter Clausen const struct device_type iio_device_type = { 1625a980e046SJonathan Cameron .name = "iio_device", 1626a980e046SJonathan Cameron .release = iio_dev_release, 1627a980e046SJonathan Cameron }; 1628a980e046SJonathan Cameron 1629a7e57dceSSachin Kamat /** 1630a7e57dceSSachin Kamat * iio_device_alloc() - allocate an iio_dev from a driver 1631c9561fd2SJonathan Cameron * @parent: Parent device. 1632a7e57dceSSachin Kamat * @sizeof_priv: Space to allocate for private structure. 163365659a8dSAndy Shevchenko * 163465659a8dSAndy Shevchenko * Returns: 163565659a8dSAndy Shevchenko * Pointer to allocated iio_dev on success, NULL on failure. 163665659a8dSAndy Shevchenko */ 163778289b4aSAlexandru Ardelean struct iio_dev *iio_device_alloc(struct device *parent, int sizeof_priv) 1638a980e046SJonathan Cameron { 16396d4ebd56SAlexandru Ardelean struct iio_dev_opaque *iio_dev_opaque; 16400d596bb2SAlexandru Ardelean struct iio_dev *indio_dev; 1641a980e046SJonathan Cameron size_t alloc_size; 1642a980e046SJonathan Cameron 16436d4ebd56SAlexandru Ardelean alloc_size = sizeof(struct iio_dev_opaque); 1644a980e046SJonathan Cameron if (sizeof_priv) { 164512c4efe3SJonathan Cameron alloc_size = ALIGN(alloc_size, IIO_DMA_MINALIGN); 1646a980e046SJonathan Cameron alloc_size += sizeof_priv; 1647a980e046SJonathan Cameron } 1648a980e046SJonathan Cameron 16496d4ebd56SAlexandru Ardelean iio_dev_opaque = kzalloc(alloc_size, GFP_KERNEL); 16506d4ebd56SAlexandru Ardelean if (!iio_dev_opaque) 16510d4b2184SJonathan Cameron return NULL; 1652a980e046SJonathan Cameron 16530d596bb2SAlexandru Ardelean indio_dev = &iio_dev_opaque->indio_dev; 16540d596bb2SAlexandru Ardelean indio_dev->priv = (char *)iio_dev_opaque + 165512c4efe3SJonathan Cameron ALIGN(sizeof(struct iio_dev_opaque), IIO_DMA_MINALIGN); 16566d4ebd56SAlexandru Ardelean 16570d596bb2SAlexandru Ardelean indio_dev->dev.parent = parent; 16580d596bb2SAlexandru Ardelean indio_dev->dev.type = &iio_device_type; 16590d596bb2SAlexandru Ardelean indio_dev->dev.bus = &iio_bus_type; 16600d596bb2SAlexandru Ardelean device_initialize(&indio_dev->dev); 166116afe125SNuno Sá mutex_init(&iio_dev_opaque->mlock); 1662b804e2b7SJonathan Cameron mutex_init(&iio_dev_opaque->info_exist_lock); 1663207c2d27SAlexandru Ardelean INIT_LIST_HEAD(&iio_dev_opaque->channel_attr_list); 1664a980e046SJonathan Cameron 1665319dbcd8Skeliu iio_dev_opaque->id = ida_alloc(&iio_ida, GFP_KERNEL); 166615ea2878SJonathan Cameron if (iio_dev_opaque->id < 0) { 1667a980e046SJonathan Cameron /* cannot use a dev_err as the name isn't available */ 16683176dd5dSSachin Kamat pr_err("failed to get device id\n"); 16696d4ebd56SAlexandru Ardelean kfree(iio_dev_opaque); 1670a980e046SJonathan Cameron return NULL; 1671a980e046SJonathan Cameron } 1672fe6f45f6SYang Yingliang 1673fe6f45f6SYang Yingliang if (dev_set_name(&indio_dev->dev, "iio:device%d", iio_dev_opaque->id)) { 1674319dbcd8Skeliu ida_free(&iio_ida, iio_dev_opaque->id); 1675fe6f45f6SYang Yingliang kfree(iio_dev_opaque); 1676fe6f45f6SYang Yingliang return NULL; 1677fe6f45f6SYang Yingliang } 1678fe6f45f6SYang Yingliang 16796a8c6b26SAlexandru Ardelean INIT_LIST_HEAD(&iio_dev_opaque->buffer_list); 16808dedcc3eSAlexandru Ardelean INIT_LIST_HEAD(&iio_dev_opaque->ioctl_handlers); 1681a980e046SJonathan Cameron 16822bc9cd66SVincent Whitchurch lockdep_register_key(&iio_dev_opaque->mlock_key); 168316afe125SNuno Sá lockdep_set_class(&iio_dev_opaque->mlock, &iio_dev_opaque->mlock_key); 16842bc9cd66SVincent Whitchurch 16850d596bb2SAlexandru Ardelean return indio_dev; 1686a980e046SJonathan Cameron } 16877cbb7537SLars-Peter Clausen EXPORT_SYMBOL(iio_device_alloc); 1688a980e046SJonathan Cameron 1689a7e57dceSSachin Kamat /** 1690a7e57dceSSachin Kamat * iio_device_free() - free an iio_dev from a driver 1691a7e57dceSSachin Kamat * @dev: the iio_dev associated with the device 169265659a8dSAndy Shevchenko */ 16937cbb7537SLars-Peter Clausen void iio_device_free(struct iio_dev *dev) 1694a980e046SJonathan Cameron { 1695e407fd65SLars-Peter Clausen if (dev) 1696e407fd65SLars-Peter Clausen put_device(&dev->dev); 1697a980e046SJonathan Cameron } 16987cbb7537SLars-Peter Clausen EXPORT_SYMBOL(iio_device_free); 1699a980e046SJonathan Cameron 1700cf5724e9SYicong Yang static void devm_iio_device_release(void *iio_dev) 17019dabaf5eSGrygorii Strashko { 1702cf5724e9SYicong Yang iio_device_free(iio_dev); 17039dabaf5eSGrygorii Strashko } 17049dabaf5eSGrygorii Strashko 1705a7e57dceSSachin Kamat /** 1706a7e57dceSSachin Kamat * devm_iio_device_alloc - Resource-managed iio_device_alloc() 170778289b4aSAlexandru Ardelean * @parent: Device to allocate iio_dev for, and parent for this IIO device 1708a7e57dceSSachin Kamat * @sizeof_priv: Space to allocate for private structure. 1709a7e57dceSSachin Kamat * 1710a7e57dceSSachin Kamat * Managed iio_device_alloc. iio_dev allocated with this function is 1711a7e57dceSSachin Kamat * automatically freed on driver detach. 1712a7e57dceSSachin Kamat * 171365659a8dSAndy Shevchenko * Returns: 1714a7e57dceSSachin Kamat * Pointer to allocated iio_dev on success, NULL on failure. 1715a7e57dceSSachin Kamat */ 171678289b4aSAlexandru Ardelean struct iio_dev *devm_iio_device_alloc(struct device *parent, int sizeof_priv) 17179dabaf5eSGrygorii Strashko { 1718cf5724e9SYicong Yang struct iio_dev *iio_dev; 1719cf5724e9SYicong Yang int ret; 17209dabaf5eSGrygorii Strashko 172178289b4aSAlexandru Ardelean iio_dev = iio_device_alloc(parent, sizeof_priv); 1722cf5724e9SYicong Yang if (!iio_dev) 1723cf5724e9SYicong Yang return NULL; 1724cf5724e9SYicong Yang 1725cf5724e9SYicong Yang ret = devm_add_action_or_reset(parent, devm_iio_device_release, 1726cf5724e9SYicong Yang iio_dev); 1727cf5724e9SYicong Yang if (ret) 172843fa7394SDan Carpenter return NULL; 17299dabaf5eSGrygorii Strashko 17309dabaf5eSGrygorii Strashko return iio_dev; 17319dabaf5eSGrygorii Strashko } 17329dabaf5eSGrygorii Strashko EXPORT_SYMBOL_GPL(devm_iio_device_alloc); 17339dabaf5eSGrygorii Strashko 1734a7e57dceSSachin Kamat /** 1735a980e046SJonathan Cameron * iio_chrdev_open() - chrdev file open for buffer access and ioctls 17362498dcf6SCristina Opriceana * @inode: Inode structure for identifying the device in the file system 17372498dcf6SCristina Opriceana * @filp: File structure for iio device used to keep and later access 17382498dcf6SCristina Opriceana * private data 17392498dcf6SCristina Opriceana * 174065659a8dSAndy Shevchenko * Returns: 0 on success or -EBUSY if the device is already opened 174165659a8dSAndy Shevchenko */ 1742a980e046SJonathan Cameron static int iio_chrdev_open(struct inode *inode, struct file *filp) 1743a980e046SJonathan Cameron { 1744396f7234SJonathan Cameron struct iio_dev_opaque *iio_dev_opaque = 1745396f7234SJonathan Cameron container_of(inode->i_cdev, struct iio_dev_opaque, chrdev); 1746396f7234SJonathan Cameron struct iio_dev *indio_dev = &iio_dev_opaque->indio_dev; 1747be24dcb1SAlexandru Ardelean struct iio_dev_buffer_pair *ib; 1748a980e046SJonathan Cameron 17498b1c82cbSJonathan Cameron if (test_and_set_bit(IIO_BUSY_BIT_POS, &iio_dev_opaque->flags)) 1750a980e046SJonathan Cameron return -EBUSY; 1751a980e046SJonathan Cameron 1752cadc2125SLars-Peter Clausen iio_device_get(indio_dev); 1753cadc2125SLars-Peter Clausen 1754be24dcb1SAlexandru Ardelean ib = kmalloc(sizeof(*ib), GFP_KERNEL); 1755be24dcb1SAlexandru Ardelean if (!ib) { 1756be24dcb1SAlexandru Ardelean iio_device_put(indio_dev); 17578b1c82cbSJonathan Cameron clear_bit(IIO_BUSY_BIT_POS, &iio_dev_opaque->flags); 1758be24dcb1SAlexandru Ardelean return -ENOMEM; 1759be24dcb1SAlexandru Ardelean } 1760be24dcb1SAlexandru Ardelean 1761be24dcb1SAlexandru Ardelean ib->indio_dev = indio_dev; 1762be24dcb1SAlexandru Ardelean ib->buffer = indio_dev->buffer; 1763be24dcb1SAlexandru Ardelean 1764be24dcb1SAlexandru Ardelean filp->private_data = ib; 1765a980e046SJonathan Cameron 1766a980e046SJonathan Cameron return 0; 1767a980e046SJonathan Cameron } 1768a980e046SJonathan Cameron 1769a980e046SJonathan Cameron /** 1770a980e046SJonathan Cameron * iio_chrdev_release() - chrdev file close buffer access and ioctls 17712498dcf6SCristina Opriceana * @inode: Inode structure pointer for the char device 17722498dcf6SCristina Opriceana * @filp: File structure pointer for the char device 17732498dcf6SCristina Opriceana * 177465659a8dSAndy Shevchenko * Returns: 0 for successful release. 17752498dcf6SCristina Opriceana */ 1776a980e046SJonathan Cameron static int iio_chrdev_release(struct inode *inode, struct file *filp) 1777a980e046SJonathan Cameron { 1778be24dcb1SAlexandru Ardelean struct iio_dev_buffer_pair *ib = filp->private_data; 1779396f7234SJonathan Cameron struct iio_dev_opaque *iio_dev_opaque = 1780396f7234SJonathan Cameron container_of(inode->i_cdev, struct iio_dev_opaque, chrdev); 1781396f7234SJonathan Cameron struct iio_dev *indio_dev = &iio_dev_opaque->indio_dev; 17829d9ec8d0SJoe Simmons-Talbott 1783be24dcb1SAlexandru Ardelean kfree(ib); 17848b1c82cbSJonathan Cameron clear_bit(IIO_BUSY_BIT_POS, &iio_dev_opaque->flags); 1785cadc2125SLars-Peter Clausen iio_device_put(indio_dev); 1786cadc2125SLars-Peter Clausen 1787a980e046SJonathan Cameron return 0; 1788a980e046SJonathan Cameron } 1789a980e046SJonathan Cameron 17908dedcc3eSAlexandru Ardelean void iio_device_ioctl_handler_register(struct iio_dev *indio_dev, 17918dedcc3eSAlexandru Ardelean struct iio_ioctl_handler *h) 17928dedcc3eSAlexandru Ardelean { 17938dedcc3eSAlexandru Ardelean struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 17948dedcc3eSAlexandru Ardelean 17958dedcc3eSAlexandru Ardelean list_add_tail(&h->entry, &iio_dev_opaque->ioctl_handlers); 17968dedcc3eSAlexandru Ardelean } 17978dedcc3eSAlexandru Ardelean 17988dedcc3eSAlexandru Ardelean void iio_device_ioctl_handler_unregister(struct iio_ioctl_handler *h) 17998dedcc3eSAlexandru Ardelean { 18008dedcc3eSAlexandru Ardelean list_del(&h->entry); 18018dedcc3eSAlexandru Ardelean } 18028dedcc3eSAlexandru Ardelean 1803a980e046SJonathan Cameron static long iio_ioctl(struct file *filp, unsigned int cmd, unsigned long arg) 1804a980e046SJonathan Cameron { 1805be24dcb1SAlexandru Ardelean struct iio_dev_buffer_pair *ib = filp->private_data; 1806be24dcb1SAlexandru Ardelean struct iio_dev *indio_dev = ib->indio_dev; 18078dedcc3eSAlexandru Ardelean struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 18088dedcc3eSAlexandru Ardelean struct iio_ioctl_handler *h; 18098dedcc3eSAlexandru Ardelean int ret = -ENODEV; 1810a980e046SJonathan Cameron 1811b804e2b7SJonathan Cameron mutex_lock(&iio_dev_opaque->info_exist_lock); 18128dedcc3eSAlexandru Ardelean 181365659a8dSAndy Shevchenko /* 18148dedcc3eSAlexandru Ardelean * The NULL check here is required to prevent crashing when a device 18158dedcc3eSAlexandru Ardelean * is being removed while userspace would still have open file handles 18168dedcc3eSAlexandru Ardelean * to try to access this device. 18178dedcc3eSAlexandru Ardelean */ 1818f18e7a06SLars-Peter Clausen if (!indio_dev->info) 18198dedcc3eSAlexandru Ardelean goto out_unlock; 1820f18e7a06SLars-Peter Clausen 18218dedcc3eSAlexandru Ardelean list_for_each_entry(h, &iio_dev_opaque->ioctl_handlers, entry) { 18228dedcc3eSAlexandru Ardelean ret = h->ioctl(indio_dev, filp, cmd, arg); 18238dedcc3eSAlexandru Ardelean if (ret != IIO_IOCTL_UNHANDLED) 18248dedcc3eSAlexandru Ardelean break; 1825a980e046SJonathan Cameron } 18268dedcc3eSAlexandru Ardelean 182774d826daSAlexandru Ardelean if (ret == IIO_IOCTL_UNHANDLED) 1828af0670b0SAlexandru Ardelean ret = -ENODEV; 182974d826daSAlexandru Ardelean 18308dedcc3eSAlexandru Ardelean out_unlock: 1831b804e2b7SJonathan Cameron mutex_unlock(&iio_dev_opaque->info_exist_lock); 18328dedcc3eSAlexandru Ardelean 18338dedcc3eSAlexandru Ardelean return ret; 1834a980e046SJonathan Cameron } 1835a980e046SJonathan Cameron 1836a980e046SJonathan Cameron static const struct file_operations iio_buffer_fileops = { 1837a980e046SJonathan Cameron .owner = THIS_MODULE, 1838a980e046SJonathan Cameron .llseek = noop_llseek, 1839ee8caea0SAlexandru Ardelean .read = iio_buffer_read_outer_addr, 18409eeee3b0SMihail Chindris .write = iio_buffer_write_outer_addr, 1841ee8caea0SAlexandru Ardelean .poll = iio_buffer_poll_addr, 1842a980e046SJonathan Cameron .unlocked_ioctl = iio_ioctl, 18431832f2d8SArnd Bergmann .compat_ioctl = compat_ptr_ioctl, 1844ee8caea0SAlexandru Ardelean .open = iio_chrdev_open, 1845ee8caea0SAlexandru Ardelean .release = iio_chrdev_release, 1846a980e046SJonathan Cameron }; 1847a980e046SJonathan Cameron 18488ebaa3ffSAlexandru Ardelean static const struct file_operations iio_event_fileops = { 18498ebaa3ffSAlexandru Ardelean .owner = THIS_MODULE, 18508ebaa3ffSAlexandru Ardelean .llseek = noop_llseek, 18518ebaa3ffSAlexandru Ardelean .unlocked_ioctl = iio_ioctl, 18528ebaa3ffSAlexandru Ardelean .compat_ioctl = compat_ptr_ioctl, 18538ebaa3ffSAlexandru Ardelean .open = iio_chrdev_open, 18548ebaa3ffSAlexandru Ardelean .release = iio_chrdev_release, 18558ebaa3ffSAlexandru Ardelean }; 18568ebaa3ffSAlexandru Ardelean 18578f5d8727SVlad Dogaru static int iio_check_unique_scan_index(struct iio_dev *indio_dev) 18588f5d8727SVlad Dogaru { 18598f5d8727SVlad Dogaru int i, j; 18608f5d8727SVlad Dogaru const struct iio_chan_spec *channels = indio_dev->channels; 18618f5d8727SVlad Dogaru 18628f5d8727SVlad Dogaru if (!(indio_dev->modes & INDIO_ALL_BUFFER_MODES)) 18638f5d8727SVlad Dogaru return 0; 18648f5d8727SVlad Dogaru 18658f5d8727SVlad Dogaru for (i = 0; i < indio_dev->num_channels - 1; i++) { 18668f5d8727SVlad Dogaru if (channels[i].scan_index < 0) 18678f5d8727SVlad Dogaru continue; 18688f5d8727SVlad Dogaru for (j = i + 1; j < indio_dev->num_channels; j++) 18698f5d8727SVlad Dogaru if (channels[i].scan_index == channels[j].scan_index) { 18708f5d8727SVlad Dogaru dev_err(&indio_dev->dev, 18718f5d8727SVlad Dogaru "Duplicate scan index %d\n", 18728f5d8727SVlad Dogaru channels[i].scan_index); 18738f5d8727SVlad Dogaru return -EINVAL; 18748f5d8727SVlad Dogaru } 18758f5d8727SVlad Dogaru } 18768f5d8727SVlad Dogaru 18778f5d8727SVlad Dogaru return 0; 18788f5d8727SVlad Dogaru } 18798f5d8727SVlad Dogaru 18800e0761f8SPaul Cercueil static int iio_check_extended_name(const struct iio_dev *indio_dev) 18810e0761f8SPaul Cercueil { 18820e0761f8SPaul Cercueil unsigned int i; 18830e0761f8SPaul Cercueil 18840e0761f8SPaul Cercueil if (!indio_dev->info->read_label) 18850e0761f8SPaul Cercueil return 0; 18860e0761f8SPaul Cercueil 18870e0761f8SPaul Cercueil for (i = 0; i < indio_dev->num_channels; i++) { 18880e0761f8SPaul Cercueil if (indio_dev->channels[i].extend_name) { 18890e0761f8SPaul Cercueil dev_err(&indio_dev->dev, 18900e0761f8SPaul Cercueil "Cannot use labels and extend_name at the same time\n"); 18910e0761f8SPaul Cercueil return -EINVAL; 18920e0761f8SPaul Cercueil } 18930e0761f8SPaul Cercueil } 18940e0761f8SPaul Cercueil 18950e0761f8SPaul Cercueil return 0; 18960e0761f8SPaul Cercueil } 18970e0761f8SPaul Cercueil 1898a980e046SJonathan Cameron static const struct iio_buffer_setup_ops noop_ring_setup_ops; 1899a980e046SJonathan Cameron 19002718f154SMatti Vaittinen static void iio_sanity_check_avail_scan_masks(struct iio_dev *indio_dev) 19012718f154SMatti Vaittinen { 19022718f154SMatti Vaittinen unsigned int num_masks, masklength, longs_per_mask; 19032718f154SMatti Vaittinen const unsigned long *av_masks; 19042718f154SMatti Vaittinen int i; 19052718f154SMatti Vaittinen 19062718f154SMatti Vaittinen av_masks = indio_dev->available_scan_masks; 19072718f154SMatti Vaittinen masklength = indio_dev->masklength; 19082718f154SMatti Vaittinen longs_per_mask = BITS_TO_LONGS(masklength); 19092718f154SMatti Vaittinen 19102718f154SMatti Vaittinen /* 19112718f154SMatti Vaittinen * The code determining how many available_scan_masks is in the array 19122718f154SMatti Vaittinen * will be assuming the end of masks when first long with all bits 19132718f154SMatti Vaittinen * zeroed is encountered. This is incorrect for masks where mask 19142718f154SMatti Vaittinen * consists of more than one long, and where some of the available masks 19152718f154SMatti Vaittinen * has long worth of bits zeroed (but has subsequent bit(s) set). This 19162718f154SMatti Vaittinen * is a safety measure against bug where array of masks is terminated by 19172718f154SMatti Vaittinen * a single zero while mask width is greater than width of a long. 19182718f154SMatti Vaittinen */ 19192718f154SMatti Vaittinen if (longs_per_mask > 1) 19202718f154SMatti Vaittinen dev_warn(indio_dev->dev.parent, 19212718f154SMatti Vaittinen "multi long available scan masks not fully supported\n"); 19222718f154SMatti Vaittinen 19232718f154SMatti Vaittinen if (bitmap_empty(av_masks, masklength)) 19242718f154SMatti Vaittinen dev_warn(indio_dev->dev.parent, "empty scan mask\n"); 19252718f154SMatti Vaittinen 19262718f154SMatti Vaittinen for (num_masks = 0; *av_masks; num_masks++) 19272718f154SMatti Vaittinen av_masks += longs_per_mask; 19282718f154SMatti Vaittinen 19292718f154SMatti Vaittinen if (num_masks < 2) 19302718f154SMatti Vaittinen return; 19312718f154SMatti Vaittinen 19322718f154SMatti Vaittinen av_masks = indio_dev->available_scan_masks; 19332718f154SMatti Vaittinen 19342718f154SMatti Vaittinen /* 19352718f154SMatti Vaittinen * Go through all the masks from first to one before the last, and see 19362718f154SMatti Vaittinen * that no mask found later from the available_scan_masks array is a 19372718f154SMatti Vaittinen * subset of mask found earlier. If this happens, then the mask found 19382718f154SMatti Vaittinen * later will never get used because scanning the array is stopped when 19392718f154SMatti Vaittinen * the first suitable mask is found. Drivers should order the array of 19402718f154SMatti Vaittinen * available masks in the order of preference (presumably the least 19412718f154SMatti Vaittinen * costy to access masks first). 19422718f154SMatti Vaittinen */ 19432718f154SMatti Vaittinen for (i = 0; i < num_masks - 1; i++) { 19442718f154SMatti Vaittinen const unsigned long *mask1; 19452718f154SMatti Vaittinen int j; 19462718f154SMatti Vaittinen 19472718f154SMatti Vaittinen mask1 = av_masks + i * longs_per_mask; 19482718f154SMatti Vaittinen for (j = i + 1; j < num_masks; j++) { 19492718f154SMatti Vaittinen const unsigned long *mask2; 19502718f154SMatti Vaittinen 19512718f154SMatti Vaittinen mask2 = av_masks + j * longs_per_mask; 19522718f154SMatti Vaittinen if (bitmap_subset(mask2, mask1, masklength)) 19532718f154SMatti Vaittinen dev_warn(indio_dev->dev.parent, 19542718f154SMatti Vaittinen "available_scan_mask %d subset of %d. Never used\n", 19552718f154SMatti Vaittinen j, i); 19562718f154SMatti Vaittinen } 19572718f154SMatti Vaittinen } 19582718f154SMatti Vaittinen } 19592718f154SMatti Vaittinen 196063b19547SJonathan Cameron int __iio_device_register(struct iio_dev *indio_dev, struct module *this_mod) 1961a980e046SJonathan Cameron { 19628ebaa3ffSAlexandru Ardelean struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 1963b2a69969SMilan Zamazal struct fwnode_handle *fwnode = NULL; 1964a980e046SJonathan Cameron int ret; 1965a980e046SJonathan Cameron 1966a17cb784SAlexandru Ardelean if (!indio_dev->info) 1967a17cb784SAlexandru Ardelean return -EINVAL; 1968a17cb784SAlexandru Ardelean 19696eaf9f6aSJonathan Cameron iio_dev_opaque->driver_module = this_mod; 197017d82b47SGuenter Roeck 197181366556SAndy Shevchenko /* If the calling driver did not initialize firmware node, do it here */ 197281366556SAndy Shevchenko if (dev_fwnode(&indio_dev->dev)) 197381366556SAndy Shevchenko fwnode = dev_fwnode(&indio_dev->dev); 1974b2a69969SMilan Zamazal /* The default dummy IIO device has no parent */ 1975b2a69969SMilan Zamazal else if (indio_dev->dev.parent) 197681366556SAndy Shevchenko fwnode = dev_fwnode(indio_dev->dev.parent); 197781366556SAndy Shevchenko device_set_node(&indio_dev->dev, fwnode); 197881366556SAndy Shevchenko 197981366556SAndy Shevchenko fwnode_property_read_string(fwnode, "label", &indio_dev->label); 19802c3d0c9fSPhil Reid 19818f5d8727SVlad Dogaru ret = iio_check_unique_scan_index(indio_dev); 19828f5d8727SVlad Dogaru if (ret < 0) 19838f5d8727SVlad Dogaru return ret; 19848f5d8727SVlad Dogaru 19850e0761f8SPaul Cercueil ret = iio_check_extended_name(indio_dev); 19860e0761f8SPaul Cercueil if (ret < 0) 19870e0761f8SPaul Cercueil return ret; 19880e0761f8SPaul Cercueil 19898915aacaSGreg Kroah-Hartman iio_device_register_debugfs(indio_dev); 19903e1b6c95SLars-Peter Clausen 1991ee708e6bSAlexandru Ardelean ret = iio_buffers_alloc_sysfs_and_mask(indio_dev); 19923e1b6c95SLars-Peter Clausen if (ret) { 19933e1b6c95SLars-Peter Clausen dev_err(indio_dev->dev.parent, 19943e1b6c95SLars-Peter Clausen "Failed to create buffer sysfs interfaces\n"); 19953e1b6c95SLars-Peter Clausen goto error_unreg_debugfs; 19963e1b6c95SLars-Peter Clausen } 19973e1b6c95SLars-Peter Clausen 19982718f154SMatti Vaittinen if (indio_dev->available_scan_masks) 19992718f154SMatti Vaittinen iio_sanity_check_avail_scan_masks(indio_dev); 20002718f154SMatti Vaittinen 2001a980e046SJonathan Cameron ret = iio_device_register_sysfs(indio_dev); 2002a980e046SJonathan Cameron if (ret) { 2003a980e046SJonathan Cameron dev_err(indio_dev->dev.parent, 2004a980e046SJonathan Cameron "Failed to register sysfs interfaces\n"); 20053e1b6c95SLars-Peter Clausen goto error_buffer_free_sysfs; 2006a980e046SJonathan Cameron } 2007a980e046SJonathan Cameron ret = iio_device_register_eventset(indio_dev); 2008a980e046SJonathan Cameron if (ret) { 2009a980e046SJonathan Cameron dev_err(indio_dev->dev.parent, 2010a980e046SJonathan Cameron "Failed to register event set\n"); 2011a980e046SJonathan Cameron goto error_free_sysfs; 2012a980e046SJonathan Cameron } 2013d89e119aSBenjamin Gaignard if (indio_dev->modes & INDIO_ALL_TRIGGERED_MODES) 2014a980e046SJonathan Cameron iio_device_register_trigger_consumer(indio_dev); 2015a980e046SJonathan Cameron 2016a980e046SJonathan Cameron if ((indio_dev->modes & INDIO_ALL_BUFFER_MODES) && 2017a980e046SJonathan Cameron indio_dev->setup_ops == NULL) 2018a980e046SJonathan Cameron indio_dev->setup_ops = &noop_ring_setup_ops; 2019a980e046SJonathan Cameron 2020ee708e6bSAlexandru Ardelean if (iio_dev_opaque->attached_buffers_cnt) 2021396f7234SJonathan Cameron cdev_init(&iio_dev_opaque->chrdev, &iio_buffer_fileops); 20228ebaa3ffSAlexandru Ardelean else if (iio_dev_opaque->event_interface) 2023396f7234SJonathan Cameron cdev_init(&iio_dev_opaque->chrdev, &iio_event_fileops); 202463b19547SJonathan Cameron 2025ee708e6bSAlexandru Ardelean if (iio_dev_opaque->attached_buffers_cnt || iio_dev_opaque->event_interface) { 202615ea2878SJonathan Cameron indio_dev->dev.devt = MKDEV(MAJOR(iio_devt), iio_dev_opaque->id); 2027396f7234SJonathan Cameron iio_dev_opaque->chrdev.owner = this_mod; 20288ebaa3ffSAlexandru Ardelean } 202938923911SLogan Gunthorpe 203032f17172SAlexandru Ardelean /* assign device groups now; they should be all registered now */ 203132f17172SAlexandru Ardelean indio_dev->dev.groups = iio_dev_opaque->groups; 203232f17172SAlexandru Ardelean 2033396f7234SJonathan Cameron ret = cdev_device_add(&iio_dev_opaque->chrdev, &indio_dev->dev); 2034a980e046SJonathan Cameron if (ret < 0) 20350d5b7daeSLars-Peter Clausen goto error_unreg_eventset; 2036a980e046SJonathan Cameron 20370d5b7daeSLars-Peter Clausen return 0; 203838923911SLogan Gunthorpe 2039a980e046SJonathan Cameron error_unreg_eventset: 2040a980e046SJonathan Cameron iio_device_unregister_eventset(indio_dev); 2041a980e046SJonathan Cameron error_free_sysfs: 2042a980e046SJonathan Cameron iio_device_unregister_sysfs(indio_dev); 20433e1b6c95SLars-Peter Clausen error_buffer_free_sysfs: 2044ee708e6bSAlexandru Ardelean iio_buffers_free_sysfs_and_mask(indio_dev); 2045a980e046SJonathan Cameron error_unreg_debugfs: 2046a980e046SJonathan Cameron iio_device_unregister_debugfs(indio_dev); 2047a980e046SJonathan Cameron return ret; 2048a980e046SJonathan Cameron } 204963b19547SJonathan Cameron EXPORT_SYMBOL(__iio_device_register); 2050a980e046SJonathan Cameron 2051a7e57dceSSachin Kamat /** 2052a7e57dceSSachin Kamat * iio_device_unregister() - unregister a device from the IIO subsystem 2053a7e57dceSSachin Kamat * @indio_dev: Device structure representing the device. 205465659a8dSAndy Shevchenko */ 2055a980e046SJonathan Cameron void iio_device_unregister(struct iio_dev *indio_dev) 2056a980e046SJonathan Cameron { 2057396f7234SJonathan Cameron struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 2058396f7234SJonathan Cameron 2059396f7234SJonathan Cameron cdev_device_del(&iio_dev_opaque->chrdev, &indio_dev->dev); 2060a87c82e4SLars-Peter Clausen 2061b804e2b7SJonathan Cameron mutex_lock(&iio_dev_opaque->info_exist_lock); 20627f75591fSFabrice Gasnier 2063bc4c9612SLars-Peter Clausen iio_device_unregister_debugfs(indio_dev); 20640d5b7daeSLars-Peter Clausen 2065a87c82e4SLars-Peter Clausen iio_disable_all_buffers(indio_dev); 2066a87c82e4SLars-Peter Clausen 2067a980e046SJonathan Cameron indio_dev->info = NULL; 2068d2f0a48fSLars-Peter Clausen 2069d2f0a48fSLars-Peter Clausen iio_device_wakeup_eventset(indio_dev); 2070d2f0a48fSLars-Peter Clausen iio_buffer_wakeup_poll(indio_dev); 2071d2f0a48fSLars-Peter Clausen 2072b804e2b7SJonathan Cameron mutex_unlock(&iio_dev_opaque->info_exist_lock); 20733e1b6c95SLars-Peter Clausen 2074ee708e6bSAlexandru Ardelean iio_buffers_free_sysfs_and_mask(indio_dev); 2075a980e046SJonathan Cameron } 2076a980e046SJonathan Cameron EXPORT_SYMBOL(iio_device_unregister); 20778caa07c0SSachin Kamat 2078cf5724e9SYicong Yang static void devm_iio_device_unreg(void *indio_dev) 20798caa07c0SSachin Kamat { 2080cf5724e9SYicong Yang iio_device_unregister(indio_dev); 20818caa07c0SSachin Kamat } 20828caa07c0SSachin Kamat 208363b19547SJonathan Cameron int __devm_iio_device_register(struct device *dev, struct iio_dev *indio_dev, 208463b19547SJonathan Cameron struct module *this_mod) 20858caa07c0SSachin Kamat { 20868caa07c0SSachin Kamat int ret; 20878caa07c0SSachin Kamat 208863b19547SJonathan Cameron ret = __iio_device_register(indio_dev, this_mod); 2089cf5724e9SYicong Yang if (ret) 20908caa07c0SSachin Kamat return ret; 2091cf5724e9SYicong Yang 2092cf5724e9SYicong Yang return devm_add_action_or_reset(dev, devm_iio_device_unreg, indio_dev); 20938caa07c0SSachin Kamat } 209463b19547SJonathan Cameron EXPORT_SYMBOL_GPL(__devm_iio_device_register); 20958caa07c0SSachin Kamat 20968caa07c0SSachin Kamat /** 209708a33805SAlison Schofield * iio_device_claim_direct_mode - Keep device in direct mode 209808a33805SAlison Schofield * @indio_dev: the iio_dev associated with the device 209908a33805SAlison Schofield * 210008a33805SAlison Schofield * If the device is in direct mode it is guaranteed to stay 210108a33805SAlison Schofield * that way until iio_device_release_direct_mode() is called. 210208a33805SAlison Schofield * 210308a33805SAlison Schofield * Use with iio_device_release_direct_mode() 210408a33805SAlison Schofield * 210565659a8dSAndy Shevchenko * Returns: 0 on success, -EBUSY on failure. 210608a33805SAlison Schofield */ 210708a33805SAlison Schofield int iio_device_claim_direct_mode(struct iio_dev *indio_dev) 210808a33805SAlison Schofield { 210916afe125SNuno Sá struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 211016afe125SNuno Sá 211116afe125SNuno Sá mutex_lock(&iio_dev_opaque->mlock); 211208a33805SAlison Schofield 211308a33805SAlison Schofield if (iio_buffer_enabled(indio_dev)) { 211416afe125SNuno Sá mutex_unlock(&iio_dev_opaque->mlock); 211508a33805SAlison Schofield return -EBUSY; 211608a33805SAlison Schofield } 211708a33805SAlison Schofield return 0; 211808a33805SAlison Schofield } 211908a33805SAlison Schofield EXPORT_SYMBOL_GPL(iio_device_claim_direct_mode); 212008a33805SAlison Schofield 212108a33805SAlison Schofield /** 212208a33805SAlison Schofield * iio_device_release_direct_mode - releases claim on direct mode 212308a33805SAlison Schofield * @indio_dev: the iio_dev associated with the device 212408a33805SAlison Schofield * 212508a33805SAlison Schofield * Release the claim. Device is no longer guaranteed to stay 212608a33805SAlison Schofield * in direct mode. 212708a33805SAlison Schofield * 212808a33805SAlison Schofield * Use with iio_device_claim_direct_mode() 212908a33805SAlison Schofield */ 213008a33805SAlison Schofield void iio_device_release_direct_mode(struct iio_dev *indio_dev) 213108a33805SAlison Schofield { 213216afe125SNuno Sá mutex_unlock(&to_iio_dev_opaque(indio_dev)->mlock); 213308a33805SAlison Schofield } 213408a33805SAlison Schofield EXPORT_SYMBOL_GPL(iio_device_release_direct_mode); 213508a33805SAlison Schofield 21368c576f87SMiquel Raynal /** 21370a856542SNuno Sá * iio_device_claim_buffer_mode - Keep device in buffer mode 21380a856542SNuno Sá * @indio_dev: the iio_dev associated with the device 21390a856542SNuno Sá * 21400a856542SNuno Sá * If the device is in buffer mode it is guaranteed to stay 21410a856542SNuno Sá * that way until iio_device_release_buffer_mode() is called. 21420a856542SNuno Sá * 21430a856542SNuno Sá * Use with iio_device_release_buffer_mode(). 21440a856542SNuno Sá * 21450a856542SNuno Sá * Returns: 0 on success, -EBUSY on failure. 21460a856542SNuno Sá */ 21470a856542SNuno Sá int iio_device_claim_buffer_mode(struct iio_dev *indio_dev) 21480a856542SNuno Sá { 214916afe125SNuno Sá struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 215016afe125SNuno Sá 215116afe125SNuno Sá mutex_lock(&iio_dev_opaque->mlock); 21520a856542SNuno Sá 21530a856542SNuno Sá if (iio_buffer_enabled(indio_dev)) 21540a856542SNuno Sá return 0; 21550a856542SNuno Sá 215616afe125SNuno Sá mutex_unlock(&iio_dev_opaque->mlock); 21570a856542SNuno Sá return -EBUSY; 21580a856542SNuno Sá } 21590a856542SNuno Sá EXPORT_SYMBOL_GPL(iio_device_claim_buffer_mode); 21600a856542SNuno Sá 21610a856542SNuno Sá /** 21620a856542SNuno Sá * iio_device_release_buffer_mode - releases claim on buffer mode 21630a856542SNuno Sá * @indio_dev: the iio_dev associated with the device 21640a856542SNuno Sá * 21650a856542SNuno Sá * Release the claim. Device is no longer guaranteed to stay 21660a856542SNuno Sá * in buffer mode. 21670a856542SNuno Sá * 21680a856542SNuno Sá * Use with iio_device_claim_buffer_mode(). 21690a856542SNuno Sá */ 21700a856542SNuno Sá void iio_device_release_buffer_mode(struct iio_dev *indio_dev) 21710a856542SNuno Sá { 217216afe125SNuno Sá mutex_unlock(&to_iio_dev_opaque(indio_dev)->mlock); 21730a856542SNuno Sá } 21740a856542SNuno Sá EXPORT_SYMBOL_GPL(iio_device_release_buffer_mode); 21750a856542SNuno Sá 21760a856542SNuno Sá /** 21778c576f87SMiquel Raynal * iio_device_get_current_mode() - helper function providing read-only access to 217851570c9dSMiquel Raynal * the opaque @currentmode variable 21798c576f87SMiquel Raynal * @indio_dev: IIO device structure for device 21808c576f87SMiquel Raynal */ 21818c576f87SMiquel Raynal int iio_device_get_current_mode(struct iio_dev *indio_dev) 21828c576f87SMiquel Raynal { 218351570c9dSMiquel Raynal struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev); 218451570c9dSMiquel Raynal 218551570c9dSMiquel Raynal return iio_dev_opaque->currentmode; 21868c576f87SMiquel Raynal } 21878c576f87SMiquel Raynal EXPORT_SYMBOL_GPL(iio_device_get_current_mode); 21888c576f87SMiquel Raynal 2189a980e046SJonathan Cameron subsys_initcall(iio_init); 2190a980e046SJonathan Cameron module_exit(iio_exit); 2191a980e046SJonathan Cameron 2192c8b95952SJonathan Cameron MODULE_AUTHOR("Jonathan Cameron <jic23@kernel.org>"); 2193a980e046SJonathan Cameron MODULE_DESCRIPTION("Industrial I/O core"); 2194a980e046SJonathan Cameron MODULE_LICENSE("GPL"); 2195