xref: /linux/drivers/iio/industrialio-core.c (revision 3a39d672e7f48b8d6b91a09afa4b55352773b4b5)
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>
1442ea5992SNuno Sa #include <linux/cleanup.h>
1505f59abaSAndy Shevchenko #include <linux/debugfs.h>
1605f59abaSAndy Shevchenko #include <linux/device.h>
1705f59abaSAndy Shevchenko #include <linux/err.h>
1805f59abaSAndy Shevchenko #include <linux/fs.h>
19a980e046SJonathan Cameron #include <linux/idr.h>
20a980e046SJonathan Cameron #include <linux/kdev_t.h>
2105f59abaSAndy Shevchenko #include <linux/kernel.h>
2205f59abaSAndy Shevchenko #include <linux/module.h>
2305f59abaSAndy Shevchenko #include <linux/mutex.h>
24a980e046SJonathan Cameron #include <linux/poll.h>
25fb158971SAndy Shevchenko #include <linux/property.h>
26a980e046SJonathan Cameron #include <linux/sched.h>
27a980e046SJonathan Cameron #include <linux/slab.h>
2805f59abaSAndy Shevchenko #include <linux/wait.h>
2905f59abaSAndy Shevchenko 
309e69c935SLars-Peter Clausen #include <linux/iio/buffer.h>
3133dd94cbSJonathan Cameron #include <linux/iio/buffer_impl.h>
3205f59abaSAndy Shevchenko #include <linux/iio/events.h>
3305f59abaSAndy Shevchenko #include <linux/iio/iio-opaque.h>
3405f59abaSAndy Shevchenko #include <linux/iio/iio.h>
3505f59abaSAndy Shevchenko #include <linux/iio/sysfs.h>
3605f59abaSAndy Shevchenko 
3705f59abaSAndy Shevchenko #include "iio_core.h"
3805f59abaSAndy Shevchenko #include "iio_core_trigger.h"
39a980e046SJonathan Cameron 
40a980e046SJonathan Cameron /* IDA to assign each registered device a unique id */
41a980e046SJonathan Cameron static DEFINE_IDA(iio_ida);
42a980e046SJonathan Cameron 
43a980e046SJonathan Cameron static dev_t iio_devt;
44a980e046SJonathan Cameron 
45a980e046SJonathan Cameron #define IIO_DEV_MAX 256
4689b1b86fSRicardo B. Marliere const struct bus_type iio_bus_type = {
47a980e046SJonathan Cameron 	.name = "iio",
48a980e046SJonathan Cameron };
49a980e046SJonathan Cameron EXPORT_SYMBOL(iio_bus_type);
50a980e046SJonathan Cameron 
51a980e046SJonathan Cameron static struct dentry *iio_debugfs_dentry;
52a980e046SJonathan Cameron 
53a980e046SJonathan Cameron static const char * const iio_direction[] = {
54a980e046SJonathan Cameron 	[0] = "in",
55a980e046SJonathan Cameron 	[1] = "out",
56a980e046SJonathan Cameron };
57a980e046SJonathan Cameron 
58a980e046SJonathan Cameron static const char * const iio_chan_type_name_spec[] = {
59a980e046SJonathan Cameron 	[IIO_VOLTAGE] = "voltage",
60a980e046SJonathan Cameron 	[IIO_CURRENT] = "current",
61a980e046SJonathan Cameron 	[IIO_POWER] = "power",
62a980e046SJonathan Cameron 	[IIO_ACCEL] = "accel",
63a980e046SJonathan Cameron 	[IIO_ANGL_VEL] = "anglvel",
64a980e046SJonathan Cameron 	[IIO_MAGN] = "magn",
65a980e046SJonathan Cameron 	[IIO_LIGHT] = "illuminance",
66a980e046SJonathan Cameron 	[IIO_INTENSITY] = "intensity",
67a980e046SJonathan Cameron 	[IIO_PROXIMITY] = "proximity",
68a980e046SJonathan Cameron 	[IIO_TEMP] = "temp",
69a980e046SJonathan Cameron 	[IIO_INCLI] = "incli",
70a980e046SJonathan Cameron 	[IIO_ROT] = "rot",
71a980e046SJonathan Cameron 	[IIO_ANGL] = "angl",
72a980e046SJonathan Cameron 	[IIO_TIMESTAMP] = "timestamp",
73a980e046SJonathan Cameron 	[IIO_CAPACITANCE] = "capacitance",
74a6b12855SMichael Hennerich 	[IIO_ALTVOLTAGE] = "altvoltage",
7521cd1fabSJon Brenner 	[IIO_CCT] = "cct",
76c4f0c693SLars-Peter Clausen 	[IIO_PRESSURE] = "pressure",
77ac216aa2SHarald Geyer 	[IIO_HUMIDITYRELATIVE] = "humidityrelative",
7855aebeb9SDaniel Baluta 	[IIO_ACTIVITY] = "activity",
79a88bfe78SIrina Tirdea 	[IIO_STEPS] = "steps",
8072c66644SIrina Tirdea 	[IIO_ENERGY] = "energy",
81cc3c9eecSIrina Tirdea 	[IIO_DISTANCE] = "distance",
825a1a9329SIrina Tirdea 	[IIO_VELOCITY] = "velocity",
838ff6b3bcSMatt Ranostay 	[IIO_CONCENTRATION] = "concentration",
84d38d5469SMatt Ranostay 	[IIO_RESISTANCE] = "resistance",
85ecb3a7ccSMatt Ranostay 	[IIO_PH] = "ph",
86d409404cSPeter Meerwald-Stadler 	[IIO_UVINDEX] = "uvindex",
874b9d2090SMatt Ranostay 	[IIO_ELECTRICALCONDUCTIVITY] = "electricalconductivity",
881a8f324aSWilliam Breathitt Gray 	[IIO_COUNT] = "count",
891a8f324aSWilliam Breathitt Gray 	[IIO_INDEX] = "index",
90571299d0SSong Hongyan 	[IIO_GRAVITY]  = "gravity",
913055a6cfSEugen Hristev 	[IIO_POSITIONRELATIVE]  = "positionrelative",
92c73314e6SMathieu Othacehe 	[IIO_PHASE] = "phase",
9317abc9ecSTomasz Duszynski 	[IIO_MASSCONCENTRATION] = "massconcentration",
94744f4990SRamona Bolboaca 	[IIO_DELTA_ANGL] = "deltaangl",
9594a39f2cSRamona Bolboaca 	[IIO_DELTA_VELOCITY] = "deltavelocity",
9642f31175SBasavaraj Natikar 	[IIO_COLORTEMP] = "colortemp",
9706790d4cSBasavaraj Natikar 	[IIO_CHROMATICITY] = "chromaticity",
98a980e046SJonathan Cameron };
99a980e046SJonathan Cameron 
100a980e046SJonathan Cameron static const char * const iio_modifier_names[] = {
101a980e046SJonathan Cameron 	[IIO_MOD_X] = "x",
102a980e046SJonathan Cameron 	[IIO_MOD_Y] = "y",
103a980e046SJonathan Cameron 	[IIO_MOD_Z] = "z",
1044b8d8015SPeter Meerwald 	[IIO_MOD_X_AND_Y] = "x&y",
1054b8d8015SPeter Meerwald 	[IIO_MOD_X_AND_Z] = "x&z",
1064b8d8015SPeter Meerwald 	[IIO_MOD_Y_AND_Z] = "y&z",
1074b8d8015SPeter Meerwald 	[IIO_MOD_X_AND_Y_AND_Z] = "x&y&z",
1084b8d8015SPeter Meerwald 	[IIO_MOD_X_OR_Y] = "x|y",
1094b8d8015SPeter Meerwald 	[IIO_MOD_X_OR_Z] = "x|z",
1104b8d8015SPeter Meerwald 	[IIO_MOD_Y_OR_Z] = "y|z",
1114b8d8015SPeter Meerwald 	[IIO_MOD_X_OR_Y_OR_Z] = "x|y|z",
1128f5879b2SJonathan Cameron 	[IIO_MOD_ROOT_SUM_SQUARED_X_Y] = "sqrt(x^2+y^2)",
113cf82cb81SJonathan Cameron 	[IIO_MOD_SUM_SQUARED_X_Y_Z] = "x^2+y^2+z^2",
114a980e046SJonathan Cameron 	[IIO_MOD_LIGHT_BOTH] = "both",
115a980e046SJonathan Cameron 	[IIO_MOD_LIGHT_IR] = "ir",
11621cd1fabSJon Brenner 	[IIO_MOD_LIGHT_CLEAR] = "clear",
11721cd1fabSJon Brenner 	[IIO_MOD_LIGHT_RED] = "red",
11821cd1fabSJon Brenner 	[IIO_MOD_LIGHT_GREEN] = "green",
11921cd1fabSJon Brenner 	[IIO_MOD_LIGHT_BLUE] = "blue",
1202c5ff1f9SPeter Meerwald-Stadler 	[IIO_MOD_LIGHT_UV] = "uv",
121b89710bdSJavier Carrasco 	[IIO_MOD_LIGHT_UVA] = "uva",
122b89710bdSJavier Carrasco 	[IIO_MOD_LIGHT_UVB] = "uvb",
123c0e4e0fdSMaxime Roussin-Bélanger 	[IIO_MOD_LIGHT_DUV] = "duv",
1245082f405SSrinivas Pandruvada 	[IIO_MOD_QUATERNION] = "quaternion",
125638b43b3SPeter Meerwald 	[IIO_MOD_TEMP_AMBIENT] = "ambient",
126638b43b3SPeter Meerwald 	[IIO_MOD_TEMP_OBJECT] = "object",
12711b8ddabSReyad Attiyat 	[IIO_MOD_NORTH_MAGN] = "from_north_magnetic",
12811b8ddabSReyad Attiyat 	[IIO_MOD_NORTH_TRUE] = "from_north_true",
12911b8ddabSReyad Attiyat 	[IIO_MOD_NORTH_MAGN_TILT_COMP] = "from_north_magnetic_tilt_comp",
13011b8ddabSReyad Attiyat 	[IIO_MOD_NORTH_TRUE_TILT_COMP] = "from_north_true_tilt_comp",
13155aebeb9SDaniel Baluta 	[IIO_MOD_RUNNING] = "running",
13255aebeb9SDaniel Baluta 	[IIO_MOD_JOGGING] = "jogging",
13355aebeb9SDaniel Baluta 	[IIO_MOD_WALKING] = "walking",
13455aebeb9SDaniel Baluta 	[IIO_MOD_STILL] = "still",
1355a1a9329SIrina Tirdea 	[IIO_MOD_ROOT_SUM_SQUARED_X_Y_Z] = "sqrt(x^2+y^2+z^2)",
1361ce87f21SLars-Peter Clausen 	[IIO_MOD_I] = "i",
1371ce87f21SLars-Peter Clausen 	[IIO_MOD_Q] = "q",
1388ff6b3bcSMatt Ranostay 	[IIO_MOD_CO2] = "co2",
1398ff6b3bcSMatt Ranostay 	[IIO_MOD_VOC] = "voc",
14017abc9ecSTomasz Duszynski 	[IIO_MOD_PM1] = "pm1",
14117abc9ecSTomasz Duszynski 	[IIO_MOD_PM2P5] = "pm2p5",
14217abc9ecSTomasz Duszynski 	[IIO_MOD_PM4] = "pm4",
14317abc9ecSTomasz Duszynski 	[IIO_MOD_PM10] = "pm10",
14425f02d32SMatt Ranostay 	[IIO_MOD_ETHANOL] = "ethanol",
14525f02d32SMatt Ranostay 	[IIO_MOD_H2] = "h2",
1464ffa22fdSMatt Ranostay 	[IIO_MOD_O2] = "o2",
147bcc57a48SAndrea Merello 	[IIO_MOD_LINEAR_X] = "linear_x",
148bcc57a48SAndrea Merello 	[IIO_MOD_LINEAR_Y] = "linear_y",
149bcc57a48SAndrea Merello 	[IIO_MOD_LINEAR_Z] = "linear_z",
150dcedf145SAndrea Merello 	[IIO_MOD_PITCH] = "pitch",
151dcedf145SAndrea Merello 	[IIO_MOD_YAW] = "yaw",
152dcedf145SAndrea Merello 	[IIO_MOD_ROLL] = "roll",
153a980e046SJonathan Cameron };
154a980e046SJonathan Cameron 
155a980e046SJonathan Cameron /* relies on pairs of these shared then separate */
156a980e046SJonathan Cameron static const char * const iio_chan_info_postfix[] = {
157a980e046SJonathan Cameron 	[IIO_CHAN_INFO_RAW] = "raw",
158a980e046SJonathan Cameron 	[IIO_CHAN_INFO_PROCESSED] = "input",
159a980e046SJonathan Cameron 	[IIO_CHAN_INFO_SCALE] = "scale",
160a980e046SJonathan Cameron 	[IIO_CHAN_INFO_OFFSET] = "offset",
161a980e046SJonathan Cameron 	[IIO_CHAN_INFO_CALIBSCALE] = "calibscale",
162a980e046SJonathan Cameron 	[IIO_CHAN_INFO_CALIBBIAS] = "calibbias",
163a980e046SJonathan Cameron 	[IIO_CHAN_INFO_PEAK] = "peak_raw",
164a980e046SJonathan Cameron 	[IIO_CHAN_INFO_PEAK_SCALE] = "peak_scale",
165a980e046SJonathan Cameron 	[IIO_CHAN_INFO_QUADRATURE_CORRECTION_RAW] = "quadrature_correction_raw",
166a980e046SJonathan Cameron 	[IIO_CHAN_INFO_AVERAGE_RAW] = "mean_raw",
167a980e046SJonathan Cameron 	[IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY]
168a980e046SJonathan Cameron 	= "filter_low_pass_3db_frequency",
1693f7f642bSMartin Fuzzey 	[IIO_CHAN_INFO_HIGH_PASS_FILTER_3DB_FREQUENCY]
1703f7f642bSMartin Fuzzey 	= "filter_high_pass_3db_frequency",
171a980e046SJonathan Cameron 	[IIO_CHAN_INFO_SAMP_FREQ] = "sampling_frequency",
172a6b12855SMichael Hennerich 	[IIO_CHAN_INFO_FREQUENCY] = "frequency",
173a6b12855SMichael Hennerich 	[IIO_CHAN_INFO_PHASE] = "phase",
174b65d6212SMichael Hennerich 	[IIO_CHAN_INFO_HARDWAREGAIN] = "hardwaregain",
1757c9ab035Ssrinivas pandruvada 	[IIO_CHAN_INFO_HYSTERESIS] = "hysteresis",
1761c71a286SYe Xiang 	[IIO_CHAN_INFO_HYSTERESIS_RELATIVE] = "hysteresis_relative",
177899d90bdSPeter Meerwald 	[IIO_CHAN_INFO_INT_TIME] = "integration_time",
178a88bfe78SIrina Tirdea 	[IIO_CHAN_INFO_ENABLE] = "en",
179bcdf28fbSIrina Tirdea 	[IIO_CHAN_INFO_CALIBHEIGHT] = "calibheight",
180d37f6836SIrina Tirdea 	[IIO_CHAN_INFO_CALIBWEIGHT] = "calibweight",
1812f0ecb7cSIrina Tirdea 	[IIO_CHAN_INFO_DEBOUNCE_COUNT] = "debounce_count",
1822f0ecb7cSIrina Tirdea 	[IIO_CHAN_INFO_DEBOUNCE_TIME] = "debounce_time",
183c8a85854SVianney le Clément de Saint-Marcq 	[IIO_CHAN_INFO_CALIBEMISSIVITY] = "calibemissivity",
184faaa4495SIrina Tirdea 	[IIO_CHAN_INFO_OVERSAMPLING_RATIO] = "oversampling_ratio",
185ddfb97d8SAndrea Merello 	[IIO_CHAN_INFO_THERMOCOUPLE_TYPE] = "thermocouple_type",
186dde8ceecSCrt Mori 	[IIO_CHAN_INFO_CALIBAMBIENT] = "calibambient",
1875c64990bSJonathan Cameron 	[IIO_CHAN_INFO_ZEROPOINT] = "zeropoint",
1885bc2ea60SJavier Carrasco 	[IIO_CHAN_INFO_TROUGH] = "trough_raw",
189a980e046SJonathan Cameron };
19015ea2878SJonathan Cameron /**
19115ea2878SJonathan Cameron  * iio_device_id() - query the unique ID for the device
19215ea2878SJonathan Cameron  * @indio_dev:		Device structure whose ID is being queried
19315ea2878SJonathan Cameron  *
19415ea2878SJonathan Cameron  * The IIO device ID is a unique index used for example for the naming
19565659a8dSAndy Shevchenko  * of the character device /dev/iio\:device[ID].
19665659a8dSAndy Shevchenko  *
19765659a8dSAndy Shevchenko  * Returns: Unique ID for the device.
19815ea2878SJonathan Cameron  */
iio_device_id(struct iio_dev * indio_dev)19915ea2878SJonathan Cameron int iio_device_id(struct iio_dev *indio_dev)
20015ea2878SJonathan Cameron {
20115ea2878SJonathan Cameron 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
20215ea2878SJonathan Cameron 
20315ea2878SJonathan Cameron 	return iio_dev_opaque->id;
20415ea2878SJonathan Cameron }
20515ea2878SJonathan Cameron EXPORT_SYMBOL_GPL(iio_device_id);
206a980e046SJonathan Cameron 
207d9a0e73cSLars-Peter Clausen /**
2082f53b4adSMiquel Raynal  * iio_buffer_enabled() - helper function to test if the buffer is enabled
2092f53b4adSMiquel Raynal  * @indio_dev:		IIO device structure for device
21065659a8dSAndy Shevchenko  *
21165659a8dSAndy Shevchenko  * Returns: True, if the buffer is enabled.
2122f53b4adSMiquel Raynal  */
iio_buffer_enabled(struct iio_dev * indio_dev)2132f53b4adSMiquel Raynal bool iio_buffer_enabled(struct iio_dev *indio_dev)
2142f53b4adSMiquel Raynal {
21551570c9dSMiquel Raynal 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
21651570c9dSMiquel Raynal 
217e7748c17SDavid Lechner 	return iio_dev_opaque->currentmode & INDIO_ALL_BUFFER_MODES;
2182f53b4adSMiquel Raynal }
2192f53b4adSMiquel Raynal EXPORT_SYMBOL_GPL(iio_buffer_enabled);
2202f53b4adSMiquel Raynal 
22196fb1b67SAlexandru Ardelean #if defined(CONFIG_DEBUG_FS)
222c9561fd2SJonathan Cameron /*
22396fb1b67SAlexandru Ardelean  * There's also a CONFIG_DEBUG_FS guard in include/linux/iio/iio.h for
22496fb1b67SAlexandru Ardelean  * iio_get_debugfs_dentry() to make it inline if CONFIG_DEBUG_FS is undefined
22596fb1b67SAlexandru Ardelean  */
iio_get_debugfs_dentry(struct iio_dev * indio_dev)22696fb1b67SAlexandru Ardelean struct dentry *iio_get_debugfs_dentry(struct iio_dev *indio_dev)
22796fb1b67SAlexandru Ardelean {
22896fb1b67SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
2299d9ec8d0SJoe Simmons-Talbott 
23096fb1b67SAlexandru Ardelean 	return iio_dev_opaque->debugfs_dentry;
23196fb1b67SAlexandru Ardelean }
23296fb1b67SAlexandru Ardelean EXPORT_SYMBOL_GPL(iio_get_debugfs_dentry);
23396fb1b67SAlexandru Ardelean #endif
23496fb1b67SAlexandru Ardelean 
235a7e57dceSSachin Kamat /**
236a7e57dceSSachin Kamat  * iio_find_channel_from_si() - get channel from its scan index
237a7e57dceSSachin Kamat  * @indio_dev:		device
238a7e57dceSSachin Kamat  * @si:			scan index to match
23965659a8dSAndy Shevchenko  *
24065659a8dSAndy Shevchenko  * Returns:
24165659a8dSAndy Shevchenko  * Constant pointer to iio_chan_spec, if scan index matches, NULL on failure.
242a7e57dceSSachin Kamat  */
243a980e046SJonathan Cameron const struct iio_chan_spec
iio_find_channel_from_si(struct iio_dev * indio_dev,int si)244a980e046SJonathan Cameron *iio_find_channel_from_si(struct iio_dev *indio_dev, int si)
245a980e046SJonathan Cameron {
246a980e046SJonathan Cameron 	int i;
247a980e046SJonathan Cameron 
248a980e046SJonathan Cameron 	for (i = 0; i < indio_dev->num_channels; i++)
249a980e046SJonathan Cameron 		if (indio_dev->channels[i].scan_index == si)
250a980e046SJonathan Cameron 			return &indio_dev->channels[i];
251a980e046SJonathan Cameron 	return NULL;
252a980e046SJonathan Cameron }
253a980e046SJonathan Cameron 
254a980e046SJonathan Cameron /* This turns up an awful lot */
iio_read_const_attr(struct device * dev,struct device_attribute * attr,char * buf)255a980e046SJonathan Cameron ssize_t iio_read_const_attr(struct device *dev,
256a980e046SJonathan Cameron 			    struct device_attribute *attr,
257a980e046SJonathan Cameron 			    char *buf)
258a980e046SJonathan Cameron {
25983ca56b6SLars-Peter Clausen 	return sysfs_emit(buf, "%s\n", to_iio_const_attr(attr)->string);
260a980e046SJonathan Cameron }
261a980e046SJonathan Cameron EXPORT_SYMBOL(iio_read_const_attr);
262a980e046SJonathan Cameron 
26369f0793eSGwendal Grignou /**
26469f0793eSGwendal Grignou  * iio_device_set_clock() - Set current timestamping clock for the device
26569f0793eSGwendal Grignou  * @indio_dev: IIO device structure containing the device
26665659a8dSAndy Shevchenko  * @clock_id: timestamping clock POSIX identifier to set.
26765659a8dSAndy Shevchenko  *
26865659a8dSAndy Shevchenko  * Returns: 0 on success, or a negative error code.
26969f0793eSGwendal Grignou  */
iio_device_set_clock(struct iio_dev * indio_dev,clockid_t clock_id)27069f0793eSGwendal Grignou int iio_device_set_clock(struct iio_dev *indio_dev, clockid_t clock_id)
271bc2b7dabSGregor Boirie {
272bc2b7dabSGregor Boirie 	int ret;
273fa83c3baSAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
274fa83c3baSAlexandru Ardelean 	const struct iio_event_interface *ev_int = iio_dev_opaque->event_interface;
275bc2b7dabSGregor Boirie 
27616afe125SNuno Sá 	ret = mutex_lock_interruptible(&iio_dev_opaque->mlock);
277bc2b7dabSGregor Boirie 	if (ret)
278bc2b7dabSGregor Boirie 		return ret;
279bc2b7dabSGregor Boirie 	if ((ev_int && iio_event_enabled(ev_int)) ||
280bc2b7dabSGregor Boirie 	    iio_buffer_enabled(indio_dev)) {
28116afe125SNuno Sá 		mutex_unlock(&iio_dev_opaque->mlock);
282bc2b7dabSGregor Boirie 		return -EBUSY;
283bc2b7dabSGregor Boirie 	}
28462a486c4SJonathan Cameron 	iio_dev_opaque->clock_id = clock_id;
28516afe125SNuno Sá 	mutex_unlock(&iio_dev_opaque->mlock);
286bc2b7dabSGregor Boirie 
287bc2b7dabSGregor Boirie 	return 0;
288bc2b7dabSGregor Boirie }
28969f0793eSGwendal Grignou EXPORT_SYMBOL(iio_device_set_clock);
290bc2b7dabSGregor Boirie 
291bc2b7dabSGregor Boirie /**
29262a486c4SJonathan Cameron  * iio_device_get_clock() - Retrieve current timestamping clock for the device
29362a486c4SJonathan Cameron  * @indio_dev: IIO device structure containing the device
29465659a8dSAndy Shevchenko  *
29565659a8dSAndy Shevchenko  * Returns: Clock ID of the current timestamping clock for the device.
29662a486c4SJonathan Cameron  */
iio_device_get_clock(const struct iio_dev * indio_dev)29762a486c4SJonathan Cameron clockid_t iio_device_get_clock(const struct iio_dev *indio_dev)
29862a486c4SJonathan Cameron {
29962a486c4SJonathan Cameron 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
30062a486c4SJonathan Cameron 
30162a486c4SJonathan Cameron 	return iio_dev_opaque->clock_id;
30262a486c4SJonathan Cameron }
30362a486c4SJonathan Cameron EXPORT_SYMBOL(iio_device_get_clock);
30462a486c4SJonathan Cameron 
30562a486c4SJonathan Cameron /**
306bc2b7dabSGregor Boirie  * iio_get_time_ns() - utility function to get a time stamp for events etc
307bc2b7dabSGregor Boirie  * @indio_dev: device
30865659a8dSAndy Shevchenko  *
30965659a8dSAndy Shevchenko  * Returns: Timestamp of the event in nanoseconds.
310bc2b7dabSGregor Boirie  */
iio_get_time_ns(const struct iio_dev * indio_dev)311bc2b7dabSGregor Boirie s64 iio_get_time_ns(const struct iio_dev *indio_dev)
312bc2b7dabSGregor Boirie {
31345e7f5d2SArnd Bergmann 	struct timespec64 tp;
314bc2b7dabSGregor Boirie 
315bc2b7dabSGregor Boirie 	switch (iio_device_get_clock(indio_dev)) {
316bc2b7dabSGregor Boirie 	case CLOCK_REALTIME:
31745e7f5d2SArnd Bergmann 		return ktime_get_real_ns();
318bc2b7dabSGregor Boirie 	case CLOCK_MONOTONIC:
31945e7f5d2SArnd Bergmann 		return ktime_get_ns();
320bc2b7dabSGregor Boirie 	case CLOCK_MONOTONIC_RAW:
32145e7f5d2SArnd Bergmann 		return ktime_get_raw_ns();
322bc2b7dabSGregor Boirie 	case CLOCK_REALTIME_COARSE:
32345e7f5d2SArnd Bergmann 		return ktime_to_ns(ktime_get_coarse_real());
324bc2b7dabSGregor Boirie 	case CLOCK_MONOTONIC_COARSE:
32545e7f5d2SArnd Bergmann 		ktime_get_coarse_ts64(&tp);
32645e7f5d2SArnd Bergmann 		return timespec64_to_ns(&tp);
327bc2b7dabSGregor Boirie 	case CLOCK_BOOTTIME:
3289285ec4cSJason A. Donenfeld 		return ktime_get_boottime_ns();
329bc2b7dabSGregor Boirie 	case CLOCK_TAI:
3309285ec4cSJason A. Donenfeld 		return ktime_get_clocktai_ns();
331bc2b7dabSGregor Boirie 	default:
332bc2b7dabSGregor Boirie 		BUG();
333bc2b7dabSGregor Boirie 	}
334bc2b7dabSGregor Boirie }
335bc2b7dabSGregor Boirie EXPORT_SYMBOL(iio_get_time_ns);
336bc2b7dabSGregor Boirie 
iio_init(void)337a980e046SJonathan Cameron static int __init iio_init(void)
338a980e046SJonathan Cameron {
339a980e046SJonathan Cameron 	int ret;
340a980e046SJonathan Cameron 
341a980e046SJonathan Cameron 	/* Register sysfs bus */
342a980e046SJonathan Cameron 	ret  = bus_register(&iio_bus_type);
343a980e046SJonathan Cameron 	if (ret < 0) {
3443176dd5dSSachin Kamat 		pr_err("could not register bus type\n");
345a980e046SJonathan Cameron 		goto error_nothing;
346a980e046SJonathan Cameron 	}
347a980e046SJonathan Cameron 
348a980e046SJonathan Cameron 	ret = alloc_chrdev_region(&iio_devt, 0, IIO_DEV_MAX, "iio");
349a980e046SJonathan Cameron 	if (ret < 0) {
3503176dd5dSSachin Kamat 		pr_err("failed to allocate char dev region\n");
351a980e046SJonathan Cameron 		goto error_unregister_bus_type;
352a980e046SJonathan Cameron 	}
353a980e046SJonathan Cameron 
354a980e046SJonathan Cameron 	iio_debugfs_dentry = debugfs_create_dir("iio", NULL);
355a980e046SJonathan Cameron 
356a980e046SJonathan Cameron 	return 0;
357a980e046SJonathan Cameron 
358a980e046SJonathan Cameron error_unregister_bus_type:
359a980e046SJonathan Cameron 	bus_unregister(&iio_bus_type);
360a980e046SJonathan Cameron error_nothing:
361a980e046SJonathan Cameron 	return ret;
362a980e046SJonathan Cameron }
363a980e046SJonathan Cameron 
iio_exit(void)364a980e046SJonathan Cameron static void __exit iio_exit(void)
365a980e046SJonathan Cameron {
366a980e046SJonathan Cameron 	if (iio_devt)
367a980e046SJonathan Cameron 		unregister_chrdev_region(iio_devt, IIO_DEV_MAX);
368a980e046SJonathan Cameron 	bus_unregister(&iio_bus_type);
369a980e046SJonathan Cameron 	debugfs_remove(iio_debugfs_dentry);
370a980e046SJonathan Cameron }
371a980e046SJonathan Cameron 
372a980e046SJonathan Cameron #if defined(CONFIG_DEBUG_FS)
iio_debugfs_read_reg(struct file * file,char __user * userbuf,size_t count,loff_t * ppos)373a980e046SJonathan Cameron static ssize_t iio_debugfs_read_reg(struct file *file, char __user *userbuf,
374a980e046SJonathan Cameron 			      size_t count, loff_t *ppos)
375a980e046SJonathan Cameron {
376a980e046SJonathan Cameron 	struct iio_dev *indio_dev = file->private_data;
37796fb1b67SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
378abeba59fSJoe Simmons-Talbott 	unsigned int val = 0;
379a980e046SJonathan Cameron 	int ret;
380a980e046SJonathan Cameron 
3812ddc982aSAlexandru Tachici 	if (*ppos > 0)
3822ddc982aSAlexandru Tachici 		return simple_read_from_buffer(userbuf, count, ppos,
38396fb1b67SAlexandru Ardelean 					       iio_dev_opaque->read_buf,
38496fb1b67SAlexandru Ardelean 					       iio_dev_opaque->read_buf_len);
3852ddc982aSAlexandru Tachici 
386a980e046SJonathan Cameron 	ret = indio_dev->info->debugfs_reg_access(indio_dev,
38796fb1b67SAlexandru Ardelean 						  iio_dev_opaque->cached_reg_addr,
388a980e046SJonathan Cameron 						  0, &val);
3893d62c78aSMatt Fornero 	if (ret) {
390a980e046SJonathan Cameron 		dev_err(indio_dev->dev.parent, "%s: read failed\n", __func__);
3913d62c78aSMatt Fornero 		return ret;
3923d62c78aSMatt Fornero 	}
393a980e046SJonathan Cameron 
39496fb1b67SAlexandru Ardelean 	iio_dev_opaque->read_buf_len = snprintf(iio_dev_opaque->read_buf,
39596fb1b67SAlexandru Ardelean 						sizeof(iio_dev_opaque->read_buf),
3962ddc982aSAlexandru Tachici 						"0x%X\n", val);
397a980e046SJonathan Cameron 
3982ddc982aSAlexandru Tachici 	return simple_read_from_buffer(userbuf, count, ppos,
39996fb1b67SAlexandru Ardelean 				       iio_dev_opaque->read_buf,
40096fb1b67SAlexandru Ardelean 				       iio_dev_opaque->read_buf_len);
401a980e046SJonathan Cameron }
402a980e046SJonathan Cameron 
iio_debugfs_write_reg(struct file * file,const char __user * userbuf,size_t count,loff_t * ppos)403a980e046SJonathan Cameron static ssize_t iio_debugfs_write_reg(struct file *file,
404a980e046SJonathan Cameron 		     const char __user *userbuf, size_t count, loff_t *ppos)
405a980e046SJonathan Cameron {
406a980e046SJonathan Cameron 	struct iio_dev *indio_dev = file->private_data;
40796fb1b67SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
408abeba59fSJoe Simmons-Talbott 	unsigned int reg, val;
409a980e046SJonathan Cameron 	char buf[80];
410a980e046SJonathan Cameron 	int ret;
411a980e046SJonathan Cameron 
412cb1d1753SAndy Shevchenko 	count = min(count, sizeof(buf) - 1);
413a980e046SJonathan Cameron 	if (copy_from_user(buf, userbuf, count))
414a980e046SJonathan Cameron 		return -EFAULT;
415a980e046SJonathan Cameron 
416a980e046SJonathan Cameron 	buf[count] = 0;
417a980e046SJonathan Cameron 
418a980e046SJonathan Cameron 	ret = sscanf(buf, "%i %i", &reg, &val);
419a980e046SJonathan Cameron 
420a980e046SJonathan Cameron 	switch (ret) {
421a980e046SJonathan Cameron 	case 1:
42296fb1b67SAlexandru Ardelean 		iio_dev_opaque->cached_reg_addr = reg;
423a980e046SJonathan Cameron 		break;
424a980e046SJonathan Cameron 	case 2:
42596fb1b67SAlexandru Ardelean 		iio_dev_opaque->cached_reg_addr = reg;
426a980e046SJonathan Cameron 		ret = indio_dev->info->debugfs_reg_access(indio_dev, reg,
427a980e046SJonathan Cameron 							  val, NULL);
428a980e046SJonathan Cameron 		if (ret) {
429a980e046SJonathan Cameron 			dev_err(indio_dev->dev.parent, "%s: write failed\n",
430a980e046SJonathan Cameron 				__func__);
431a980e046SJonathan Cameron 			return ret;
432a980e046SJonathan Cameron 		}
433a980e046SJonathan Cameron 		break;
434a980e046SJonathan Cameron 	default:
435a980e046SJonathan Cameron 		return -EINVAL;
436a980e046SJonathan Cameron 	}
437a980e046SJonathan Cameron 
438a980e046SJonathan Cameron 	return count;
439a980e046SJonathan Cameron }
440a980e046SJonathan Cameron 
441a980e046SJonathan Cameron static const struct file_operations iio_debugfs_reg_fops = {
4425a28c873SAxel Lin 	.open = simple_open,
443a980e046SJonathan Cameron 	.read = iio_debugfs_read_reg,
444a980e046SJonathan Cameron 	.write = iio_debugfs_write_reg,
445a980e046SJonathan Cameron };
446a980e046SJonathan Cameron 
iio_device_unregister_debugfs(struct iio_dev * indio_dev)447a980e046SJonathan Cameron static void iio_device_unregister_debugfs(struct iio_dev *indio_dev)
448a980e046SJonathan Cameron {
44996fb1b67SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
4509d9ec8d0SJoe Simmons-Talbott 
45196fb1b67SAlexandru Ardelean 	debugfs_remove_recursive(iio_dev_opaque->debugfs_dentry);
452a980e046SJonathan Cameron }
453a980e046SJonathan Cameron 
iio_device_register_debugfs(struct iio_dev * indio_dev)4548915aacaSGreg Kroah-Hartman static void iio_device_register_debugfs(struct iio_dev *indio_dev)
455a980e046SJonathan Cameron {
45696fb1b67SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque;
45796fb1b67SAlexandru Ardelean 
458a980e046SJonathan Cameron 	if (indio_dev->info->debugfs_reg_access == NULL)
4598915aacaSGreg Kroah-Hartman 		return;
460a980e046SJonathan Cameron 
461abd5a2fbSAxel Lin 	if (!iio_debugfs_dentry)
4628915aacaSGreg Kroah-Hartman 		return;
463a980e046SJonathan Cameron 
46496fb1b67SAlexandru Ardelean 	iio_dev_opaque = to_iio_dev_opaque(indio_dev);
46596fb1b67SAlexandru Ardelean 
46696fb1b67SAlexandru Ardelean 	iio_dev_opaque->debugfs_dentry =
467a980e046SJonathan Cameron 		debugfs_create_dir(dev_name(&indio_dev->dev),
468a980e046SJonathan Cameron 				   iio_debugfs_dentry);
469a980e046SJonathan Cameron 
4708915aacaSGreg Kroah-Hartman 	debugfs_create_file("direct_reg_access", 0644,
47196fb1b67SAlexandru Ardelean 			    iio_dev_opaque->debugfs_dentry, indio_dev,
4728915aacaSGreg Kroah-Hartman 			    &iio_debugfs_reg_fops);
473a980e046SJonathan Cameron }
474a980e046SJonathan Cameron #else
iio_device_register_debugfs(struct iio_dev * indio_dev)4758915aacaSGreg Kroah-Hartman static void iio_device_register_debugfs(struct iio_dev *indio_dev)
476a980e046SJonathan Cameron {
477a980e046SJonathan Cameron }
478a980e046SJonathan Cameron 
iio_device_unregister_debugfs(struct iio_dev * indio_dev)479a980e046SJonathan Cameron static void iio_device_unregister_debugfs(struct iio_dev *indio_dev)
480a980e046SJonathan Cameron {
481a980e046SJonathan Cameron }
482a980e046SJonathan Cameron #endif /* CONFIG_DEBUG_FS */
483a980e046SJonathan Cameron 
iio_read_channel_ext_info(struct device * dev,struct device_attribute * attr,char * buf)484a980e046SJonathan Cameron static ssize_t iio_read_channel_ext_info(struct device *dev,
485a980e046SJonathan Cameron 				     struct device_attribute *attr,
486a980e046SJonathan Cameron 				     char *buf)
487a980e046SJonathan Cameron {
488e53f5ac5SLars-Peter Clausen 	struct iio_dev *indio_dev = dev_to_iio_dev(dev);
489a980e046SJonathan Cameron 	struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
490a980e046SJonathan Cameron 	const struct iio_chan_spec_ext_info *ext_info;
491a980e046SJonathan Cameron 
492a980e046SJonathan Cameron 	ext_info = &this_attr->c->ext_info[this_attr->address];
493a980e046SJonathan Cameron 
494fc6d1139SMichael Hennerich 	return ext_info->read(indio_dev, ext_info->private, this_attr->c, buf);
495a980e046SJonathan Cameron }
496a980e046SJonathan Cameron 
iio_write_channel_ext_info(struct device * dev,struct device_attribute * attr,const char * buf,size_t len)497a980e046SJonathan Cameron static ssize_t iio_write_channel_ext_info(struct device *dev,
498a980e046SJonathan Cameron 				     struct device_attribute *attr,
499b662f4baSAndy Shevchenko 				     const char *buf, size_t len)
500a980e046SJonathan Cameron {
501e53f5ac5SLars-Peter Clausen 	struct iio_dev *indio_dev = dev_to_iio_dev(dev);
502a980e046SJonathan Cameron 	struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
503a980e046SJonathan Cameron 	const struct iio_chan_spec_ext_info *ext_info;
504a980e046SJonathan Cameron 
505a980e046SJonathan Cameron 	ext_info = &this_attr->c->ext_info[this_attr->address];
506a980e046SJonathan Cameron 
507fc6d1139SMichael Hennerich 	return ext_info->write(indio_dev, ext_info->private,
508fc6d1139SMichael Hennerich 			       this_attr->c, buf, len);
509a980e046SJonathan Cameron }
510a980e046SJonathan Cameron 
iio_enum_available_read(struct iio_dev * indio_dev,uintptr_t priv,const struct iio_chan_spec * chan,char * buf)5115212cc8aSLars-Peter Clausen ssize_t iio_enum_available_read(struct iio_dev *indio_dev,
5125212cc8aSLars-Peter Clausen 	uintptr_t priv, const struct iio_chan_spec *chan, char *buf)
5135212cc8aSLars-Peter Clausen {
5145212cc8aSLars-Peter Clausen 	const struct iio_enum *e = (const struct iio_enum *)priv;
5155212cc8aSLars-Peter Clausen 	unsigned int i;
5165212cc8aSLars-Peter Clausen 	size_t len = 0;
5175212cc8aSLars-Peter Clausen 
5185212cc8aSLars-Peter Clausen 	if (!e->num_items)
5195212cc8aSLars-Peter Clausen 		return 0;
5205212cc8aSLars-Peter Clausen 
521d9a0e73cSLars-Peter Clausen 	for (i = 0; i < e->num_items; ++i) {
522d9a0e73cSLars-Peter Clausen 		if (!e->items[i])
523d9a0e73cSLars-Peter Clausen 			continue;
5240207483bSLars-Peter Clausen 		len += sysfs_emit_at(buf, len, "%s ", e->items[i]);
525d9a0e73cSLars-Peter Clausen 	}
5265212cc8aSLars-Peter Clausen 
5275212cc8aSLars-Peter Clausen 	/* replace last space with a newline */
5285212cc8aSLars-Peter Clausen 	buf[len - 1] = '\n';
5295212cc8aSLars-Peter Clausen 
5305212cc8aSLars-Peter Clausen 	return len;
5315212cc8aSLars-Peter Clausen }
5325212cc8aSLars-Peter Clausen EXPORT_SYMBOL_GPL(iio_enum_available_read);
5335212cc8aSLars-Peter Clausen 
iio_enum_read(struct iio_dev * indio_dev,uintptr_t priv,const struct iio_chan_spec * chan,char * buf)5345212cc8aSLars-Peter Clausen ssize_t iio_enum_read(struct iio_dev *indio_dev,
5355212cc8aSLars-Peter Clausen 	uintptr_t priv, const struct iio_chan_spec *chan, char *buf)
5365212cc8aSLars-Peter Clausen {
5375212cc8aSLars-Peter Clausen 	const struct iio_enum *e = (const struct iio_enum *)priv;
5385212cc8aSLars-Peter Clausen 	int i;
5395212cc8aSLars-Peter Clausen 
5405212cc8aSLars-Peter Clausen 	if (!e->get)
5415212cc8aSLars-Peter Clausen 		return -EINVAL;
5425212cc8aSLars-Peter Clausen 
5435212cc8aSLars-Peter Clausen 	i = e->get(indio_dev, chan);
5445212cc8aSLars-Peter Clausen 	if (i < 0)
5455212cc8aSLars-Peter Clausen 		return i;
5461702df5dSAndy Shevchenko 	if (i >= e->num_items || !e->items[i])
5475212cc8aSLars-Peter Clausen 		return -EINVAL;
5485212cc8aSLars-Peter Clausen 
54983ca56b6SLars-Peter Clausen 	return sysfs_emit(buf, "%s\n", e->items[i]);
5505212cc8aSLars-Peter Clausen }
5515212cc8aSLars-Peter Clausen EXPORT_SYMBOL_GPL(iio_enum_read);
5525212cc8aSLars-Peter Clausen 
iio_enum_write(struct iio_dev * indio_dev,uintptr_t priv,const struct iio_chan_spec * chan,const char * buf,size_t len)5535212cc8aSLars-Peter Clausen ssize_t iio_enum_write(struct iio_dev *indio_dev,
5545212cc8aSLars-Peter Clausen 	uintptr_t priv, const struct iio_chan_spec *chan, const char *buf,
5555212cc8aSLars-Peter Clausen 	size_t len)
5565212cc8aSLars-Peter Clausen {
5575212cc8aSLars-Peter Clausen 	const struct iio_enum *e = (const struct iio_enum *)priv;
5585212cc8aSLars-Peter Clausen 	int ret;
5595212cc8aSLars-Peter Clausen 
5605212cc8aSLars-Peter Clausen 	if (!e->set)
5615212cc8aSLars-Peter Clausen 		return -EINVAL;
5625212cc8aSLars-Peter Clausen 
563122fb873SAndy Shevchenko 	ret = __sysfs_match_string(e->items, e->num_items, buf);
56402e9a0ffSAndy Shevchenko 	if (ret < 0)
56502e9a0ffSAndy Shevchenko 		return ret;
5665212cc8aSLars-Peter Clausen 
56702e9a0ffSAndy Shevchenko 	ret = e->set(indio_dev, chan, ret);
5685212cc8aSLars-Peter Clausen 	return ret ? ret : len;
5695212cc8aSLars-Peter Clausen }
5705212cc8aSLars-Peter Clausen EXPORT_SYMBOL_GPL(iio_enum_write);
5715212cc8aSLars-Peter Clausen 
572dfc57732SGregor Boirie static const struct iio_mount_matrix iio_mount_idmatrix = {
573dfc57732SGregor Boirie 	.rotation = {
574dfc57732SGregor Boirie 		"1", "0", "0",
575dfc57732SGregor Boirie 		"0", "1", "0",
576dfc57732SGregor Boirie 		"0", "0", "1"
577dfc57732SGregor Boirie 	}
578dfc57732SGregor Boirie };
579dfc57732SGregor Boirie 
iio_setup_mount_idmatrix(const struct device * dev,struct iio_mount_matrix * matrix)580dfc57732SGregor Boirie static int iio_setup_mount_idmatrix(const struct device *dev,
581dfc57732SGregor Boirie 				    struct iio_mount_matrix *matrix)
582dfc57732SGregor Boirie {
583dfc57732SGregor Boirie 	*matrix = iio_mount_idmatrix;
584dfc57732SGregor Boirie 	dev_info(dev, "mounting matrix not found: using identity...\n");
585dfc57732SGregor Boirie 	return 0;
586dfc57732SGregor Boirie }
587dfc57732SGregor Boirie 
iio_show_mount_matrix(struct iio_dev * indio_dev,uintptr_t priv,const struct iio_chan_spec * chan,char * buf)588dfc57732SGregor Boirie ssize_t iio_show_mount_matrix(struct iio_dev *indio_dev, uintptr_t priv,
589dfc57732SGregor Boirie 			      const struct iio_chan_spec *chan, char *buf)
590dfc57732SGregor Boirie {
591b662f4baSAndy Shevchenko 	const struct iio_mount_matrix *mtx;
592dfc57732SGregor Boirie 
593b662f4baSAndy Shevchenko 	mtx = ((iio_get_mount_matrix_t *)priv)(indio_dev, chan);
594dfc57732SGregor Boirie 	if (IS_ERR(mtx))
595dfc57732SGregor Boirie 		return PTR_ERR(mtx);
596dfc57732SGregor Boirie 
597dfc57732SGregor Boirie 	if (!mtx)
598dfc57732SGregor Boirie 		mtx = &iio_mount_idmatrix;
599dfc57732SGregor Boirie 
60083ca56b6SLars-Peter Clausen 	return sysfs_emit(buf, "%s, %s, %s; %s, %s, %s; %s, %s, %s\n",
601dfc57732SGregor Boirie 			  mtx->rotation[0], mtx->rotation[1], mtx->rotation[2],
602dfc57732SGregor Boirie 			  mtx->rotation[3], mtx->rotation[4], mtx->rotation[5],
603dfc57732SGregor Boirie 			  mtx->rotation[6], mtx->rotation[7], mtx->rotation[8]);
604dfc57732SGregor Boirie }
605dfc57732SGregor Boirie EXPORT_SYMBOL_GPL(iio_show_mount_matrix);
606dfc57732SGregor Boirie 
607dfc57732SGregor Boirie /**
608fb158971SAndy Shevchenko  * iio_read_mount_matrix() - retrieve iio device mounting matrix from
609fb158971SAndy Shevchenko  *                           device "mount-matrix" property
610dfc57732SGregor Boirie  * @dev:	device the mounting matrix property is assigned to
611dfc57732SGregor Boirie  * @matrix:	where to store retrieved matrix
612dfc57732SGregor Boirie  *
613dfc57732SGregor Boirie  * If device is assigned no mounting matrix property, a default 3x3 identity
614dfc57732SGregor Boirie  * matrix will be filled in.
615dfc57732SGregor Boirie  *
61665659a8dSAndy Shevchenko  * Returns: 0 if success, or a negative error code on failure.
617dfc57732SGregor Boirie  */
iio_read_mount_matrix(struct device * dev,struct iio_mount_matrix * matrix)618b892770aSAndy Shevchenko int iio_read_mount_matrix(struct device *dev, struct iio_mount_matrix *matrix)
619dfc57732SGregor Boirie {
620fb158971SAndy Shevchenko 	size_t len = ARRAY_SIZE(iio_mount_idmatrix.rotation);
621fb158971SAndy Shevchenko 	int err;
622dfc57732SGregor Boirie 
623b892770aSAndy Shevchenko 	err = device_property_read_string_array(dev, "mount-matrix", matrix->rotation, len);
624fb158971SAndy Shevchenko 	if (err == len)
625dfc57732SGregor Boirie 		return 0;
626dfc57732SGregor Boirie 
627dfc57732SGregor Boirie 	if (err >= 0)
628dfc57732SGregor Boirie 		/* Invalid number of matrix entries. */
629dfc57732SGregor Boirie 		return -EINVAL;
630dfc57732SGregor Boirie 
631dfc57732SGregor Boirie 	if (err != -EINVAL)
632dfc57732SGregor Boirie 		/* Invalid matrix declaration format. */
633dfc57732SGregor Boirie 		return err;
634dfc57732SGregor Boirie 
635dfc57732SGregor Boirie 	/* Matrix was not declared at all: fallback to identity. */
636dfc57732SGregor Boirie 	return iio_setup_mount_idmatrix(dev, matrix);
637dfc57732SGregor Boirie }
638fb158971SAndy Shevchenko EXPORT_SYMBOL(iio_read_mount_matrix);
639dfc57732SGregor Boirie 
__iio_format_value(char * buf,size_t offset,unsigned int type,int size,const int * vals)6406b92ba0aSLars-Peter Clausen static ssize_t __iio_format_value(char *buf, size_t offset, unsigned int type,
64151239600SJonathan Cameron 				  int size, const int *vals)
64251239600SJonathan Cameron {
64351239600SJonathan Cameron 	int tmp0, tmp1;
6440e7a3978SAnand Ashok Dumbre 	s64 tmp2;
64551239600SJonathan Cameron 	bool scale_db = false;
64651239600SJonathan Cameron 
64751239600SJonathan Cameron 	switch (type) {
64851239600SJonathan Cameron 	case IIO_VAL_INT:
6496b92ba0aSLars-Peter Clausen 		return sysfs_emit_at(buf, offset, "%d", vals[0]);
65051239600SJonathan Cameron 	case IIO_VAL_INT_PLUS_MICRO_DB:
65151239600SJonathan Cameron 		scale_db = true;
652df561f66SGustavo A. R. Silva 		fallthrough;
65351239600SJonathan Cameron 	case IIO_VAL_INT_PLUS_MICRO:
65451239600SJonathan Cameron 		if (vals[1] < 0)
6556b92ba0aSLars-Peter Clausen 			return sysfs_emit_at(buf, offset, "-%d.%06u%s",
6566b92ba0aSLars-Peter Clausen 					     abs(vals[0]), -vals[1],
65751239600SJonathan Cameron 					     scale_db ? " dB" : "");
6586b92ba0aSLars-Peter Clausen 		else
6596b92ba0aSLars-Peter Clausen 			return sysfs_emit_at(buf, offset, "%d.%06u%s", vals[0],
6606b92ba0aSLars-Peter Clausen 					     vals[1], scale_db ? " dB" : "");
66151239600SJonathan Cameron 	case IIO_VAL_INT_PLUS_NANO:
66251239600SJonathan Cameron 		if (vals[1] < 0)
6636b92ba0aSLars-Peter Clausen 			return sysfs_emit_at(buf, offset, "-%d.%09u",
6646b92ba0aSLars-Peter Clausen 					     abs(vals[0]), -vals[1]);
66551239600SJonathan Cameron 		else
6666b92ba0aSLars-Peter Clausen 			return sysfs_emit_at(buf, offset, "%d.%09u", vals[0],
6676b92ba0aSLars-Peter Clausen 					     vals[1]);
66851239600SJonathan Cameron 	case IIO_VAL_FRACTIONAL:
6690e7a3978SAnand Ashok Dumbre 		tmp2 = div_s64((s64)vals[0] * 1000000000LL, 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  */
iio_format_value(char * buf,unsigned int type,int size,int * vals)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 
do_iio_read_channel_label(struct iio_dev * indio_dev,const struct iio_chan_spec * c,char * buf)7290214b27fSSean Anderson ssize_t do_iio_read_channel_label(struct iio_dev *indio_dev,
7300214b27fSSean Anderson 				  const struct iio_chan_spec *c,
7310214b27fSSean Anderson 				  char *buf)
7320214b27fSSean Anderson {
7330214b27fSSean Anderson 	if (indio_dev->info->read_label)
7340214b27fSSean Anderson 		return indio_dev->info->read_label(indio_dev, c, buf);
7350214b27fSSean Anderson 
7360214b27fSSean Anderson 	if (c->extend_name)
7370214b27fSSean Anderson 		return sysfs_emit(buf, "%s\n", c->extend_name);
7380214b27fSSean Anderson 
7390214b27fSSean Anderson 	return -EINVAL;
7400214b27fSSean Anderson }
7410214b27fSSean Anderson 
iio_read_channel_label(struct device * dev,struct device_attribute * attr,char * buf)7421d4ef9b3SCristian Pop static ssize_t iio_read_channel_label(struct device *dev,
7431d4ef9b3SCristian Pop 				      struct device_attribute *attr,
7441d4ef9b3SCristian Pop 				      char *buf)
7451d4ef9b3SCristian Pop {
7460214b27fSSean Anderson 	return do_iio_read_channel_label(dev_to_iio_dev(dev),
7470214b27fSSean Anderson 					 to_iio_dev_attr(attr)->c, buf);
7481d4ef9b3SCristian Pop }
7491d4ef9b3SCristian Pop 
iio_read_channel_info(struct device * dev,struct device_attribute * attr,char * buf)7503661f3f5SLars-Peter Clausen static ssize_t iio_read_channel_info(struct device *dev,
7513661f3f5SLars-Peter Clausen 				     struct device_attribute *attr,
7523661f3f5SLars-Peter Clausen 				     char *buf)
7533661f3f5SLars-Peter Clausen {
7543661f3f5SLars-Peter Clausen 	struct iio_dev *indio_dev = dev_to_iio_dev(dev);
7553661f3f5SLars-Peter Clausen 	struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
7569fbfb4b3SSrinivas Pandruvada 	int vals[INDIO_MAX_RAW_ELEMENTS];
7579fbfb4b3SSrinivas Pandruvada 	int ret;
7589fbfb4b3SSrinivas Pandruvada 	int val_len = 2;
7599fbfb4b3SSrinivas Pandruvada 
7609fbfb4b3SSrinivas Pandruvada 	if (indio_dev->info->read_raw_multi)
7619fbfb4b3SSrinivas Pandruvada 		ret = indio_dev->info->read_raw_multi(indio_dev, this_attr->c,
7629fbfb4b3SSrinivas Pandruvada 							INDIO_MAX_RAW_ELEMENTS,
7639fbfb4b3SSrinivas Pandruvada 							vals, &val_len,
7649fbfb4b3SSrinivas Pandruvada 							this_attr->address);
765c4ec8dedSJulien Stephan 	else if (indio_dev->info->read_raw)
7669fbfb4b3SSrinivas Pandruvada 		ret = indio_dev->info->read_raw(indio_dev, this_attr->c,
7679fbfb4b3SSrinivas Pandruvada 				    &vals[0], &vals[1], this_attr->address);
768c4ec8dedSJulien Stephan 	else
769c4ec8dedSJulien Stephan 		return -EINVAL;
7703661f3f5SLars-Peter Clausen 
7713661f3f5SLars-Peter Clausen 	if (ret < 0)
7723661f3f5SLars-Peter Clausen 		return ret;
7733661f3f5SLars-Peter Clausen 
7749fbfb4b3SSrinivas Pandruvada 	return iio_format_value(buf, ret, val_len, vals);
7753661f3f5SLars-Peter Clausen }
7763661f3f5SLars-Peter Clausen 
iio_format_list(char * buf,const int * vals,int type,int length,const char * prefix,const char * suffix)777eda20ba1SLars-Peter Clausen static ssize_t iio_format_list(char *buf, const int *vals, int type, int length,
778eda20ba1SLars-Peter Clausen 			       const char *prefix, const char *suffix)
77951239600SJonathan Cameron {
780eda20ba1SLars-Peter Clausen 	ssize_t len;
781e08b60d3SLars-Peter Clausen 	int stride;
78251239600SJonathan Cameron 	int i;
783eda20ba1SLars-Peter Clausen 
78451239600SJonathan Cameron 	switch (type) {
78551239600SJonathan Cameron 	case IIO_VAL_INT:
786e08b60d3SLars-Peter Clausen 		stride = 1;
78751239600SJonathan Cameron 		break;
78851239600SJonathan Cameron 	default:
789e08b60d3SLars-Peter Clausen 		stride = 2;
790e08b60d3SLars-Peter Clausen 		break;
791e08b60d3SLars-Peter Clausen 	}
792e08b60d3SLars-Peter Clausen 
7936b92ba0aSLars-Peter Clausen 	len = sysfs_emit(buf, prefix);
794e08b60d3SLars-Peter Clausen 
795e08b60d3SLars-Peter Clausen 	for (i = 0; i <= length - stride; i += stride) {
796e08b60d3SLars-Peter Clausen 		if (i != 0) {
7976b92ba0aSLars-Peter Clausen 			len += sysfs_emit_at(buf, len, " ");
79851239600SJonathan Cameron 			if (len >= PAGE_SIZE)
79951239600SJonathan Cameron 				return -EFBIG;
80051239600SJonathan Cameron 		}
801e08b60d3SLars-Peter Clausen 
8026b92ba0aSLars-Peter Clausen 		len += __iio_format_value(buf, len, type, stride, &vals[i]);
803e08b60d3SLars-Peter Clausen 		if (len >= PAGE_SIZE)
804e08b60d3SLars-Peter Clausen 			return -EFBIG;
80551239600SJonathan Cameron 	}
80651239600SJonathan Cameron 
8076b92ba0aSLars-Peter Clausen 	len += sysfs_emit_at(buf, len, "%s\n", suffix);
808e08b60d3SLars-Peter Clausen 
80951239600SJonathan Cameron 	return len;
81051239600SJonathan Cameron }
81151239600SJonathan Cameron 
iio_format_avail_list(char * buf,const int * vals,int type,int length)812eda20ba1SLars-Peter Clausen static ssize_t iio_format_avail_list(char *buf, const int *vals,
813eda20ba1SLars-Peter Clausen 				     int type, int length)
814eda20ba1SLars-Peter Clausen {
815eda20ba1SLars-Peter Clausen 
816eda20ba1SLars-Peter Clausen 	return iio_format_list(buf, vals, type, length, "", "");
817eda20ba1SLars-Peter Clausen }
818eda20ba1SLars-Peter Clausen 
iio_format_avail_range(char * buf,const int * vals,int type)81951239600SJonathan Cameron static ssize_t iio_format_avail_range(char *buf, const int *vals, int type)
82051239600SJonathan Cameron {
8215e1f9185SFawzi Khaber 	int length;
8225e1f9185SFawzi Khaber 
8235e1f9185SFawzi Khaber 	/*
8245e1f9185SFawzi Khaber 	 * length refers to the array size , not the number of elements.
8255e1f9185SFawzi Khaber 	 * The purpose is to print the range [min , step ,max] so length should
8265e1f9185SFawzi Khaber 	 * be 3 in case of int, and 6 for other types.
8275e1f9185SFawzi Khaber 	 */
8285e1f9185SFawzi Khaber 	switch (type) {
8295e1f9185SFawzi Khaber 	case IIO_VAL_INT:
8305e1f9185SFawzi Khaber 		length = 3;
8315e1f9185SFawzi Khaber 		break;
8325e1f9185SFawzi Khaber 	default:
8335e1f9185SFawzi Khaber 		length = 6;
8345e1f9185SFawzi Khaber 		break;
8355e1f9185SFawzi Khaber 	}
8365e1f9185SFawzi Khaber 
8375e1f9185SFawzi Khaber 	return iio_format_list(buf, vals, type, length, "[", "]");
83851239600SJonathan Cameron }
83951239600SJonathan Cameron 
iio_read_channel_info_avail(struct device * dev,struct device_attribute * attr,char * buf)84051239600SJonathan Cameron static ssize_t iio_read_channel_info_avail(struct device *dev,
84151239600SJonathan Cameron 					   struct device_attribute *attr,
84251239600SJonathan Cameron 					   char *buf)
84351239600SJonathan Cameron {
84451239600SJonathan Cameron 	struct iio_dev *indio_dev = dev_to_iio_dev(dev);
84551239600SJonathan Cameron 	struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
84651239600SJonathan Cameron 	const int *vals;
84751239600SJonathan Cameron 	int ret;
84851239600SJonathan Cameron 	int length;
84951239600SJonathan Cameron 	int type;
85051239600SJonathan Cameron 
851c4ec8dedSJulien Stephan 	if (!indio_dev->info->read_avail)
852c4ec8dedSJulien Stephan 		return -EINVAL;
853c4ec8dedSJulien Stephan 
85451239600SJonathan Cameron 	ret = indio_dev->info->read_avail(indio_dev, this_attr->c,
85551239600SJonathan Cameron 					  &vals, &type, &length,
85651239600SJonathan Cameron 					  this_attr->address);
85751239600SJonathan Cameron 
85851239600SJonathan Cameron 	if (ret < 0)
85951239600SJonathan Cameron 		return ret;
86051239600SJonathan Cameron 	switch (ret) {
86151239600SJonathan Cameron 	case IIO_AVAIL_LIST:
86251239600SJonathan Cameron 		return iio_format_avail_list(buf, vals, type, length);
86351239600SJonathan Cameron 	case IIO_AVAIL_RANGE:
86451239600SJonathan Cameron 		return iio_format_avail_range(buf, vals, type);
86551239600SJonathan Cameron 	default:
86651239600SJonathan Cameron 		return -EINVAL;
86751239600SJonathan Cameron 	}
86851239600SJonathan Cameron }
86951239600SJonathan Cameron 
8706807d721SLars-Peter Clausen /**
871b8528224SBeniamin Bia  * __iio_str_to_fixpoint() - Parse a fixed-point number from a string
8726807d721SLars-Peter Clausen  * @str: The string to parse
8736807d721SLars-Peter Clausen  * @fract_mult: Multiplier for the first decimal place, should be a power of 10
8746807d721SLars-Peter Clausen  * @integer: The integer part of the number
8756807d721SLars-Peter Clausen  * @fract: The fractional part of the number
876b8528224SBeniamin Bia  * @scale_db: True if this should parse as dB
8776807d721SLars-Peter Clausen  *
87865659a8dSAndy Shevchenko  * Returns:
87965659a8dSAndy Shevchenko  * 0 on success, or a negative error code if the string could not be parsed.
8806807d721SLars-Peter Clausen  */
__iio_str_to_fixpoint(const char * str,int fract_mult,int * integer,int * fract,bool scale_db)881b8528224SBeniamin Bia static int __iio_str_to_fixpoint(const char *str, int fract_mult,
882b8528224SBeniamin Bia 				 int *integer, int *fract, bool scale_db)
8836807d721SLars-Peter Clausen {
8846807d721SLars-Peter Clausen 	int i = 0, f = 0;
8856807d721SLars-Peter Clausen 	bool integer_part = true, negative = false;
8866807d721SLars-Peter Clausen 
887f47dff32SSean Nyekjaer 	if (fract_mult == 0) {
888f47dff32SSean Nyekjaer 		*fract = 0;
889f47dff32SSean Nyekjaer 
890f47dff32SSean Nyekjaer 		return kstrtoint(str, 0, integer);
891f47dff32SSean Nyekjaer 	}
892f47dff32SSean Nyekjaer 
8936807d721SLars-Peter Clausen 	if (str[0] == '-') {
8946807d721SLars-Peter Clausen 		negative = true;
8956807d721SLars-Peter Clausen 		str++;
8966807d721SLars-Peter Clausen 	} else if (str[0] == '+') {
8976807d721SLars-Peter Clausen 		str++;
8986807d721SLars-Peter Clausen 	}
8996807d721SLars-Peter Clausen 
9006807d721SLars-Peter Clausen 	while (*str) {
9016807d721SLars-Peter Clausen 		if ('0' <= *str && *str <= '9') {
9026807d721SLars-Peter Clausen 			if (integer_part) {
9036807d721SLars-Peter Clausen 				i = i * 10 + *str - '0';
9046807d721SLars-Peter Clausen 			} else {
9056807d721SLars-Peter Clausen 				f += fract_mult * (*str - '0');
9066807d721SLars-Peter Clausen 				fract_mult /= 10;
9076807d721SLars-Peter Clausen 			}
9086807d721SLars-Peter Clausen 		} else if (*str == '\n') {
9096807d721SLars-Peter Clausen 			if (*(str + 1) == '\0')
9106807d721SLars-Peter Clausen 				break;
9116807d721SLars-Peter Clausen 			return -EINVAL;
912b8528224SBeniamin Bia 		} else if (!strncmp(str, " dB", sizeof(" dB") - 1) && scale_db) {
913b8528224SBeniamin Bia 			/* Ignore the dB suffix */
914b8528224SBeniamin Bia 			str += sizeof(" dB") - 1;
915b8528224SBeniamin Bia 			continue;
916b8528224SBeniamin Bia 		} else if (!strncmp(str, "dB", sizeof("dB") - 1) && scale_db) {
917b8528224SBeniamin Bia 			/* Ignore the dB suffix */
918b8528224SBeniamin Bia 			str += sizeof("dB") - 1;
919b8528224SBeniamin Bia 			continue;
9206807d721SLars-Peter Clausen 		} else if (*str == '.' && integer_part) {
9216807d721SLars-Peter Clausen 			integer_part = false;
9226807d721SLars-Peter Clausen 		} else {
9236807d721SLars-Peter Clausen 			return -EINVAL;
9246807d721SLars-Peter Clausen 		}
9256807d721SLars-Peter Clausen 		str++;
9266807d721SLars-Peter Clausen 	}
9276807d721SLars-Peter Clausen 
9286807d721SLars-Peter Clausen 	if (negative) {
9296807d721SLars-Peter Clausen 		if (i)
9306807d721SLars-Peter Clausen 			i = -i;
9316807d721SLars-Peter Clausen 		else
9326807d721SLars-Peter Clausen 			f = -f;
9336807d721SLars-Peter Clausen 	}
9346807d721SLars-Peter Clausen 
9356807d721SLars-Peter Clausen 	*integer = i;
9366807d721SLars-Peter Clausen 	*fract = f;
9376807d721SLars-Peter Clausen 
9386807d721SLars-Peter Clausen 	return 0;
9396807d721SLars-Peter Clausen }
940b8528224SBeniamin Bia 
941b8528224SBeniamin Bia /**
942b8528224SBeniamin Bia  * iio_str_to_fixpoint() - Parse a fixed-point number from a string
943b8528224SBeniamin Bia  * @str: The string to parse
944b8528224SBeniamin Bia  * @fract_mult: Multiplier for the first decimal place, should be a power of 10
945b8528224SBeniamin Bia  * @integer: The integer part of the number
946b8528224SBeniamin Bia  * @fract: The fractional part of the number
947b8528224SBeniamin Bia  *
94865659a8dSAndy Shevchenko  * Returns:
94965659a8dSAndy Shevchenko  * 0 on success, or a negative error code if the string could not be parsed.
950b8528224SBeniamin Bia  */
iio_str_to_fixpoint(const char * str,int fract_mult,int * integer,int * fract)951b8528224SBeniamin Bia int iio_str_to_fixpoint(const char *str, int fract_mult,
952b8528224SBeniamin Bia 			int *integer, int *fract)
953b8528224SBeniamin Bia {
954b8528224SBeniamin Bia 	return __iio_str_to_fixpoint(str, fract_mult, integer, fract, false);
955b8528224SBeniamin Bia }
9566807d721SLars-Peter Clausen EXPORT_SYMBOL_GPL(iio_str_to_fixpoint);
9576807d721SLars-Peter Clausen 
iio_write_channel_info(struct device * dev,struct device_attribute * attr,const char * buf,size_t len)958a980e046SJonathan Cameron static ssize_t iio_write_channel_info(struct device *dev,
959a980e046SJonathan Cameron 				      struct device_attribute *attr,
960a980e046SJonathan Cameron 				      const char *buf,
961a980e046SJonathan Cameron 				      size_t len)
962a980e046SJonathan Cameron {
963e53f5ac5SLars-Peter Clausen 	struct iio_dev *indio_dev = dev_to_iio_dev(dev);
964a980e046SJonathan Cameron 	struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
9656807d721SLars-Peter Clausen 	int ret, fract_mult = 100000;
9668cb34036SAndrea Merello 	int integer, fract = 0;
9678cb34036SAndrea Merello 	bool is_char = false;
968b8528224SBeniamin Bia 	bool scale_db = false;
969a980e046SJonathan Cameron 
970a980e046SJonathan Cameron 	/* Assumes decimal - precision based on number of digits */
971a980e046SJonathan Cameron 	if (!indio_dev->info->write_raw)
972a980e046SJonathan Cameron 		return -EINVAL;
973a980e046SJonathan Cameron 
974a980e046SJonathan Cameron 	if (indio_dev->info->write_raw_get_fmt)
975a980e046SJonathan Cameron 		switch (indio_dev->info->write_raw_get_fmt(indio_dev,
976a980e046SJonathan Cameron 			this_attr->c, this_attr->address)) {
977f47dff32SSean Nyekjaer 		case IIO_VAL_INT:
978f47dff32SSean Nyekjaer 			fract_mult = 0;
979f47dff32SSean Nyekjaer 			break;
980b8528224SBeniamin Bia 		case IIO_VAL_INT_PLUS_MICRO_DB:
981b8528224SBeniamin Bia 			scale_db = true;
982df561f66SGustavo A. R. Silva 			fallthrough;
983a980e046SJonathan Cameron 		case IIO_VAL_INT_PLUS_MICRO:
984a980e046SJonathan Cameron 			fract_mult = 100000;
985a980e046SJonathan Cameron 			break;
986a980e046SJonathan Cameron 		case IIO_VAL_INT_PLUS_NANO:
987a980e046SJonathan Cameron 			fract_mult = 100000000;
988a980e046SJonathan Cameron 			break;
9898cb34036SAndrea Merello 		case IIO_VAL_CHAR:
9908cb34036SAndrea Merello 			is_char = true;
9918cb34036SAndrea Merello 			break;
992a980e046SJonathan Cameron 		default:
993a980e046SJonathan Cameron 			return -EINVAL;
994a980e046SJonathan Cameron 		}
995a980e046SJonathan Cameron 
9968cb34036SAndrea Merello 	if (is_char) {
9978cb34036SAndrea Merello 		char ch;
9988cb34036SAndrea Merello 
9998cb34036SAndrea Merello 		if (sscanf(buf, "%c", &ch) != 1)
10008cb34036SAndrea Merello 			return -EINVAL;
10018cb34036SAndrea Merello 		integer = ch;
10028cb34036SAndrea Merello 	} else {
1003b8528224SBeniamin Bia 		ret = __iio_str_to_fixpoint(buf, fract_mult, &integer, &fract,
1004b8528224SBeniamin Bia 					    scale_db);
1005b8528224SBeniamin Bia 		if (ret)
1006b8528224SBeniamin Bia 			return ret;
10075403f280SMircea Caprioru 	}
1008a980e046SJonathan Cameron 
1009a980e046SJonathan Cameron 	ret = indio_dev->info->write_raw(indio_dev, this_attr->c,
1010a980e046SJonathan Cameron 					 integer, fract, this_attr->address);
1011a980e046SJonathan Cameron 	if (ret)
1012a980e046SJonathan Cameron 		return ret;
1013a980e046SJonathan Cameron 
1014a980e046SJonathan Cameron 	return len;
1015a980e046SJonathan Cameron }
1016a980e046SJonathan Cameron 
1017a980e046SJonathan Cameron static
__iio_device_attr_init(struct device_attribute * dev_attr,const char * postfix,struct iio_chan_spec const * chan,ssize_t (* readfunc)(struct device * dev,struct device_attribute * attr,char * buf),ssize_t (* writefunc)(struct device * dev,struct device_attribute * attr,const char * buf,size_t len),enum iio_shared_by shared_by)1018a980e046SJonathan Cameron int __iio_device_attr_init(struct device_attribute *dev_attr,
1019a980e046SJonathan Cameron 			   const char *postfix,
1020a980e046SJonathan Cameron 			   struct iio_chan_spec const *chan,
1021a980e046SJonathan Cameron 			   ssize_t (*readfunc)(struct device *dev,
1022a980e046SJonathan Cameron 					       struct device_attribute *attr,
1023a980e046SJonathan Cameron 					       char *buf),
1024a980e046SJonathan Cameron 			   ssize_t (*writefunc)(struct device *dev,
1025a980e046SJonathan Cameron 						struct device_attribute *attr,
1026a980e046SJonathan Cameron 						const char *buf,
1027a980e046SJonathan Cameron 						size_t len),
10283704432fSJonathan Cameron 			   enum iio_shared_by shared_by)
1029a980e046SJonathan Cameron {
10303704432fSJonathan Cameron 	int ret = 0;
10317bbcf7e1SLars-Peter Clausen 	char *name = NULL;
10323704432fSJonathan Cameron 	char *full_postfix;
10339d9ec8d0SJoe Simmons-Talbott 
1034a980e046SJonathan Cameron 	sysfs_attr_init(&dev_attr->attr);
1035a980e046SJonathan Cameron 
1036a980e046SJonathan Cameron 	/* Build up postfix of <extend_name>_<modifier>_postfix */
10373704432fSJonathan Cameron 	if (chan->modified && (shared_by == IIO_SEPARATE)) {
1038a980e046SJonathan Cameron 		if (chan->extend_name)
1039a980e046SJonathan Cameron 			full_postfix = kasprintf(GFP_KERNEL, "%s_%s_%s",
1040b662f4baSAndy Shevchenko 						 iio_modifier_names[chan->channel2],
1041a980e046SJonathan Cameron 						 chan->extend_name,
1042a980e046SJonathan Cameron 						 postfix);
1043a980e046SJonathan Cameron 		else
1044a980e046SJonathan Cameron 			full_postfix = kasprintf(GFP_KERNEL, "%s_%s",
1045b662f4baSAndy Shevchenko 						 iio_modifier_names[chan->channel2],
1046a980e046SJonathan Cameron 						 postfix);
1047a980e046SJonathan Cameron 	} else {
104877bfa8baSLars-Peter Clausen 		if (chan->extend_name == NULL || shared_by != IIO_SEPARATE)
1049a980e046SJonathan Cameron 			full_postfix = kstrdup(postfix, GFP_KERNEL);
1050a980e046SJonathan Cameron 		else
1051a980e046SJonathan Cameron 			full_postfix = kasprintf(GFP_KERNEL,
1052a980e046SJonathan Cameron 						 "%s_%s",
1053a980e046SJonathan Cameron 						 chan->extend_name,
1054a980e046SJonathan Cameron 						 postfix);
1055a980e046SJonathan Cameron 	}
10563704432fSJonathan Cameron 	if (full_postfix == NULL)
10573704432fSJonathan Cameron 		return -ENOMEM;
1058a980e046SJonathan Cameron 
1059a980e046SJonathan Cameron 	if (chan->differential) { /* Differential can not have modifier */
10603704432fSJonathan Cameron 		switch (shared_by) {
1061c006ec83SJonathan Cameron 		case IIO_SHARED_BY_ALL:
10627bbcf7e1SLars-Peter Clausen 			name = kasprintf(GFP_KERNEL, "%s", full_postfix);
1063c006ec83SJonathan Cameron 			break;
1064c006ec83SJonathan Cameron 		case IIO_SHARED_BY_DIR:
10657bbcf7e1SLars-Peter Clausen 			name = kasprintf(GFP_KERNEL, "%s_%s",
1066c006ec83SJonathan Cameron 						iio_direction[chan->output],
1067c006ec83SJonathan Cameron 						full_postfix);
1068c006ec83SJonathan Cameron 			break;
10693704432fSJonathan Cameron 		case IIO_SHARED_BY_TYPE:
10707bbcf7e1SLars-Peter Clausen 			name = kasprintf(GFP_KERNEL, "%s_%s-%s_%s",
1071a980e046SJonathan Cameron 					    iio_direction[chan->output],
1072a980e046SJonathan Cameron 					    iio_chan_type_name_spec[chan->type],
1073a980e046SJonathan Cameron 					    iio_chan_type_name_spec[chan->type],
1074a980e046SJonathan Cameron 					    full_postfix);
10753704432fSJonathan Cameron 			break;
10763704432fSJonathan Cameron 		case IIO_SEPARATE:
10773704432fSJonathan Cameron 			if (!chan->indexed) {
1078231bfe53SDan Carpenter 				WARN(1, "Differential channels must be indexed\n");
10793704432fSJonathan Cameron 				ret = -EINVAL;
10803704432fSJonathan Cameron 				goto error_free_full_postfix;
10813704432fSJonathan Cameron 			}
10827bbcf7e1SLars-Peter Clausen 			name = kasprintf(GFP_KERNEL,
10833704432fSJonathan Cameron 					    "%s_%s%d-%s%d_%s",
1084a980e046SJonathan Cameron 					    iio_direction[chan->output],
1085a980e046SJonathan Cameron 					    iio_chan_type_name_spec[chan->type],
1086a980e046SJonathan Cameron 					    chan->channel,
1087a980e046SJonathan Cameron 					    iio_chan_type_name_spec[chan->type],
1088a980e046SJonathan Cameron 					    chan->channel2,
1089a980e046SJonathan Cameron 					    full_postfix);
10903704432fSJonathan Cameron 			break;
1091a980e046SJonathan Cameron 		}
1092a980e046SJonathan Cameron 	} else { /* Single ended */
10933704432fSJonathan Cameron 		switch (shared_by) {
1094c006ec83SJonathan Cameron 		case IIO_SHARED_BY_ALL:
10957bbcf7e1SLars-Peter Clausen 			name = kasprintf(GFP_KERNEL, "%s", full_postfix);
1096c006ec83SJonathan Cameron 			break;
1097c006ec83SJonathan Cameron 		case IIO_SHARED_BY_DIR:
10987bbcf7e1SLars-Peter Clausen 			name = kasprintf(GFP_KERNEL, "%s_%s",
1099c006ec83SJonathan Cameron 						iio_direction[chan->output],
1100c006ec83SJonathan Cameron 						full_postfix);
1101c006ec83SJonathan Cameron 			break;
11023704432fSJonathan Cameron 		case IIO_SHARED_BY_TYPE:
11037bbcf7e1SLars-Peter Clausen 			name = kasprintf(GFP_KERNEL, "%s_%s_%s",
1104a980e046SJonathan Cameron 					    iio_direction[chan->output],
1105a980e046SJonathan Cameron 					    iio_chan_type_name_spec[chan->type],
1106a980e046SJonathan Cameron 					    full_postfix);
11073704432fSJonathan Cameron 			break;
11083704432fSJonathan Cameron 
11093704432fSJonathan Cameron 		case IIO_SEPARATE:
11103704432fSJonathan Cameron 			if (chan->indexed)
11117bbcf7e1SLars-Peter Clausen 				name = kasprintf(GFP_KERNEL, "%s_%s%d_%s",
1112a980e046SJonathan Cameron 						    iio_direction[chan->output],
1113a980e046SJonathan Cameron 						    iio_chan_type_name_spec[chan->type],
1114a980e046SJonathan Cameron 						    chan->channel,
1115a980e046SJonathan Cameron 						    full_postfix);
1116a980e046SJonathan Cameron 			else
11177bbcf7e1SLars-Peter Clausen 				name = kasprintf(GFP_KERNEL, "%s_%s_%s",
1118a980e046SJonathan Cameron 						    iio_direction[chan->output],
1119a980e046SJonathan Cameron 						    iio_chan_type_name_spec[chan->type],
1120a980e046SJonathan Cameron 						    full_postfix);
11213704432fSJonathan Cameron 			break;
11223704432fSJonathan Cameron 		}
1123a980e046SJonathan Cameron 	}
11247bbcf7e1SLars-Peter Clausen 	if (name == NULL) {
1125a980e046SJonathan Cameron 		ret = -ENOMEM;
1126a980e046SJonathan Cameron 		goto error_free_full_postfix;
1127a980e046SJonathan Cameron 	}
11287bbcf7e1SLars-Peter Clausen 	dev_attr->attr.name = name;
1129a980e046SJonathan Cameron 
1130a980e046SJonathan Cameron 	if (readfunc) {
11319cf0b618SJoe Simmons-Talbott 		dev_attr->attr.mode |= 0444;
1132a980e046SJonathan Cameron 		dev_attr->show = readfunc;
1133a980e046SJonathan Cameron 	}
1134a980e046SJonathan Cameron 
1135a980e046SJonathan Cameron 	if (writefunc) {
11369cf0b618SJoe Simmons-Talbott 		dev_attr->attr.mode |= 0200;
1137a980e046SJonathan Cameron 		dev_attr->store = writefunc;
1138a980e046SJonathan Cameron 	}
11397bbcf7e1SLars-Peter Clausen 
1140a980e046SJonathan Cameron error_free_full_postfix:
1141a980e046SJonathan Cameron 	kfree(full_postfix);
11423704432fSJonathan Cameron 
1143a980e046SJonathan Cameron 	return ret;
1144a980e046SJonathan Cameron }
1145a980e046SJonathan Cameron 
__iio_device_attr_deinit(struct device_attribute * dev_attr)1146a980e046SJonathan Cameron static void __iio_device_attr_deinit(struct device_attribute *dev_attr)
1147a980e046SJonathan Cameron {
1148a980e046SJonathan Cameron 	kfree(dev_attr->attr.name);
1149a980e046SJonathan Cameron }
1150a980e046SJonathan Cameron 
__iio_add_chan_devattr(const char * postfix,struct iio_chan_spec const * chan,ssize_t (* readfunc)(struct device * dev,struct device_attribute * attr,char * buf),ssize_t (* writefunc)(struct device * dev,struct device_attribute * attr,const char * buf,size_t len),u64 mask,enum iio_shared_by shared_by,struct device * dev,struct iio_buffer * buffer,struct list_head * attr_list)1151a980e046SJonathan Cameron int __iio_add_chan_devattr(const char *postfix,
1152a980e046SJonathan Cameron 			   struct iio_chan_spec const *chan,
1153a980e046SJonathan Cameron 			   ssize_t (*readfunc)(struct device *dev,
1154a980e046SJonathan Cameron 					       struct device_attribute *attr,
1155a980e046SJonathan Cameron 					       char *buf),
1156a980e046SJonathan Cameron 			   ssize_t (*writefunc)(struct device *dev,
1157a980e046SJonathan Cameron 						struct device_attribute *attr,
1158a980e046SJonathan Cameron 						const char *buf,
1159a980e046SJonathan Cameron 						size_t len),
1160a980e046SJonathan Cameron 			   u64 mask,
11613704432fSJonathan Cameron 			   enum iio_shared_by shared_by,
1162a980e046SJonathan Cameron 			   struct device *dev,
11633e3d11b2SAlexandru Ardelean 			   struct iio_buffer *buffer,
1164a980e046SJonathan Cameron 			   struct list_head *attr_list)
1165a980e046SJonathan Cameron {
1166a980e046SJonathan Cameron 	int ret;
1167a980e046SJonathan Cameron 	struct iio_dev_attr *iio_attr, *t;
1168a980e046SJonathan Cameron 
1169670c1103SSachin Kamat 	iio_attr = kzalloc(sizeof(*iio_attr), GFP_KERNEL);
117092825ff9SHartmut Knaack 	if (iio_attr == NULL)
117192825ff9SHartmut Knaack 		return -ENOMEM;
1172a980e046SJonathan Cameron 	ret = __iio_device_attr_init(&iio_attr->dev_attr,
1173a980e046SJonathan Cameron 				     postfix, chan,
11743704432fSJonathan Cameron 				     readfunc, writefunc, shared_by);
1175a980e046SJonathan Cameron 	if (ret)
1176a980e046SJonathan Cameron 		goto error_iio_dev_attr_free;
1177a980e046SJonathan Cameron 	iio_attr->c = chan;
1178a980e046SJonathan Cameron 	iio_attr->address = mask;
11793e3d11b2SAlexandru Ardelean 	iio_attr->buffer = buffer;
1180a980e046SJonathan Cameron 	list_for_each_entry(t, attr_list, l)
1181a980e046SJonathan Cameron 		if (strcmp(t->dev_attr.attr.name,
1182a980e046SJonathan Cameron 			   iio_attr->dev_attr.attr.name) == 0) {
11833704432fSJonathan Cameron 			if (shared_by == IIO_SEPARATE)
1184a980e046SJonathan Cameron 				dev_err(dev, "tried to double register : %s\n",
1185a980e046SJonathan Cameron 					t->dev_attr.attr.name);
1186a980e046SJonathan Cameron 			ret = -EBUSY;
1187a980e046SJonathan Cameron 			goto error_device_attr_deinit;
1188a980e046SJonathan Cameron 		}
1189a980e046SJonathan Cameron 	list_add(&iio_attr->l, attr_list);
1190a980e046SJonathan Cameron 
1191a980e046SJonathan Cameron 	return 0;
1192a980e046SJonathan Cameron 
1193a980e046SJonathan Cameron error_device_attr_deinit:
1194a980e046SJonathan Cameron 	__iio_device_attr_deinit(&iio_attr->dev_attr);
1195a980e046SJonathan Cameron error_iio_dev_attr_free:
1196a980e046SJonathan Cameron 	kfree(iio_attr);
1197a980e046SJonathan Cameron 	return ret;
1198a980e046SJonathan Cameron }
1199a980e046SJonathan Cameron 
iio_device_add_channel_label(struct iio_dev * indio_dev,struct iio_chan_spec const * chan)12001d4ef9b3SCristian Pop static int iio_device_add_channel_label(struct iio_dev *indio_dev,
12011d4ef9b3SCristian Pop 					 struct iio_chan_spec const *chan)
12021d4ef9b3SCristian Pop {
12031d4ef9b3SCristian Pop 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
12041d4ef9b3SCristian Pop 	int ret;
12051d4ef9b3SCristian Pop 
120613efdc3dSPaul Cercueil 	if (!indio_dev->info->read_label && !chan->extend_name)
12071d4ef9b3SCristian Pop 		return 0;
12081d4ef9b3SCristian Pop 
12091d4ef9b3SCristian Pop 	ret = __iio_add_chan_devattr("label",
12101d4ef9b3SCristian Pop 				     chan,
12111d4ef9b3SCristian Pop 				     &iio_read_channel_label,
12121d4ef9b3SCristian Pop 				     NULL,
12131d4ef9b3SCristian Pop 				     0,
12141d4ef9b3SCristian Pop 				     IIO_SEPARATE,
12151d4ef9b3SCristian Pop 				     &indio_dev->dev,
12163e3d11b2SAlexandru Ardelean 				     NULL,
12171d4ef9b3SCristian Pop 				     &iio_dev_opaque->channel_attr_list);
12181d4ef9b3SCristian Pop 	if (ret < 0)
12191d4ef9b3SCristian Pop 		return ret;
12201d4ef9b3SCristian Pop 
12211d4ef9b3SCristian Pop 	return 1;
12221d4ef9b3SCristian Pop }
12231d4ef9b3SCristian Pop 
iio_device_add_info_mask_type(struct iio_dev * indio_dev,struct iio_chan_spec const * chan,enum iio_shared_by shared_by,const long * infomask)12243704432fSJonathan Cameron static int iio_device_add_info_mask_type(struct iio_dev *indio_dev,
12253704432fSJonathan Cameron 					 struct iio_chan_spec const *chan,
12263704432fSJonathan Cameron 					 enum iio_shared_by shared_by,
12273704432fSJonathan Cameron 					 const long *infomask)
12283704432fSJonathan Cameron {
1229207c2d27SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
12303704432fSJonathan Cameron 	int i, ret, attrcount = 0;
12313704432fSJonathan Cameron 
12321016d567SOrson Zhai 	for_each_set_bit(i, infomask, sizeof(*infomask)*8) {
1233ef4b4856SJonathan Cameron 		if (i >= ARRAY_SIZE(iio_chan_info_postfix))
1234ef4b4856SJonathan Cameron 			return -EINVAL;
12353704432fSJonathan Cameron 		ret = __iio_add_chan_devattr(iio_chan_info_postfix[i],
12363704432fSJonathan Cameron 					     chan,
12373704432fSJonathan Cameron 					     &iio_read_channel_info,
12383704432fSJonathan Cameron 					     &iio_write_channel_info,
12393704432fSJonathan Cameron 					     i,
12403704432fSJonathan Cameron 					     shared_by,
12413704432fSJonathan Cameron 					     &indio_dev->dev,
12423e3d11b2SAlexandru Ardelean 					     NULL,
1243207c2d27SAlexandru Ardelean 					     &iio_dev_opaque->channel_attr_list);
12443704432fSJonathan Cameron 		if ((ret == -EBUSY) && (shared_by != IIO_SEPARATE))
12453704432fSJonathan Cameron 			continue;
12461702df5dSAndy Shevchenko 		if (ret < 0)
12473704432fSJonathan Cameron 			return ret;
12483704432fSJonathan Cameron 		attrcount++;
12493704432fSJonathan Cameron 	}
12503704432fSJonathan Cameron 
12513704432fSJonathan Cameron 	return attrcount;
12523704432fSJonathan Cameron }
12533704432fSJonathan Cameron 
iio_device_add_info_mask_type_avail(struct iio_dev * indio_dev,struct iio_chan_spec const * chan,enum iio_shared_by shared_by,const long * infomask)125451239600SJonathan Cameron static int iio_device_add_info_mask_type_avail(struct iio_dev *indio_dev,
125551239600SJonathan Cameron 					       struct iio_chan_spec const *chan,
125651239600SJonathan Cameron 					       enum iio_shared_by shared_by,
125751239600SJonathan Cameron 					       const long *infomask)
125851239600SJonathan Cameron {
1259207c2d27SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
126051239600SJonathan Cameron 	int i, ret, attrcount = 0;
126151239600SJonathan Cameron 	char *avail_postfix;
126251239600SJonathan Cameron 
12631016d567SOrson Zhai 	for_each_set_bit(i, infomask, sizeof(*infomask) * 8) {
1264936d3e53SYoung Xiao 		if (i >= ARRAY_SIZE(iio_chan_info_postfix))
1265936d3e53SYoung Xiao 			return -EINVAL;
126651239600SJonathan Cameron 		avail_postfix = kasprintf(GFP_KERNEL,
126751239600SJonathan Cameron 					  "%s_available",
126851239600SJonathan Cameron 					  iio_chan_info_postfix[i]);
126951239600SJonathan Cameron 		if (!avail_postfix)
127051239600SJonathan Cameron 			return -ENOMEM;
127151239600SJonathan Cameron 
127251239600SJonathan Cameron 		ret = __iio_add_chan_devattr(avail_postfix,
127351239600SJonathan Cameron 					     chan,
127451239600SJonathan Cameron 					     &iio_read_channel_info_avail,
127551239600SJonathan Cameron 					     NULL,
127651239600SJonathan Cameron 					     i,
127751239600SJonathan Cameron 					     shared_by,
127851239600SJonathan Cameron 					     &indio_dev->dev,
12793e3d11b2SAlexandru Ardelean 					     NULL,
1280207c2d27SAlexandru Ardelean 					     &iio_dev_opaque->channel_attr_list);
128151239600SJonathan Cameron 		kfree(avail_postfix);
128251239600SJonathan Cameron 		if ((ret == -EBUSY) && (shared_by != IIO_SEPARATE))
128351239600SJonathan Cameron 			continue;
12841702df5dSAndy Shevchenko 		if (ret < 0)
128551239600SJonathan Cameron 			return ret;
128651239600SJonathan Cameron 		attrcount++;
128751239600SJonathan Cameron 	}
128851239600SJonathan Cameron 
128951239600SJonathan Cameron 	return attrcount;
129051239600SJonathan Cameron }
129151239600SJonathan Cameron 
iio_device_add_channel_sysfs(struct iio_dev * indio_dev,struct iio_chan_spec const * chan)1292a980e046SJonathan Cameron static int iio_device_add_channel_sysfs(struct iio_dev *indio_dev,
1293a980e046SJonathan Cameron 					struct iio_chan_spec const *chan)
1294a980e046SJonathan Cameron {
1295207c2d27SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
1296a980e046SJonathan Cameron 	int ret, attrcount = 0;
1297a980e046SJonathan Cameron 	const struct iio_chan_spec_ext_info *ext_info;
1298a980e046SJonathan Cameron 
1299a980e046SJonathan Cameron 	if (chan->channel < 0)
1300a980e046SJonathan Cameron 		return 0;
13013704432fSJonathan Cameron 	ret = iio_device_add_info_mask_type(indio_dev, chan,
13023704432fSJonathan Cameron 					    IIO_SEPARATE,
13033704432fSJonathan Cameron 					    &chan->info_mask_separate);
13048655cc49SJonathan Cameron 	if (ret < 0)
13053704432fSJonathan Cameron 		return ret;
13063704432fSJonathan Cameron 	attrcount += ret;
13073704432fSJonathan Cameron 
130851239600SJonathan Cameron 	ret = iio_device_add_info_mask_type_avail(indio_dev, chan,
130951239600SJonathan Cameron 						  IIO_SEPARATE,
1310682ca76bSJoe Simmons-Talbott 						  &chan->info_mask_separate_available);
131151239600SJonathan Cameron 	if (ret < 0)
131251239600SJonathan Cameron 		return ret;
131351239600SJonathan Cameron 	attrcount += ret;
131451239600SJonathan Cameron 
13153704432fSJonathan Cameron 	ret = iio_device_add_info_mask_type(indio_dev, chan,
13163704432fSJonathan Cameron 					    IIO_SHARED_BY_TYPE,
13173704432fSJonathan Cameron 					    &chan->info_mask_shared_by_type);
13183704432fSJonathan Cameron 	if (ret < 0)
13193704432fSJonathan Cameron 		return ret;
13203704432fSJonathan Cameron 	attrcount += ret;
1321a980e046SJonathan Cameron 
132251239600SJonathan Cameron 	ret = iio_device_add_info_mask_type_avail(indio_dev, chan,
132351239600SJonathan Cameron 						  IIO_SHARED_BY_TYPE,
1324682ca76bSJoe Simmons-Talbott 						  &chan->info_mask_shared_by_type_available);
132551239600SJonathan Cameron 	if (ret < 0)
132651239600SJonathan Cameron 		return ret;
132751239600SJonathan Cameron 	attrcount += ret;
132851239600SJonathan Cameron 
1329c006ec83SJonathan Cameron 	ret = iio_device_add_info_mask_type(indio_dev, chan,
1330c006ec83SJonathan Cameron 					    IIO_SHARED_BY_DIR,
1331c006ec83SJonathan Cameron 					    &chan->info_mask_shared_by_dir);
1332c006ec83SJonathan Cameron 	if (ret < 0)
1333c006ec83SJonathan Cameron 		return ret;
1334c006ec83SJonathan Cameron 	attrcount += ret;
1335c006ec83SJonathan Cameron 
133651239600SJonathan Cameron 	ret = iio_device_add_info_mask_type_avail(indio_dev, chan,
133751239600SJonathan Cameron 						  IIO_SHARED_BY_DIR,
133851239600SJonathan Cameron 						  &chan->info_mask_shared_by_dir_available);
133951239600SJonathan Cameron 	if (ret < 0)
134051239600SJonathan Cameron 		return ret;
134151239600SJonathan Cameron 	attrcount += ret;
134251239600SJonathan Cameron 
1343c006ec83SJonathan Cameron 	ret = iio_device_add_info_mask_type(indio_dev, chan,
1344c006ec83SJonathan Cameron 					    IIO_SHARED_BY_ALL,
1345c006ec83SJonathan Cameron 					    &chan->info_mask_shared_by_all);
1346c006ec83SJonathan Cameron 	if (ret < 0)
1347c006ec83SJonathan Cameron 		return ret;
1348c006ec83SJonathan Cameron 	attrcount += ret;
1349c006ec83SJonathan Cameron 
135051239600SJonathan Cameron 	ret = iio_device_add_info_mask_type_avail(indio_dev, chan,
135151239600SJonathan Cameron 						  IIO_SHARED_BY_ALL,
135251239600SJonathan Cameron 						  &chan->info_mask_shared_by_all_available);
135351239600SJonathan Cameron 	if (ret < 0)
135451239600SJonathan Cameron 		return ret;
135551239600SJonathan Cameron 	attrcount += ret;
135651239600SJonathan Cameron 
13571d4ef9b3SCristian Pop 	ret = iio_device_add_channel_label(indio_dev, chan);
13581d4ef9b3SCristian Pop 	if (ret < 0)
13591d4ef9b3SCristian Pop 		return ret;
13601d4ef9b3SCristian Pop 	attrcount += ret;
13611d4ef9b3SCristian Pop 
1362a980e046SJonathan Cameron 	if (chan->ext_info) {
1363a980e046SJonathan Cameron 		unsigned int i = 0;
13649d9ec8d0SJoe Simmons-Talbott 
1365a980e046SJonathan Cameron 		for (ext_info = chan->ext_info; ext_info->name; ext_info++) {
1366a980e046SJonathan Cameron 			ret = __iio_add_chan_devattr(ext_info->name,
1367a980e046SJonathan Cameron 					chan,
1368a980e046SJonathan Cameron 					ext_info->read ?
1369a980e046SJonathan Cameron 					    &iio_read_channel_ext_info : NULL,
1370a980e046SJonathan Cameron 					ext_info->write ?
1371a980e046SJonathan Cameron 					    &iio_write_channel_ext_info : NULL,
1372a980e046SJonathan Cameron 					i,
1373a980e046SJonathan Cameron 					ext_info->shared,
1374a980e046SJonathan Cameron 					&indio_dev->dev,
13753e3d11b2SAlexandru Ardelean 					NULL,
1376207c2d27SAlexandru Ardelean 					&iio_dev_opaque->channel_attr_list);
1377a980e046SJonathan Cameron 			i++;
1378a980e046SJonathan Cameron 			if (ret == -EBUSY && ext_info->shared)
1379a980e046SJonathan Cameron 				continue;
1380a980e046SJonathan Cameron 
1381a980e046SJonathan Cameron 			if (ret)
13823704432fSJonathan Cameron 				return ret;
1383a980e046SJonathan Cameron 
1384a980e046SJonathan Cameron 			attrcount++;
1385a980e046SJonathan Cameron 		}
1386a980e046SJonathan Cameron 	}
1387a980e046SJonathan Cameron 
13883704432fSJonathan Cameron 	return attrcount;
1389a980e046SJonathan Cameron }
1390a980e046SJonathan Cameron 
139184088ebdSLars-Peter Clausen /**
139284088ebdSLars-Peter Clausen  * iio_free_chan_devattr_list() - Free a list of IIO device attributes
139384088ebdSLars-Peter Clausen  * @attr_list: List of IIO device attributes
139484088ebdSLars-Peter Clausen  *
139584088ebdSLars-Peter Clausen  * This function frees the memory allocated for each of the IIO device
1396c1b03ab5SMartin Fuzzey  * attributes in the list.
139784088ebdSLars-Peter Clausen  */
iio_free_chan_devattr_list(struct list_head * attr_list)139884088ebdSLars-Peter Clausen void iio_free_chan_devattr_list(struct list_head *attr_list)
1399a980e046SJonathan Cameron {
140084088ebdSLars-Peter Clausen 	struct iio_dev_attr *p, *n;
140184088ebdSLars-Peter Clausen 
140284088ebdSLars-Peter Clausen 	list_for_each_entry_safe(p, n, attr_list, l) {
140315097c7aSAlexandru Ardelean 		kfree_const(p->dev_attr.attr.name);
1404c1b03ab5SMartin Fuzzey 		list_del(&p->l);
1405a980e046SJonathan Cameron 		kfree(p);
1406a980e046SJonathan Cameron 	}
140784088ebdSLars-Peter Clausen }
1408a980e046SJonathan Cameron 
name_show(struct device * dev,struct device_attribute * attr,char * buf)14099cf0b618SJoe Simmons-Talbott static ssize_t name_show(struct device *dev, struct device_attribute *attr,
1410a980e046SJonathan Cameron 			 char *buf)
1411a980e046SJonathan Cameron {
1412e53f5ac5SLars-Peter Clausen 	struct iio_dev *indio_dev = dev_to_iio_dev(dev);
14139d9ec8d0SJoe Simmons-Talbott 
141483ca56b6SLars-Peter Clausen 	return sysfs_emit(buf, "%s\n", indio_dev->name);
1415a980e046SJonathan Cameron }
1416a980e046SJonathan Cameron 
14179cf0b618SJoe Simmons-Talbott static DEVICE_ATTR_RO(name);
1418a980e046SJonathan Cameron 
label_show(struct device * dev,struct device_attribute * attr,char * buf)14199cf0b618SJoe Simmons-Talbott static ssize_t label_show(struct device *dev, struct device_attribute *attr,
14202c3d0c9fSPhil Reid 			  char *buf)
14212c3d0c9fSPhil Reid {
14222c3d0c9fSPhil Reid 	struct iio_dev *indio_dev = dev_to_iio_dev(dev);
14239d9ec8d0SJoe Simmons-Talbott 
142483ca56b6SLars-Peter Clausen 	return sysfs_emit(buf, "%s\n", indio_dev->label);
14252c3d0c9fSPhil Reid }
14262c3d0c9fSPhil Reid 
14279cf0b618SJoe Simmons-Talbott static DEVICE_ATTR_RO(label);
14282c3d0c9fSPhil Reid 
1429971ddd4bSAndy Shevchenko static const char * const clock_names[] = {
1430971ddd4bSAndy Shevchenko 	[CLOCK_REALTIME]	 	= "realtime",
1431971ddd4bSAndy Shevchenko 	[CLOCK_MONOTONIC]	 	= "monotonic",
1432971ddd4bSAndy Shevchenko 	[CLOCK_PROCESS_CPUTIME_ID]	= "process_cputime_id",
1433971ddd4bSAndy Shevchenko 	[CLOCK_THREAD_CPUTIME_ID]	= "thread_cputime_id",
1434971ddd4bSAndy Shevchenko 	[CLOCK_MONOTONIC_RAW]	 	= "monotonic_raw",
1435971ddd4bSAndy Shevchenko 	[CLOCK_REALTIME_COARSE]	 	= "realtime_coarse",
1436971ddd4bSAndy Shevchenko 	[CLOCK_MONOTONIC_COARSE] 	= "monotonic_coarse",
1437971ddd4bSAndy Shevchenko 	[CLOCK_BOOTTIME]	 	= "boottime",
1438971ddd4bSAndy Shevchenko 	[CLOCK_REALTIME_ALARM]		= "realtime_alarm",
1439971ddd4bSAndy Shevchenko 	[CLOCK_BOOTTIME_ALARM]		= "boottime_alarm",
1440971ddd4bSAndy Shevchenko 	[CLOCK_SGI_CYCLE]		= "sgi_cycle",
1441971ddd4bSAndy Shevchenko 	[CLOCK_TAI]		 	= "tai",
1442971ddd4bSAndy Shevchenko };
1443971ddd4bSAndy Shevchenko 
current_timestamp_clock_show(struct device * dev,struct device_attribute * attr,char * buf)14449cf0b618SJoe Simmons-Talbott static ssize_t current_timestamp_clock_show(struct device *dev,
1445bc2b7dabSGregor Boirie 					    struct device_attribute *attr,
1446bc2b7dabSGregor Boirie 					    char *buf)
1447bc2b7dabSGregor Boirie {
1448bc2b7dabSGregor Boirie 	const struct iio_dev *indio_dev = dev_to_iio_dev(dev);
1449bc2b7dabSGregor Boirie 	const clockid_t clk = iio_device_get_clock(indio_dev);
1450bc2b7dabSGregor Boirie 
1451bc2b7dabSGregor Boirie 	switch (clk) {
1452bc2b7dabSGregor Boirie 	case CLOCK_REALTIME:
1453bc2b7dabSGregor Boirie 	case CLOCK_MONOTONIC:
1454bc2b7dabSGregor Boirie 	case CLOCK_MONOTONIC_RAW:
1455bc2b7dabSGregor Boirie 	case CLOCK_REALTIME_COARSE:
1456bc2b7dabSGregor Boirie 	case CLOCK_MONOTONIC_COARSE:
1457bc2b7dabSGregor Boirie 	case CLOCK_BOOTTIME:
1458bc2b7dabSGregor Boirie 	case CLOCK_TAI:
1459bc2b7dabSGregor Boirie 		break;
1460bc2b7dabSGregor Boirie 	default:
1461bc2b7dabSGregor Boirie 		BUG();
1462bc2b7dabSGregor Boirie 	}
1463bc2b7dabSGregor Boirie 
1464971ddd4bSAndy Shevchenko 	return sysfs_emit(buf, "%s\n", clock_names[clk]);
1465bc2b7dabSGregor Boirie }
1466bc2b7dabSGregor Boirie 
current_timestamp_clock_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t len)14679cf0b618SJoe Simmons-Talbott static ssize_t current_timestamp_clock_store(struct device *dev,
1468bc2b7dabSGregor Boirie 					     struct device_attribute *attr,
1469bc2b7dabSGregor Boirie 					     const char *buf, size_t len)
1470bc2b7dabSGregor Boirie {
1471bc2b7dabSGregor Boirie 	clockid_t clk;
1472bc2b7dabSGregor Boirie 	int ret;
1473bc2b7dabSGregor Boirie 
1474971ddd4bSAndy Shevchenko 	ret = sysfs_match_string(clock_names, buf);
1475971ddd4bSAndy Shevchenko 	if (ret < 0)
1476971ddd4bSAndy Shevchenko 		return ret;
1477971ddd4bSAndy Shevchenko 	clk = ret;
1478971ddd4bSAndy Shevchenko 
1479971ddd4bSAndy Shevchenko 	switch (clk) {
1480971ddd4bSAndy Shevchenko 	case CLOCK_REALTIME:
1481971ddd4bSAndy Shevchenko 	case CLOCK_MONOTONIC:
1482971ddd4bSAndy Shevchenko 	case CLOCK_MONOTONIC_RAW:
1483971ddd4bSAndy Shevchenko 	case CLOCK_REALTIME_COARSE:
1484971ddd4bSAndy Shevchenko 	case CLOCK_MONOTONIC_COARSE:
1485971ddd4bSAndy Shevchenko 	case CLOCK_BOOTTIME:
1486971ddd4bSAndy Shevchenko 	case CLOCK_TAI:
1487971ddd4bSAndy Shevchenko 		break;
1488971ddd4bSAndy Shevchenko 	default:
1489bc2b7dabSGregor Boirie 		return -EINVAL;
1490971ddd4bSAndy Shevchenko 	}
1491bc2b7dabSGregor Boirie 
1492bc2b7dabSGregor Boirie 	ret = iio_device_set_clock(dev_to_iio_dev(dev), clk);
1493bc2b7dabSGregor Boirie 	if (ret)
1494bc2b7dabSGregor Boirie 		return ret;
1495bc2b7dabSGregor Boirie 
1496bc2b7dabSGregor Boirie 	return len;
1497bc2b7dabSGregor Boirie }
1498bc2b7dabSGregor Boirie 
iio_device_register_sysfs_group(struct iio_dev * indio_dev,const struct attribute_group * group)149932f17172SAlexandru Ardelean int iio_device_register_sysfs_group(struct iio_dev *indio_dev,
150032f17172SAlexandru Ardelean 				    const struct attribute_group *group)
150132f17172SAlexandru Ardelean {
150232f17172SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
150332f17172SAlexandru Ardelean 	const struct attribute_group **new, **old = iio_dev_opaque->groups;
150432f17172SAlexandru Ardelean 	unsigned int cnt = iio_dev_opaque->groupcounter;
150532f17172SAlexandru Ardelean 
15065a0821e0SAndy Shevchenko 	new = krealloc_array(old, cnt + 2, sizeof(*new), GFP_KERNEL);
150732f17172SAlexandru Ardelean 	if (!new)
150832f17172SAlexandru Ardelean 		return -ENOMEM;
150932f17172SAlexandru Ardelean 
151032f17172SAlexandru Ardelean 	new[iio_dev_opaque->groupcounter++] = group;
151132f17172SAlexandru Ardelean 	new[iio_dev_opaque->groupcounter] = NULL;
151232f17172SAlexandru Ardelean 
151332f17172SAlexandru Ardelean 	iio_dev_opaque->groups = new;
151432f17172SAlexandru Ardelean 
151532f17172SAlexandru Ardelean 	return 0;
151632f17172SAlexandru Ardelean }
151732f17172SAlexandru Ardelean 
15189cf0b618SJoe Simmons-Talbott static DEVICE_ATTR_RW(current_timestamp_clock);
1519bc2b7dabSGregor Boirie 
iio_device_register_sysfs(struct iio_dev * indio_dev)1520a980e046SJonathan Cameron static int iio_device_register_sysfs(struct iio_dev *indio_dev)
1521a980e046SJonathan Cameron {
1522207c2d27SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
1523a980e046SJonathan Cameron 	int i, ret = 0, attrcount, attrn, attrcount_orig = 0;
152484088ebdSLars-Peter Clausen 	struct iio_dev_attr *p;
1525bc2b7dabSGregor Boirie 	struct attribute **attr, *clk = NULL;
1526a980e046SJonathan Cameron 
1527a980e046SJonathan Cameron 	/* First count elements in any existing group */
1528a980e046SJonathan Cameron 	if (indio_dev->info->attrs) {
1529a980e046SJonathan Cameron 		attr = indio_dev->info->attrs->attrs;
1530a980e046SJonathan Cameron 		while (*attr++ != NULL)
1531a980e046SJonathan Cameron 			attrcount_orig++;
1532a980e046SJonathan Cameron 	}
1533a980e046SJonathan Cameron 	attrcount = attrcount_orig;
1534a980e046SJonathan Cameron 	/*
1535a980e046SJonathan Cameron 	 * New channel registration method - relies on the fact a group does
1536d25b3808SPeter Meerwald 	 * not need to be initialized if its name is NULL.
1537a980e046SJonathan Cameron 	 */
1538a980e046SJonathan Cameron 	if (indio_dev->channels)
1539a980e046SJonathan Cameron 		for (i = 0; i < indio_dev->num_channels; i++) {
1540bc2b7dabSGregor Boirie 			const struct iio_chan_spec *chan =
1541bc2b7dabSGregor Boirie 				&indio_dev->channels[i];
1542bc2b7dabSGregor Boirie 
1543bc2b7dabSGregor Boirie 			if (chan->type == IIO_TIMESTAMP)
1544bc2b7dabSGregor Boirie 				clk = &dev_attr_current_timestamp_clock.attr;
1545bc2b7dabSGregor Boirie 
1546bc2b7dabSGregor Boirie 			ret = iio_device_add_channel_sysfs(indio_dev, chan);
1547a980e046SJonathan Cameron 			if (ret < 0)
1548a980e046SJonathan Cameron 				goto error_clear_attrs;
1549a980e046SJonathan Cameron 			attrcount += ret;
1550a980e046SJonathan Cameron 		}
1551a980e046SJonathan Cameron 
1552fa83c3baSAlexandru Ardelean 	if (iio_dev_opaque->event_interface)
1553bc2b7dabSGregor Boirie 		clk = &dev_attr_current_timestamp_clock.attr;
1554bc2b7dabSGregor Boirie 
1555a980e046SJonathan Cameron 	if (indio_dev->name)
1556a980e046SJonathan Cameron 		attrcount++;
15572c3d0c9fSPhil Reid 	if (indio_dev->label)
15582c3d0c9fSPhil Reid 		attrcount++;
1559bc2b7dabSGregor Boirie 	if (clk)
1560bc2b7dabSGregor Boirie 		attrcount++;
1561a980e046SJonathan Cameron 
1562207c2d27SAlexandru Ardelean 	iio_dev_opaque->chan_attr_group.attrs =
1563207c2d27SAlexandru Ardelean 		kcalloc(attrcount + 1,
1564207c2d27SAlexandru Ardelean 			sizeof(iio_dev_opaque->chan_attr_group.attrs[0]),
1565a980e046SJonathan Cameron 			GFP_KERNEL);
1566207c2d27SAlexandru Ardelean 	if (iio_dev_opaque->chan_attr_group.attrs == NULL) {
1567a980e046SJonathan Cameron 		ret = -ENOMEM;
1568a980e046SJonathan Cameron 		goto error_clear_attrs;
1569a980e046SJonathan Cameron 	}
1570e0d27ea3SAndrea Merello 	/* Copy across original attributes, and point to original binary attributes */
157118b4c9cdSHans de Goede 	if (indio_dev->info->attrs) {
1572207c2d27SAlexandru Ardelean 		memcpy(iio_dev_opaque->chan_attr_group.attrs,
1573a980e046SJonathan Cameron 		       indio_dev->info->attrs->attrs,
1574207c2d27SAlexandru Ardelean 		       sizeof(iio_dev_opaque->chan_attr_group.attrs[0])
1575a980e046SJonathan Cameron 		       *attrcount_orig);
157618b4c9cdSHans de Goede 		iio_dev_opaque->chan_attr_group.is_visible =
157718b4c9cdSHans de Goede 			indio_dev->info->attrs->is_visible;
1578e0d27ea3SAndrea Merello 		iio_dev_opaque->chan_attr_group.bin_attrs =
1579e0d27ea3SAndrea Merello 			indio_dev->info->attrs->bin_attrs;
158018b4c9cdSHans de Goede 	}
1581a980e046SJonathan Cameron 	attrn = attrcount_orig;
1582a980e046SJonathan Cameron 	/* Add all elements from the list. */
1583207c2d27SAlexandru Ardelean 	list_for_each_entry(p, &iio_dev_opaque->channel_attr_list, l)
1584207c2d27SAlexandru Ardelean 		iio_dev_opaque->chan_attr_group.attrs[attrn++] = &p->dev_attr.attr;
1585a980e046SJonathan Cameron 	if (indio_dev->name)
1586207c2d27SAlexandru Ardelean 		iio_dev_opaque->chan_attr_group.attrs[attrn++] = &dev_attr_name.attr;
15872c3d0c9fSPhil Reid 	if (indio_dev->label)
1588207c2d27SAlexandru Ardelean 		iio_dev_opaque->chan_attr_group.attrs[attrn++] = &dev_attr_label.attr;
1589bc2b7dabSGregor Boirie 	if (clk)
1590207c2d27SAlexandru Ardelean 		iio_dev_opaque->chan_attr_group.attrs[attrn++] = clk;
1591a980e046SJonathan Cameron 
159232f17172SAlexandru Ardelean 	ret = iio_device_register_sysfs_group(indio_dev,
159332f17172SAlexandru Ardelean 					      &iio_dev_opaque->chan_attr_group);
159432f17172SAlexandru Ardelean 	if (ret)
159595a0d596SDinghao Liu 		goto error_free_chan_attrs;
1596a980e046SJonathan Cameron 
1597a980e046SJonathan Cameron 	return 0;
1598a980e046SJonathan Cameron 
159995a0d596SDinghao Liu error_free_chan_attrs:
160095a0d596SDinghao Liu 	kfree(iio_dev_opaque->chan_attr_group.attrs);
160195a0d596SDinghao Liu 	iio_dev_opaque->chan_attr_group.attrs = NULL;
1602a980e046SJonathan Cameron error_clear_attrs:
1603207c2d27SAlexandru Ardelean 	iio_free_chan_devattr_list(&iio_dev_opaque->channel_attr_list);
1604a980e046SJonathan Cameron 
1605a980e046SJonathan Cameron 	return ret;
1606a980e046SJonathan Cameron }
1607a980e046SJonathan Cameron 
iio_device_unregister_sysfs(struct iio_dev * indio_dev)1608a980e046SJonathan Cameron static void iio_device_unregister_sysfs(struct iio_dev *indio_dev)
1609a980e046SJonathan Cameron {
1610207c2d27SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
1611a980e046SJonathan Cameron 
1612207c2d27SAlexandru Ardelean 	iio_free_chan_devattr_list(&iio_dev_opaque->channel_attr_list);
1613207c2d27SAlexandru Ardelean 	kfree(iio_dev_opaque->chan_attr_group.attrs);
1614207c2d27SAlexandru Ardelean 	iio_dev_opaque->chan_attr_group.attrs = NULL;
161532f17172SAlexandru Ardelean 	kfree(iio_dev_opaque->groups);
161619833c40SYang Yingliang 	iio_dev_opaque->groups = NULL;
1617a980e046SJonathan Cameron }
1618a980e046SJonathan Cameron 
iio_dev_release(struct device * device)1619a980e046SJonathan Cameron static void iio_dev_release(struct device *device)
1620a980e046SJonathan Cameron {
1621e53f5ac5SLars-Peter Clausen 	struct iio_dev *indio_dev = dev_to_iio_dev(device);
16226d4ebd56SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
16236d4ebd56SAlexandru Ardelean 
1624d89e119aSBenjamin Gaignard 	if (indio_dev->modes & INDIO_ALL_TRIGGERED_MODES)
1625a980e046SJonathan Cameron 		iio_device_unregister_trigger_consumer(indio_dev);
1626a980e046SJonathan Cameron 	iio_device_unregister_eventset(indio_dev);
1627a980e046SJonathan Cameron 	iio_device_unregister_sysfs(indio_dev);
1628e407fd65SLars-Peter Clausen 
1629218bc53dSAlexandru Ardelean 	iio_device_detach_buffers(indio_dev);
16309e69c935SLars-Peter Clausen 
16312bc9cd66SVincent Whitchurch 	lockdep_unregister_key(&iio_dev_opaque->mlock_key);
16322bc9cd66SVincent Whitchurch 
1633319dbcd8Skeliu 	ida_free(&iio_ida, iio_dev_opaque->id);
16346d4ebd56SAlexandru Ardelean 	kfree(iio_dev_opaque);
1635a980e046SJonathan Cameron }
1636a980e046SJonathan Cameron 
16373c33b7b8SLars-Peter Clausen const struct device_type iio_device_type = {
1638a980e046SJonathan Cameron 	.name = "iio_device",
1639a980e046SJonathan Cameron 	.release = iio_dev_release,
1640a980e046SJonathan Cameron };
1641a980e046SJonathan Cameron 
1642a7e57dceSSachin Kamat /**
1643a7e57dceSSachin Kamat  * iio_device_alloc() - allocate an iio_dev from a driver
1644c9561fd2SJonathan Cameron  * @parent:		Parent device.
1645a7e57dceSSachin Kamat  * @sizeof_priv:	Space to allocate for private structure.
164665659a8dSAndy Shevchenko  *
164765659a8dSAndy Shevchenko  * Returns:
164865659a8dSAndy Shevchenko  * Pointer to allocated iio_dev on success, NULL on failure.
164965659a8dSAndy Shevchenko  */
iio_device_alloc(struct device * parent,int sizeof_priv)165078289b4aSAlexandru Ardelean struct iio_dev *iio_device_alloc(struct device *parent, int sizeof_priv)
1651a980e046SJonathan Cameron {
16526d4ebd56SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque;
16530d596bb2SAlexandru Ardelean 	struct iio_dev *indio_dev;
1654a980e046SJonathan Cameron 	size_t alloc_size;
1655a980e046SJonathan Cameron 
16565c4e4115SAndy Shevchenko 	if (sizeof_priv)
16575c4e4115SAndy Shevchenko 		alloc_size = ALIGN(sizeof(*iio_dev_opaque), IIO_DMA_MINALIGN) + sizeof_priv;
16585c4e4115SAndy Shevchenko 	else
16595c4e4115SAndy Shevchenko 		alloc_size = sizeof(*iio_dev_opaque);
1660a980e046SJonathan Cameron 
16616d4ebd56SAlexandru Ardelean 	iio_dev_opaque = kzalloc(alloc_size, GFP_KERNEL);
16626d4ebd56SAlexandru Ardelean 	if (!iio_dev_opaque)
16630d4b2184SJonathan Cameron 		return NULL;
1664a980e046SJonathan Cameron 
16650d596bb2SAlexandru Ardelean 	indio_dev = &iio_dev_opaque->indio_dev;
1666f0245ab3SAndy Shevchenko 
1667f0245ab3SAndy Shevchenko 	if (sizeof_priv)
16680d596bb2SAlexandru Ardelean 		indio_dev->priv = (char *)iio_dev_opaque +
1669f0245ab3SAndy Shevchenko 			ALIGN(sizeof(*iio_dev_opaque), IIO_DMA_MINALIGN);
16706d4ebd56SAlexandru Ardelean 
16710d596bb2SAlexandru Ardelean 	indio_dev->dev.parent = parent;
16720d596bb2SAlexandru Ardelean 	indio_dev->dev.type = &iio_device_type;
16730d596bb2SAlexandru Ardelean 	indio_dev->dev.bus = &iio_bus_type;
16740d596bb2SAlexandru Ardelean 	device_initialize(&indio_dev->dev);
167516afe125SNuno Sá 	mutex_init(&iio_dev_opaque->mlock);
1676b804e2b7SJonathan Cameron 	mutex_init(&iio_dev_opaque->info_exist_lock);
1677207c2d27SAlexandru Ardelean 	INIT_LIST_HEAD(&iio_dev_opaque->channel_attr_list);
1678a980e046SJonathan Cameron 
1679319dbcd8Skeliu 	iio_dev_opaque->id = ida_alloc(&iio_ida, GFP_KERNEL);
168015ea2878SJonathan Cameron 	if (iio_dev_opaque->id < 0) {
1681a980e046SJonathan Cameron 		/* cannot use a dev_err as the name isn't available */
16823176dd5dSSachin Kamat 		pr_err("failed to get device id\n");
16836d4ebd56SAlexandru Ardelean 		kfree(iio_dev_opaque);
1684a980e046SJonathan Cameron 		return NULL;
1685a980e046SJonathan Cameron 	}
1686fe6f45f6SYang Yingliang 
1687fe6f45f6SYang Yingliang 	if (dev_set_name(&indio_dev->dev, "iio:device%d", iio_dev_opaque->id)) {
1688319dbcd8Skeliu 		ida_free(&iio_ida, iio_dev_opaque->id);
1689fe6f45f6SYang Yingliang 		kfree(iio_dev_opaque);
1690fe6f45f6SYang Yingliang 		return NULL;
1691fe6f45f6SYang Yingliang 	}
1692fe6f45f6SYang Yingliang 
16936a8c6b26SAlexandru Ardelean 	INIT_LIST_HEAD(&iio_dev_opaque->buffer_list);
16948dedcc3eSAlexandru Ardelean 	INIT_LIST_HEAD(&iio_dev_opaque->ioctl_handlers);
1695a980e046SJonathan Cameron 
16962bc9cd66SVincent Whitchurch 	lockdep_register_key(&iio_dev_opaque->mlock_key);
169716afe125SNuno Sá 	lockdep_set_class(&iio_dev_opaque->mlock, &iio_dev_opaque->mlock_key);
16982bc9cd66SVincent Whitchurch 
16990d596bb2SAlexandru Ardelean 	return indio_dev;
1700a980e046SJonathan Cameron }
17017cbb7537SLars-Peter Clausen EXPORT_SYMBOL(iio_device_alloc);
1702a980e046SJonathan Cameron 
1703a7e57dceSSachin Kamat /**
1704a7e57dceSSachin Kamat  * iio_device_free() - free an iio_dev from a driver
1705a7e57dceSSachin Kamat  * @dev:		the iio_dev associated with the device
170665659a8dSAndy Shevchenko  */
iio_device_free(struct iio_dev * dev)17077cbb7537SLars-Peter Clausen void iio_device_free(struct iio_dev *dev)
1708a980e046SJonathan Cameron {
1709e407fd65SLars-Peter Clausen 	if (dev)
1710e407fd65SLars-Peter Clausen 		put_device(&dev->dev);
1711a980e046SJonathan Cameron }
17127cbb7537SLars-Peter Clausen EXPORT_SYMBOL(iio_device_free);
1713a980e046SJonathan Cameron 
devm_iio_device_release(void * iio_dev)1714cf5724e9SYicong Yang static void devm_iio_device_release(void *iio_dev)
17159dabaf5eSGrygorii Strashko {
1716cf5724e9SYicong Yang 	iio_device_free(iio_dev);
17179dabaf5eSGrygorii Strashko }
17189dabaf5eSGrygorii Strashko 
1719a7e57dceSSachin Kamat /**
1720a7e57dceSSachin Kamat  * devm_iio_device_alloc - Resource-managed iio_device_alloc()
172178289b4aSAlexandru Ardelean  * @parent:		Device to allocate iio_dev for, and parent for this IIO device
1722a7e57dceSSachin Kamat  * @sizeof_priv:	Space to allocate for private structure.
1723a7e57dceSSachin Kamat  *
1724a7e57dceSSachin Kamat  * Managed iio_device_alloc. iio_dev allocated with this function is
1725a7e57dceSSachin Kamat  * automatically freed on driver detach.
1726a7e57dceSSachin Kamat  *
172765659a8dSAndy Shevchenko  * Returns:
1728a7e57dceSSachin Kamat  * Pointer to allocated iio_dev on success, NULL on failure.
1729a7e57dceSSachin Kamat  */
devm_iio_device_alloc(struct device * parent,int sizeof_priv)173078289b4aSAlexandru Ardelean struct iio_dev *devm_iio_device_alloc(struct device *parent, int sizeof_priv)
17319dabaf5eSGrygorii Strashko {
1732cf5724e9SYicong Yang 	struct iio_dev *iio_dev;
1733cf5724e9SYicong Yang 	int ret;
17349dabaf5eSGrygorii Strashko 
173578289b4aSAlexandru Ardelean 	iio_dev = iio_device_alloc(parent, sizeof_priv);
1736cf5724e9SYicong Yang 	if (!iio_dev)
1737cf5724e9SYicong Yang 		return NULL;
1738cf5724e9SYicong Yang 
1739cf5724e9SYicong Yang 	ret = devm_add_action_or_reset(parent, devm_iio_device_release,
1740cf5724e9SYicong Yang 				       iio_dev);
1741cf5724e9SYicong Yang 	if (ret)
174243fa7394SDan Carpenter 		return NULL;
17439dabaf5eSGrygorii Strashko 
17449dabaf5eSGrygorii Strashko 	return iio_dev;
17459dabaf5eSGrygorii Strashko }
17469dabaf5eSGrygorii Strashko EXPORT_SYMBOL_GPL(devm_iio_device_alloc);
17479dabaf5eSGrygorii Strashko 
1748a7e57dceSSachin Kamat /**
1749a980e046SJonathan Cameron  * iio_chrdev_open() - chrdev file open for buffer access and ioctls
17502498dcf6SCristina Opriceana  * @inode:	Inode structure for identifying the device in the file system
17512498dcf6SCristina Opriceana  * @filp:	File structure for iio device used to keep and later access
17522498dcf6SCristina Opriceana  *		private data
17532498dcf6SCristina Opriceana  *
175465659a8dSAndy Shevchenko  * Returns: 0 on success or -EBUSY if the device is already opened
175565659a8dSAndy Shevchenko  */
iio_chrdev_open(struct inode * inode,struct file * filp)1756a980e046SJonathan Cameron static int iio_chrdev_open(struct inode *inode, struct file *filp)
1757a980e046SJonathan Cameron {
1758396f7234SJonathan Cameron 	struct iio_dev_opaque *iio_dev_opaque =
1759396f7234SJonathan Cameron 		container_of(inode->i_cdev, struct iio_dev_opaque, chrdev);
1760396f7234SJonathan Cameron 	struct iio_dev *indio_dev = &iio_dev_opaque->indio_dev;
1761be24dcb1SAlexandru Ardelean 	struct iio_dev_buffer_pair *ib;
1762a980e046SJonathan Cameron 
17638b1c82cbSJonathan Cameron 	if (test_and_set_bit(IIO_BUSY_BIT_POS, &iio_dev_opaque->flags))
1764a980e046SJonathan Cameron 		return -EBUSY;
1765a980e046SJonathan Cameron 
1766cadc2125SLars-Peter Clausen 	iio_device_get(indio_dev);
1767cadc2125SLars-Peter Clausen 
1768be24dcb1SAlexandru Ardelean 	ib = kmalloc(sizeof(*ib), GFP_KERNEL);
1769be24dcb1SAlexandru Ardelean 	if (!ib) {
1770be24dcb1SAlexandru Ardelean 		iio_device_put(indio_dev);
17718b1c82cbSJonathan Cameron 		clear_bit(IIO_BUSY_BIT_POS, &iio_dev_opaque->flags);
1772be24dcb1SAlexandru Ardelean 		return -ENOMEM;
1773be24dcb1SAlexandru Ardelean 	}
1774be24dcb1SAlexandru Ardelean 
1775be24dcb1SAlexandru Ardelean 	ib->indio_dev = indio_dev;
1776be24dcb1SAlexandru Ardelean 	ib->buffer = indio_dev->buffer;
1777be24dcb1SAlexandru Ardelean 
1778be24dcb1SAlexandru Ardelean 	filp->private_data = ib;
1779a980e046SJonathan Cameron 
1780a980e046SJonathan Cameron 	return 0;
1781a980e046SJonathan Cameron }
1782a980e046SJonathan Cameron 
1783a980e046SJonathan Cameron /**
1784a980e046SJonathan Cameron  * iio_chrdev_release() - chrdev file close buffer access and ioctls
17852498dcf6SCristina Opriceana  * @inode:	Inode structure pointer for the char device
17862498dcf6SCristina Opriceana  * @filp:	File structure pointer for the char device
17872498dcf6SCristina Opriceana  *
178865659a8dSAndy Shevchenko  * Returns: 0 for successful release.
17892498dcf6SCristina Opriceana  */
iio_chrdev_release(struct inode * inode,struct file * filp)1790a980e046SJonathan Cameron static int iio_chrdev_release(struct inode *inode, struct file *filp)
1791a980e046SJonathan Cameron {
1792be24dcb1SAlexandru Ardelean 	struct iio_dev_buffer_pair *ib = filp->private_data;
1793396f7234SJonathan Cameron 	struct iio_dev_opaque *iio_dev_opaque =
1794396f7234SJonathan Cameron 		container_of(inode->i_cdev, struct iio_dev_opaque, chrdev);
1795396f7234SJonathan Cameron 	struct iio_dev *indio_dev = &iio_dev_opaque->indio_dev;
17969d9ec8d0SJoe Simmons-Talbott 
1797be24dcb1SAlexandru Ardelean 	kfree(ib);
17988b1c82cbSJonathan Cameron 	clear_bit(IIO_BUSY_BIT_POS, &iio_dev_opaque->flags);
1799cadc2125SLars-Peter Clausen 	iio_device_put(indio_dev);
1800cadc2125SLars-Peter Clausen 
1801a980e046SJonathan Cameron 	return 0;
1802a980e046SJonathan Cameron }
1803a980e046SJonathan Cameron 
iio_device_ioctl_handler_register(struct iio_dev * indio_dev,struct iio_ioctl_handler * h)18048dedcc3eSAlexandru Ardelean void iio_device_ioctl_handler_register(struct iio_dev *indio_dev,
18058dedcc3eSAlexandru Ardelean 				       struct iio_ioctl_handler *h)
18068dedcc3eSAlexandru Ardelean {
18078dedcc3eSAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
18088dedcc3eSAlexandru Ardelean 
18098dedcc3eSAlexandru Ardelean 	list_add_tail(&h->entry, &iio_dev_opaque->ioctl_handlers);
18108dedcc3eSAlexandru Ardelean }
18118dedcc3eSAlexandru Ardelean 
iio_device_ioctl_handler_unregister(struct iio_ioctl_handler * h)18128dedcc3eSAlexandru Ardelean void iio_device_ioctl_handler_unregister(struct iio_ioctl_handler *h)
18138dedcc3eSAlexandru Ardelean {
18148dedcc3eSAlexandru Ardelean 	list_del(&h->entry);
18158dedcc3eSAlexandru Ardelean }
18168dedcc3eSAlexandru Ardelean 
iio_ioctl(struct file * filp,unsigned int cmd,unsigned long arg)1817a980e046SJonathan Cameron static long iio_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
1818a980e046SJonathan Cameron {
1819be24dcb1SAlexandru Ardelean 	struct iio_dev_buffer_pair *ib = filp->private_data;
1820be24dcb1SAlexandru Ardelean 	struct iio_dev *indio_dev = ib->indio_dev;
18218dedcc3eSAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
18228dedcc3eSAlexandru Ardelean 	struct iio_ioctl_handler *h;
182342ea5992SNuno Sa 	int ret;
1824a980e046SJonathan Cameron 
182542ea5992SNuno Sa 	guard(mutex)(&iio_dev_opaque->info_exist_lock);
182665659a8dSAndy Shevchenko 	/*
18278dedcc3eSAlexandru Ardelean 	 * The NULL check here is required to prevent crashing when a device
18288dedcc3eSAlexandru Ardelean 	 * is being removed while userspace would still have open file handles
18298dedcc3eSAlexandru Ardelean 	 * to try to access this device.
18308dedcc3eSAlexandru Ardelean 	 */
1831f18e7a06SLars-Peter Clausen 	if (!indio_dev->info)
183242ea5992SNuno Sa 		return -ENODEV;
1833f18e7a06SLars-Peter Clausen 
18348dedcc3eSAlexandru Ardelean 	list_for_each_entry(h, &iio_dev_opaque->ioctl_handlers, entry) {
18358dedcc3eSAlexandru Ardelean 		ret = h->ioctl(indio_dev, filp, cmd, arg);
18368dedcc3eSAlexandru Ardelean 		if (ret != IIO_IOCTL_UNHANDLED)
183742ea5992SNuno Sa 			return ret;
1838a980e046SJonathan Cameron 	}
18398dedcc3eSAlexandru Ardelean 
184042ea5992SNuno Sa 	return -ENODEV;
1841a980e046SJonathan Cameron }
1842a980e046SJonathan Cameron 
1843a980e046SJonathan Cameron static const struct file_operations iio_buffer_fileops = {
1844a980e046SJonathan Cameron 	.owner = THIS_MODULE,
1845a980e046SJonathan Cameron 	.llseek = noop_llseek,
1846ee8caea0SAlexandru Ardelean 	.read = iio_buffer_read_outer_addr,
18479eeee3b0SMihail Chindris 	.write = iio_buffer_write_outer_addr,
1848ee8caea0SAlexandru Ardelean 	.poll = iio_buffer_poll_addr,
1849a980e046SJonathan Cameron 	.unlocked_ioctl = iio_ioctl,
18501832f2d8SArnd Bergmann 	.compat_ioctl = compat_ptr_ioctl,
1851ee8caea0SAlexandru Ardelean 	.open = iio_chrdev_open,
1852ee8caea0SAlexandru Ardelean 	.release = iio_chrdev_release,
1853a980e046SJonathan Cameron };
1854a980e046SJonathan Cameron 
18558ebaa3ffSAlexandru Ardelean static const struct file_operations iio_event_fileops = {
18568ebaa3ffSAlexandru Ardelean 	.owner = THIS_MODULE,
18578ebaa3ffSAlexandru Ardelean 	.llseek = noop_llseek,
18588ebaa3ffSAlexandru Ardelean 	.unlocked_ioctl = iio_ioctl,
18598ebaa3ffSAlexandru Ardelean 	.compat_ioctl = compat_ptr_ioctl,
18608ebaa3ffSAlexandru Ardelean 	.open = iio_chrdev_open,
18618ebaa3ffSAlexandru Ardelean 	.release = iio_chrdev_release,
18628ebaa3ffSAlexandru Ardelean };
18638ebaa3ffSAlexandru Ardelean 
iio_check_unique_scan_index(struct iio_dev * indio_dev)18648f5d8727SVlad Dogaru static int iio_check_unique_scan_index(struct iio_dev *indio_dev)
18658f5d8727SVlad Dogaru {
18668f5d8727SVlad Dogaru 	int i, j;
18678f5d8727SVlad Dogaru 	const struct iio_chan_spec *channels = indio_dev->channels;
18688f5d8727SVlad Dogaru 
18698f5d8727SVlad Dogaru 	if (!(indio_dev->modes & INDIO_ALL_BUFFER_MODES))
18708f5d8727SVlad Dogaru 		return 0;
18718f5d8727SVlad Dogaru 
18728f5d8727SVlad Dogaru 	for (i = 0; i < indio_dev->num_channels - 1; i++) {
18738f5d8727SVlad Dogaru 		if (channels[i].scan_index < 0)
18748f5d8727SVlad Dogaru 			continue;
18758f5d8727SVlad Dogaru 		for (j = i + 1; j < indio_dev->num_channels; j++)
18768f5d8727SVlad Dogaru 			if (channels[i].scan_index == channels[j].scan_index) {
18778f5d8727SVlad Dogaru 				dev_err(&indio_dev->dev,
18788f5d8727SVlad Dogaru 					"Duplicate scan index %d\n",
18798f5d8727SVlad Dogaru 					channels[i].scan_index);
18808f5d8727SVlad Dogaru 				return -EINVAL;
18818f5d8727SVlad Dogaru 			}
18828f5d8727SVlad Dogaru 	}
18838f5d8727SVlad Dogaru 
18848f5d8727SVlad Dogaru 	return 0;
18858f5d8727SVlad Dogaru }
18868f5d8727SVlad Dogaru 
iio_check_extended_name(const struct iio_dev * indio_dev)18870e0761f8SPaul Cercueil static int iio_check_extended_name(const struct iio_dev *indio_dev)
18880e0761f8SPaul Cercueil {
18890e0761f8SPaul Cercueil 	unsigned int i;
18900e0761f8SPaul Cercueil 
18910e0761f8SPaul Cercueil 	if (!indio_dev->info->read_label)
18920e0761f8SPaul Cercueil 		return 0;
18930e0761f8SPaul Cercueil 
18940e0761f8SPaul Cercueil 	for (i = 0; i < indio_dev->num_channels; i++) {
18950e0761f8SPaul Cercueil 		if (indio_dev->channels[i].extend_name) {
18960e0761f8SPaul Cercueil 			dev_err(&indio_dev->dev,
18970e0761f8SPaul Cercueil 				"Cannot use labels and extend_name at the same time\n");
18980e0761f8SPaul Cercueil 			return -EINVAL;
18990e0761f8SPaul Cercueil 		}
19000e0761f8SPaul Cercueil 	}
19010e0761f8SPaul Cercueil 
19020e0761f8SPaul Cercueil 	return 0;
19030e0761f8SPaul Cercueil }
19040e0761f8SPaul Cercueil 
1905a980e046SJonathan Cameron static const struct iio_buffer_setup_ops noop_ring_setup_ops;
1906a980e046SJonathan Cameron 
iio_sanity_check_avail_scan_masks(struct iio_dev * indio_dev)19072718f154SMatti Vaittinen static void iio_sanity_check_avail_scan_masks(struct iio_dev *indio_dev)
19082718f154SMatti Vaittinen {
19092718f154SMatti Vaittinen 	unsigned int num_masks, masklength, longs_per_mask;
19102718f154SMatti Vaittinen 	const unsigned long *av_masks;
19112718f154SMatti Vaittinen 	int i;
19122718f154SMatti Vaittinen 
19132718f154SMatti Vaittinen 	av_masks = indio_dev->available_scan_masks;
1914c6c47852SNuno Sa 	masklength = iio_get_masklength(indio_dev);
19152718f154SMatti Vaittinen 	longs_per_mask = BITS_TO_LONGS(masklength);
19162718f154SMatti Vaittinen 
19172718f154SMatti Vaittinen 	/*
19182718f154SMatti Vaittinen 	 * The code determining how many available_scan_masks is in the array
19192718f154SMatti Vaittinen 	 * will be assuming the end of masks when first long with all bits
19202718f154SMatti Vaittinen 	 * zeroed is encountered. This is incorrect for masks where mask
19212718f154SMatti Vaittinen 	 * consists of more than one long, and where some of the available masks
19222718f154SMatti Vaittinen 	 * has long worth of bits zeroed (but has subsequent bit(s) set). This
19232718f154SMatti Vaittinen 	 * is a safety measure against bug where array of masks is terminated by
19242718f154SMatti Vaittinen 	 * a single zero while mask width is greater than width of a long.
19252718f154SMatti Vaittinen 	 */
19262718f154SMatti Vaittinen 	if (longs_per_mask > 1)
19272718f154SMatti Vaittinen 		dev_warn(indio_dev->dev.parent,
19282718f154SMatti Vaittinen 			 "multi long available scan masks not fully supported\n");
19292718f154SMatti Vaittinen 
19302718f154SMatti Vaittinen 	if (bitmap_empty(av_masks, masklength))
19312718f154SMatti Vaittinen 		dev_warn(indio_dev->dev.parent, "empty scan mask\n");
19322718f154SMatti Vaittinen 
19332718f154SMatti Vaittinen 	for (num_masks = 0; *av_masks; num_masks++)
19342718f154SMatti Vaittinen 		av_masks += longs_per_mask;
19352718f154SMatti Vaittinen 
19362718f154SMatti Vaittinen 	if (num_masks < 2)
19372718f154SMatti Vaittinen 		return;
19382718f154SMatti Vaittinen 
19392718f154SMatti Vaittinen 	av_masks = indio_dev->available_scan_masks;
19402718f154SMatti Vaittinen 
19412718f154SMatti Vaittinen 	/*
19422718f154SMatti Vaittinen 	 * Go through all the masks from first to one before the last, and see
19432718f154SMatti Vaittinen 	 * that no mask found later from the available_scan_masks array is a
19442718f154SMatti Vaittinen 	 * subset of mask found earlier. If this happens, then the mask found
19452718f154SMatti Vaittinen 	 * later will never get used because scanning the array is stopped when
19462718f154SMatti Vaittinen 	 * the first suitable mask is found. Drivers should order the array of
19472718f154SMatti Vaittinen 	 * available masks in the order of preference (presumably the least
19482718f154SMatti Vaittinen 	 * costy to access masks first).
19492718f154SMatti Vaittinen 	 */
19502718f154SMatti Vaittinen 	for (i = 0; i < num_masks - 1; i++) {
19512718f154SMatti Vaittinen 		const unsigned long *mask1;
19522718f154SMatti Vaittinen 		int j;
19532718f154SMatti Vaittinen 
19542718f154SMatti Vaittinen 		mask1 = av_masks + i * longs_per_mask;
19552718f154SMatti Vaittinen 		for (j = i + 1; j < num_masks; j++) {
19562718f154SMatti Vaittinen 			const unsigned long *mask2;
19572718f154SMatti Vaittinen 
19582718f154SMatti Vaittinen 			mask2 = av_masks + j * longs_per_mask;
19592718f154SMatti Vaittinen 			if (bitmap_subset(mask2, mask1, masklength))
19602718f154SMatti Vaittinen 				dev_warn(indio_dev->dev.parent,
19612718f154SMatti Vaittinen 					 "available_scan_mask %d subset of %d. Never used\n",
19622718f154SMatti Vaittinen 					 j, i);
19632718f154SMatti Vaittinen 		}
19642718f154SMatti Vaittinen 	}
19652718f154SMatti Vaittinen }
19662718f154SMatti Vaittinen 
1967d092b686SJulien Stephan /**
1968d092b686SJulien Stephan  * iio_active_scan_mask_index - Get index of the active scan mask inside the
1969d092b686SJulien Stephan  * available scan masks array
1970d092b686SJulien Stephan  * @indio_dev: the IIO device containing the active and available scan masks
1971d092b686SJulien Stephan  *
1972d092b686SJulien Stephan  * Returns: the index or -EINVAL if  active_scan_mask is not set
1973d092b686SJulien Stephan  */
iio_active_scan_mask_index(struct iio_dev * indio_dev)1974d092b686SJulien Stephan int iio_active_scan_mask_index(struct iio_dev *indio_dev)
1975d092b686SJulien Stephan 
1976d092b686SJulien Stephan {
1977d092b686SJulien Stephan 	const unsigned long *av_masks;
1978d092b686SJulien Stephan 	unsigned int masklength = iio_get_masklength(indio_dev);
1979d092b686SJulien Stephan 	int i = 0;
1980d092b686SJulien Stephan 
1981d092b686SJulien Stephan 	if (!indio_dev->active_scan_mask)
1982d092b686SJulien Stephan 		return -EINVAL;
1983d092b686SJulien Stephan 
1984d092b686SJulien Stephan 	/*
1985d092b686SJulien Stephan 	 * As in iio_scan_mask_match and iio_sanity_check_avail_scan_masks,
1986d092b686SJulien Stephan 	 * the condition here do not handle multi-long masks correctly.
1987d092b686SJulien Stephan 	 * It only checks the first long to be zero, and will use such mask
1988d092b686SJulien Stephan 	 * as a terminator even if there was bits set after the first long.
1989d092b686SJulien Stephan 	 *
1990d092b686SJulien Stephan 	 * This should be fine since the available_scan_mask has already been
1991d092b686SJulien Stephan 	 * sanity tested using iio_sanity_check_avail_scan_masks.
1992d092b686SJulien Stephan 	 *
1993d092b686SJulien Stephan 	 * See iio_scan_mask_match and iio_sanity_check_avail_scan_masks for
1994d092b686SJulien Stephan 	 * more details
1995d092b686SJulien Stephan 	 */
1996d092b686SJulien Stephan 	av_masks = indio_dev->available_scan_masks;
1997d092b686SJulien Stephan 	while (*av_masks) {
1998d092b686SJulien Stephan 		if (indio_dev->active_scan_mask == av_masks)
1999d092b686SJulien Stephan 			return i;
2000d092b686SJulien Stephan 		av_masks += BITS_TO_LONGS(masklength);
2001d092b686SJulien Stephan 		i++;
2002d092b686SJulien Stephan 	}
2003d092b686SJulien Stephan 
2004d092b686SJulien Stephan 	dev_warn(indio_dev->dev.parent,
2005*f2271ba6SColin Ian King 		 "active scan mask is not part of the available scan masks\n");
2006d092b686SJulien Stephan 	return -EINVAL;
2007d092b686SJulien Stephan }
2008d092b686SJulien Stephan EXPORT_SYMBOL_GPL(iio_active_scan_mask_index);
2009d092b686SJulien Stephan 
__iio_device_register(struct iio_dev * indio_dev,struct module * this_mod)201063b19547SJonathan Cameron int __iio_device_register(struct iio_dev *indio_dev, struct module *this_mod)
2011a980e046SJonathan Cameron {
20128ebaa3ffSAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
2013b2a69969SMilan Zamazal 	struct fwnode_handle *fwnode = NULL;
2014a980e046SJonathan Cameron 	int ret;
2015a980e046SJonathan Cameron 
2016a17cb784SAlexandru Ardelean 	if (!indio_dev->info)
2017a17cb784SAlexandru Ardelean 		return -EINVAL;
2018a17cb784SAlexandru Ardelean 
20196eaf9f6aSJonathan Cameron 	iio_dev_opaque->driver_module = this_mod;
202017d82b47SGuenter Roeck 
202181366556SAndy Shevchenko 	/* If the calling driver did not initialize firmware node, do it here */
202281366556SAndy Shevchenko 	if (dev_fwnode(&indio_dev->dev))
202381366556SAndy Shevchenko 		fwnode = dev_fwnode(&indio_dev->dev);
2024b2a69969SMilan Zamazal 	/* The default dummy IIO device has no parent */
2025b2a69969SMilan Zamazal 	else if (indio_dev->dev.parent)
202681366556SAndy Shevchenko 		fwnode = dev_fwnode(indio_dev->dev.parent);
202781366556SAndy Shevchenko 	device_set_node(&indio_dev->dev, fwnode);
202881366556SAndy Shevchenko 
202981366556SAndy Shevchenko 	fwnode_property_read_string(fwnode, "label", &indio_dev->label);
20302c3d0c9fSPhil Reid 
20318f5d8727SVlad Dogaru 	ret = iio_check_unique_scan_index(indio_dev);
20328f5d8727SVlad Dogaru 	if (ret < 0)
20338f5d8727SVlad Dogaru 		return ret;
20348f5d8727SVlad Dogaru 
20350e0761f8SPaul Cercueil 	ret = iio_check_extended_name(indio_dev);
20360e0761f8SPaul Cercueil 	if (ret < 0)
20370e0761f8SPaul Cercueil 		return ret;
20380e0761f8SPaul Cercueil 
20398915aacaSGreg Kroah-Hartman 	iio_device_register_debugfs(indio_dev);
20403e1b6c95SLars-Peter Clausen 
2041ee708e6bSAlexandru Ardelean 	ret = iio_buffers_alloc_sysfs_and_mask(indio_dev);
20423e1b6c95SLars-Peter Clausen 	if (ret) {
20433e1b6c95SLars-Peter Clausen 		dev_err(indio_dev->dev.parent,
20443e1b6c95SLars-Peter Clausen 			"Failed to create buffer sysfs interfaces\n");
20453e1b6c95SLars-Peter Clausen 		goto error_unreg_debugfs;
20463e1b6c95SLars-Peter Clausen 	}
20473e1b6c95SLars-Peter Clausen 
20482718f154SMatti Vaittinen 	if (indio_dev->available_scan_masks)
20492718f154SMatti Vaittinen 		iio_sanity_check_avail_scan_masks(indio_dev);
20502718f154SMatti Vaittinen 
2051a980e046SJonathan Cameron 	ret = iio_device_register_sysfs(indio_dev);
2052a980e046SJonathan Cameron 	if (ret) {
2053a980e046SJonathan Cameron 		dev_err(indio_dev->dev.parent,
2054a980e046SJonathan Cameron 			"Failed to register sysfs interfaces\n");
20553e1b6c95SLars-Peter Clausen 		goto error_buffer_free_sysfs;
2056a980e046SJonathan Cameron 	}
2057a980e046SJonathan Cameron 	ret = iio_device_register_eventset(indio_dev);
2058a980e046SJonathan Cameron 	if (ret) {
2059a980e046SJonathan Cameron 		dev_err(indio_dev->dev.parent,
2060a980e046SJonathan Cameron 			"Failed to register event set\n");
2061a980e046SJonathan Cameron 		goto error_free_sysfs;
2062a980e046SJonathan Cameron 	}
2063d89e119aSBenjamin Gaignard 	if (indio_dev->modes & INDIO_ALL_TRIGGERED_MODES)
2064a980e046SJonathan Cameron 		iio_device_register_trigger_consumer(indio_dev);
2065a980e046SJonathan Cameron 
2066a980e046SJonathan Cameron 	if ((indio_dev->modes & INDIO_ALL_BUFFER_MODES) &&
2067a980e046SJonathan Cameron 		indio_dev->setup_ops == NULL)
2068a980e046SJonathan Cameron 		indio_dev->setup_ops = &noop_ring_setup_ops;
2069a980e046SJonathan Cameron 
2070ee708e6bSAlexandru Ardelean 	if (iio_dev_opaque->attached_buffers_cnt)
2071396f7234SJonathan Cameron 		cdev_init(&iio_dev_opaque->chrdev, &iio_buffer_fileops);
20728ebaa3ffSAlexandru Ardelean 	else if (iio_dev_opaque->event_interface)
2073396f7234SJonathan Cameron 		cdev_init(&iio_dev_opaque->chrdev, &iio_event_fileops);
207463b19547SJonathan Cameron 
2075ee708e6bSAlexandru Ardelean 	if (iio_dev_opaque->attached_buffers_cnt || iio_dev_opaque->event_interface) {
207615ea2878SJonathan Cameron 		indio_dev->dev.devt = MKDEV(MAJOR(iio_devt), iio_dev_opaque->id);
2077396f7234SJonathan Cameron 		iio_dev_opaque->chrdev.owner = this_mod;
20788ebaa3ffSAlexandru Ardelean 	}
207938923911SLogan Gunthorpe 
208032f17172SAlexandru Ardelean 	/* assign device groups now; they should be all registered now */
208132f17172SAlexandru Ardelean 	indio_dev->dev.groups = iio_dev_opaque->groups;
208232f17172SAlexandru Ardelean 
2083396f7234SJonathan Cameron 	ret = cdev_device_add(&iio_dev_opaque->chrdev, &indio_dev->dev);
2084a980e046SJonathan Cameron 	if (ret < 0)
20850d5b7daeSLars-Peter Clausen 		goto error_unreg_eventset;
2086a980e046SJonathan Cameron 
20870d5b7daeSLars-Peter Clausen 	return 0;
208838923911SLogan Gunthorpe 
2089a980e046SJonathan Cameron error_unreg_eventset:
2090a980e046SJonathan Cameron 	iio_device_unregister_eventset(indio_dev);
2091a980e046SJonathan Cameron error_free_sysfs:
2092a980e046SJonathan Cameron 	iio_device_unregister_sysfs(indio_dev);
20933e1b6c95SLars-Peter Clausen error_buffer_free_sysfs:
2094ee708e6bSAlexandru Ardelean 	iio_buffers_free_sysfs_and_mask(indio_dev);
2095a980e046SJonathan Cameron error_unreg_debugfs:
2096a980e046SJonathan Cameron 	iio_device_unregister_debugfs(indio_dev);
2097a980e046SJonathan Cameron 	return ret;
2098a980e046SJonathan Cameron }
209963b19547SJonathan Cameron EXPORT_SYMBOL(__iio_device_register);
2100a980e046SJonathan Cameron 
2101a7e57dceSSachin Kamat /**
2102a7e57dceSSachin Kamat  * iio_device_unregister() - unregister a device from the IIO subsystem
2103a7e57dceSSachin Kamat  * @indio_dev:		Device structure representing the device.
210465659a8dSAndy Shevchenko  */
iio_device_unregister(struct iio_dev * indio_dev)2105a980e046SJonathan Cameron void iio_device_unregister(struct iio_dev *indio_dev)
2106a980e046SJonathan Cameron {
2107396f7234SJonathan Cameron 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
2108396f7234SJonathan Cameron 
2109396f7234SJonathan Cameron 	cdev_device_del(&iio_dev_opaque->chrdev, &indio_dev->dev);
2110a87c82e4SLars-Peter Clausen 
211142ea5992SNuno Sa 	scoped_guard(mutex, &iio_dev_opaque->info_exist_lock) {
2112bc4c9612SLars-Peter Clausen 		iio_device_unregister_debugfs(indio_dev);
21130d5b7daeSLars-Peter Clausen 
2114a87c82e4SLars-Peter Clausen 		iio_disable_all_buffers(indio_dev);
2115a87c82e4SLars-Peter Clausen 
2116a980e046SJonathan Cameron 		indio_dev->info = NULL;
2117d2f0a48fSLars-Peter Clausen 
2118d2f0a48fSLars-Peter Clausen 		iio_device_wakeup_eventset(indio_dev);
2119d2f0a48fSLars-Peter Clausen 		iio_buffer_wakeup_poll(indio_dev);
212042ea5992SNuno Sa 	}
21213e1b6c95SLars-Peter Clausen 
2122ee708e6bSAlexandru Ardelean 	iio_buffers_free_sysfs_and_mask(indio_dev);
2123a980e046SJonathan Cameron }
2124a980e046SJonathan Cameron EXPORT_SYMBOL(iio_device_unregister);
21258caa07c0SSachin Kamat 
devm_iio_device_unreg(void * indio_dev)2126cf5724e9SYicong Yang static void devm_iio_device_unreg(void *indio_dev)
21278caa07c0SSachin Kamat {
2128cf5724e9SYicong Yang 	iio_device_unregister(indio_dev);
21298caa07c0SSachin Kamat }
21308caa07c0SSachin Kamat 
__devm_iio_device_register(struct device * dev,struct iio_dev * indio_dev,struct module * this_mod)213163b19547SJonathan Cameron int __devm_iio_device_register(struct device *dev, struct iio_dev *indio_dev,
213263b19547SJonathan Cameron 			       struct module *this_mod)
21338caa07c0SSachin Kamat {
21348caa07c0SSachin Kamat 	int ret;
21358caa07c0SSachin Kamat 
213663b19547SJonathan Cameron 	ret = __iio_device_register(indio_dev, this_mod);
2137cf5724e9SYicong Yang 	if (ret)
21388caa07c0SSachin Kamat 		return ret;
2139cf5724e9SYicong Yang 
2140cf5724e9SYicong Yang 	return devm_add_action_or_reset(dev, devm_iio_device_unreg, indio_dev);
21418caa07c0SSachin Kamat }
214263b19547SJonathan Cameron EXPORT_SYMBOL_GPL(__devm_iio_device_register);
21438caa07c0SSachin Kamat 
21448caa07c0SSachin Kamat /**
214508a33805SAlison Schofield  * iio_device_claim_direct_mode - Keep device in direct mode
214608a33805SAlison Schofield  * @indio_dev:	the iio_dev associated with the device
214708a33805SAlison Schofield  *
214808a33805SAlison Schofield  * If the device is in direct mode it is guaranteed to stay
214908a33805SAlison Schofield  * that way until iio_device_release_direct_mode() is called.
215008a33805SAlison Schofield  *
215108a33805SAlison Schofield  * Use with iio_device_release_direct_mode()
215208a33805SAlison Schofield  *
215365659a8dSAndy Shevchenko  * Returns: 0 on success, -EBUSY on failure.
215408a33805SAlison Schofield  */
iio_device_claim_direct_mode(struct iio_dev * indio_dev)215508a33805SAlison Schofield int iio_device_claim_direct_mode(struct iio_dev *indio_dev)
215608a33805SAlison Schofield {
215716afe125SNuno Sá 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
215816afe125SNuno Sá 
215916afe125SNuno Sá 	mutex_lock(&iio_dev_opaque->mlock);
216008a33805SAlison Schofield 
216108a33805SAlison Schofield 	if (iio_buffer_enabled(indio_dev)) {
216216afe125SNuno Sá 		mutex_unlock(&iio_dev_opaque->mlock);
216308a33805SAlison Schofield 		return -EBUSY;
216408a33805SAlison Schofield 	}
216508a33805SAlison Schofield 	return 0;
216608a33805SAlison Schofield }
216708a33805SAlison Schofield EXPORT_SYMBOL_GPL(iio_device_claim_direct_mode);
216808a33805SAlison Schofield 
216908a33805SAlison Schofield /**
217008a33805SAlison Schofield  * iio_device_release_direct_mode - releases claim on direct mode
217108a33805SAlison Schofield  * @indio_dev:	the iio_dev associated with the device
217208a33805SAlison Schofield  *
217308a33805SAlison Schofield  * Release the claim. Device is no longer guaranteed to stay
217408a33805SAlison Schofield  * in direct mode.
217508a33805SAlison Schofield  *
217608a33805SAlison Schofield  * Use with iio_device_claim_direct_mode()
217708a33805SAlison Schofield  */
iio_device_release_direct_mode(struct iio_dev * indio_dev)217808a33805SAlison Schofield void iio_device_release_direct_mode(struct iio_dev *indio_dev)
217908a33805SAlison Schofield {
218016afe125SNuno Sá 	mutex_unlock(&to_iio_dev_opaque(indio_dev)->mlock);
218108a33805SAlison Schofield }
218208a33805SAlison Schofield EXPORT_SYMBOL_GPL(iio_device_release_direct_mode);
218308a33805SAlison Schofield 
21848c576f87SMiquel Raynal /**
21850a856542SNuno Sá  * iio_device_claim_buffer_mode - Keep device in buffer mode
21860a856542SNuno Sá  * @indio_dev:	the iio_dev associated with the device
21870a856542SNuno Sá  *
21880a856542SNuno Sá  * If the device is in buffer mode it is guaranteed to stay
21890a856542SNuno Sá  * that way until iio_device_release_buffer_mode() is called.
21900a856542SNuno Sá  *
21910a856542SNuno Sá  * Use with iio_device_release_buffer_mode().
21920a856542SNuno Sá  *
21930a856542SNuno Sá  * Returns: 0 on success, -EBUSY on failure.
21940a856542SNuno Sá  */
iio_device_claim_buffer_mode(struct iio_dev * indio_dev)21950a856542SNuno Sá int iio_device_claim_buffer_mode(struct iio_dev *indio_dev)
21960a856542SNuno Sá {
219716afe125SNuno Sá 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
219816afe125SNuno Sá 
219916afe125SNuno Sá 	mutex_lock(&iio_dev_opaque->mlock);
22000a856542SNuno Sá 
22010a856542SNuno Sá 	if (iio_buffer_enabled(indio_dev))
22020a856542SNuno Sá 		return 0;
22030a856542SNuno Sá 
220416afe125SNuno Sá 	mutex_unlock(&iio_dev_opaque->mlock);
22050a856542SNuno Sá 	return -EBUSY;
22060a856542SNuno Sá }
22070a856542SNuno Sá EXPORT_SYMBOL_GPL(iio_device_claim_buffer_mode);
22080a856542SNuno Sá 
22090a856542SNuno Sá /**
22100a856542SNuno Sá  * iio_device_release_buffer_mode - releases claim on buffer mode
22110a856542SNuno Sá  * @indio_dev:	the iio_dev associated with the device
22120a856542SNuno Sá  *
22130a856542SNuno Sá  * Release the claim. Device is no longer guaranteed to stay
22140a856542SNuno Sá  * in buffer mode.
22150a856542SNuno Sá  *
22160a856542SNuno Sá  * Use with iio_device_claim_buffer_mode().
22170a856542SNuno Sá  */
iio_device_release_buffer_mode(struct iio_dev * indio_dev)22180a856542SNuno Sá void iio_device_release_buffer_mode(struct iio_dev *indio_dev)
22190a856542SNuno Sá {
222016afe125SNuno Sá 	mutex_unlock(&to_iio_dev_opaque(indio_dev)->mlock);
22210a856542SNuno Sá }
22220a856542SNuno Sá EXPORT_SYMBOL_GPL(iio_device_release_buffer_mode);
22230a856542SNuno Sá 
22240a856542SNuno Sá /**
22258c576f87SMiquel Raynal  * iio_device_get_current_mode() - helper function providing read-only access to
222651570c9dSMiquel Raynal  *				   the opaque @currentmode variable
22278c576f87SMiquel Raynal  * @indio_dev:			   IIO device structure for device
22288c576f87SMiquel Raynal  */
iio_device_get_current_mode(struct iio_dev * indio_dev)22298c576f87SMiquel Raynal int iio_device_get_current_mode(struct iio_dev *indio_dev)
22308c576f87SMiquel Raynal {
223151570c9dSMiquel Raynal 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
223251570c9dSMiquel Raynal 
223351570c9dSMiquel Raynal 	return iio_dev_opaque->currentmode;
22348c576f87SMiquel Raynal }
22358c576f87SMiquel Raynal EXPORT_SYMBOL_GPL(iio_device_get_current_mode);
22368c576f87SMiquel Raynal 
2237a980e046SJonathan Cameron subsys_initcall(iio_init);
2238a980e046SJonathan Cameron module_exit(iio_exit);
2239a980e046SJonathan Cameron 
2240c8b95952SJonathan Cameron MODULE_AUTHOR("Jonathan Cameron <jic23@kernel.org>");
2241a980e046SJonathan Cameron MODULE_DESCRIPTION("Industrial I/O core");
2242a980e046SJonathan Cameron MODULE_LICENSE("GPL");
2243