xref: /linux/drivers/iio/industrialio-core.c (revision 42ea59925387e8468f490155ffdc382aba2539ae)
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>
14*42ea5992SNuno 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  */
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  */
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  */
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
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 */
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  */
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  */
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  */
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 
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 
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)
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 
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 
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 
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
4758915aacaSGreg Kroah-Hartman static void iio_device_register_debugfs(struct iio_dev *indio_dev)
476a980e046SJonathan Cameron {
477a980e046SJonathan Cameron }
478a980e046SJonathan Cameron 
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 
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 
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 
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 
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 
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 
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 
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  */
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 
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]);
67051239600SJonathan Cameron 		tmp1 = vals[1];
6710e7a3978SAnand Ashok Dumbre 		tmp0 = (int)div_s64_rem(tmp2, 1000000000, &tmp1);
6720e7a3978SAnand Ashok Dumbre 		if ((tmp2 < 0) && (tmp0 == 0))
6736b92ba0aSLars-Peter Clausen 			return sysfs_emit_at(buf, offset, "-0.%09u", abs(tmp1));
6740e7a3978SAnand Ashok Dumbre 		else
6756b92ba0aSLars-Peter Clausen 			return sysfs_emit_at(buf, offset, "%d.%09u", tmp0,
6766b92ba0aSLars-Peter Clausen 					     abs(tmp1));
67751239600SJonathan Cameron 	case IIO_VAL_FRACTIONAL_LOG2:
6782646a95dSLars-Peter Clausen 		tmp2 = shift_right((s64)vals[0] * 1000000000LL, vals[1]);
6792646a95dSLars-Peter Clausen 		tmp0 = (int)div_s64_rem(tmp2, 1000000000LL, &tmp1);
68038a52cdeSLars-Peter Clausen 		if (tmp0 == 0 && tmp2 < 0)
6816b92ba0aSLars-Peter Clausen 			return sysfs_emit_at(buf, offset, "-0.%09u", abs(tmp1));
68238a52cdeSLars-Peter Clausen 		else
6836b92ba0aSLars-Peter Clausen 			return sysfs_emit_at(buf, offset, "%d.%09u", tmp0,
6846b92ba0aSLars-Peter Clausen 					     abs(tmp1));
68551239600SJonathan Cameron 	case IIO_VAL_INT_MULTIPLE:
68651239600SJonathan Cameron 	{
68751239600SJonathan Cameron 		int i;
68851239600SJonathan Cameron 		int l = 0;
68951239600SJonathan Cameron 
6906b92ba0aSLars-Peter Clausen 		for (i = 0; i < size; ++i)
6916b92ba0aSLars-Peter Clausen 			l += sysfs_emit_at(buf, offset + l, "%d ", vals[i]);
69251239600SJonathan Cameron 		return l;
69351239600SJonathan Cameron 	}
6948cb34036SAndrea Merello 	case IIO_VAL_CHAR:
6956b92ba0aSLars-Peter Clausen 		return sysfs_emit_at(buf, offset, "%c", (char)vals[0]);
6966bb835f3SAndriy Tryshnivskyy 	case IIO_VAL_INT_64:
6976bb835f3SAndriy Tryshnivskyy 		tmp2 = (s64)((((u64)vals[1]) << 32) | (u32)vals[0]);
6986bb835f3SAndriy Tryshnivskyy 		return sysfs_emit_at(buf, offset, "%lld", tmp2);
69951239600SJonathan Cameron 	default:
70051239600SJonathan Cameron 		return 0;
70151239600SJonathan Cameron 	}
70251239600SJonathan Cameron }
70351239600SJonathan Cameron 
7043661f3f5SLars-Peter Clausen /**
7053661f3f5SLars-Peter Clausen  * iio_format_value() - Formats a IIO value into its string representation
7062498dcf6SCristina Opriceana  * @buf:	The buffer to which the formatted value gets written
70751239600SJonathan Cameron  *		which is assumed to be big enough (i.e. PAGE_SIZE).
708c175cb7cSRandy Dunlap  * @type:	One of the IIO_VAL_* constants. This decides how the val
7092498dcf6SCristina Opriceana  *		and val2 parameters are formatted.
7102498dcf6SCristina Opriceana  * @size:	Number of IIO value entries contained in vals
7112498dcf6SCristina Opriceana  * @vals:	Pointer to the values, exact meaning depends on the
7122498dcf6SCristina Opriceana  *		type parameter.
7132498dcf6SCristina Opriceana  *
71465659a8dSAndy Shevchenko  * Returns:
71565659a8dSAndy Shevchenko  * 0 by default, a negative number on failure or the total number of characters
71665659a8dSAndy Shevchenko  * written for a type that belongs to the IIO_VAL_* constant.
7173661f3f5SLars-Peter Clausen  */
7189fbfb4b3SSrinivas Pandruvada ssize_t iio_format_value(char *buf, unsigned int type, int size, int *vals)
719a980e046SJonathan Cameron {
72051239600SJonathan Cameron 	ssize_t len;
721a980e046SJonathan Cameron 
7226b92ba0aSLars-Peter Clausen 	len = __iio_format_value(buf, 0, type, size, vals);
72351239600SJonathan Cameron 	if (len >= PAGE_SIZE - 1)
72451239600SJonathan Cameron 		return -EFBIG;
7259fbfb4b3SSrinivas Pandruvada 
7266b92ba0aSLars-Peter Clausen 	return len + sysfs_emit_at(buf, len, "\n");
72767eedba3SMichael Hennerich }
7287d2c2acaSAndrew F. Davis EXPORT_SYMBOL_GPL(iio_format_value);
729a980e046SJonathan Cameron 
7301d4ef9b3SCristian Pop static ssize_t iio_read_channel_label(struct device *dev,
7311d4ef9b3SCristian Pop 				      struct device_attribute *attr,
7321d4ef9b3SCristian Pop 				      char *buf)
7331d4ef9b3SCristian Pop {
7341d4ef9b3SCristian Pop 	struct iio_dev *indio_dev = dev_to_iio_dev(dev);
7351d4ef9b3SCristian Pop 	struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
7361d4ef9b3SCristian Pop 
73713efdc3dSPaul Cercueil 	if (indio_dev->info->read_label)
7381d4ef9b3SCristian Pop 		return indio_dev->info->read_label(indio_dev, this_attr->c, buf);
73913efdc3dSPaul Cercueil 
74013efdc3dSPaul Cercueil 	if (this_attr->c->extend_name)
741c3154defSLars-Peter Clausen 		return sysfs_emit(buf, "%s\n", this_attr->c->extend_name);
74213efdc3dSPaul Cercueil 
74313efdc3dSPaul Cercueil 	return -EINVAL;
7441d4ef9b3SCristian Pop }
7451d4ef9b3SCristian Pop 
7463661f3f5SLars-Peter Clausen static ssize_t iio_read_channel_info(struct device *dev,
7473661f3f5SLars-Peter Clausen 				     struct device_attribute *attr,
7483661f3f5SLars-Peter Clausen 				     char *buf)
7493661f3f5SLars-Peter Clausen {
7503661f3f5SLars-Peter Clausen 	struct iio_dev *indio_dev = dev_to_iio_dev(dev);
7513661f3f5SLars-Peter Clausen 	struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
7529fbfb4b3SSrinivas Pandruvada 	int vals[INDIO_MAX_RAW_ELEMENTS];
7539fbfb4b3SSrinivas Pandruvada 	int ret;
7549fbfb4b3SSrinivas Pandruvada 	int val_len = 2;
7559fbfb4b3SSrinivas Pandruvada 
7569fbfb4b3SSrinivas Pandruvada 	if (indio_dev->info->read_raw_multi)
7579fbfb4b3SSrinivas Pandruvada 		ret = indio_dev->info->read_raw_multi(indio_dev, this_attr->c,
7589fbfb4b3SSrinivas Pandruvada 							INDIO_MAX_RAW_ELEMENTS,
7599fbfb4b3SSrinivas Pandruvada 							vals, &val_len,
7609fbfb4b3SSrinivas Pandruvada 							this_attr->address);
7619fbfb4b3SSrinivas Pandruvada 	else
7629fbfb4b3SSrinivas Pandruvada 		ret = indio_dev->info->read_raw(indio_dev, this_attr->c,
7639fbfb4b3SSrinivas Pandruvada 				    &vals[0], &vals[1], this_attr->address);
7643661f3f5SLars-Peter Clausen 
7653661f3f5SLars-Peter Clausen 	if (ret < 0)
7663661f3f5SLars-Peter Clausen 		return ret;
7673661f3f5SLars-Peter Clausen 
7689fbfb4b3SSrinivas Pandruvada 	return iio_format_value(buf, ret, val_len, vals);
7693661f3f5SLars-Peter Clausen }
7703661f3f5SLars-Peter Clausen 
771eda20ba1SLars-Peter Clausen static ssize_t iio_format_list(char *buf, const int *vals, int type, int length,
772eda20ba1SLars-Peter Clausen 			       const char *prefix, const char *suffix)
77351239600SJonathan Cameron {
774eda20ba1SLars-Peter Clausen 	ssize_t len;
775e08b60d3SLars-Peter Clausen 	int stride;
77651239600SJonathan Cameron 	int i;
777eda20ba1SLars-Peter Clausen 
77851239600SJonathan Cameron 	switch (type) {
77951239600SJonathan Cameron 	case IIO_VAL_INT:
780e08b60d3SLars-Peter Clausen 		stride = 1;
78151239600SJonathan Cameron 		break;
78251239600SJonathan Cameron 	default:
783e08b60d3SLars-Peter Clausen 		stride = 2;
784e08b60d3SLars-Peter Clausen 		break;
785e08b60d3SLars-Peter Clausen 	}
786e08b60d3SLars-Peter Clausen 
7876b92ba0aSLars-Peter Clausen 	len = sysfs_emit(buf, prefix);
788e08b60d3SLars-Peter Clausen 
789e08b60d3SLars-Peter Clausen 	for (i = 0; i <= length - stride; i += stride) {
790e08b60d3SLars-Peter Clausen 		if (i != 0) {
7916b92ba0aSLars-Peter Clausen 			len += sysfs_emit_at(buf, len, " ");
79251239600SJonathan Cameron 			if (len >= PAGE_SIZE)
79351239600SJonathan Cameron 				return -EFBIG;
79451239600SJonathan Cameron 		}
795e08b60d3SLars-Peter Clausen 
7966b92ba0aSLars-Peter Clausen 		len += __iio_format_value(buf, len, type, stride, &vals[i]);
797e08b60d3SLars-Peter Clausen 		if (len >= PAGE_SIZE)
798e08b60d3SLars-Peter Clausen 			return -EFBIG;
79951239600SJonathan Cameron 	}
80051239600SJonathan Cameron 
8016b92ba0aSLars-Peter Clausen 	len += sysfs_emit_at(buf, len, "%s\n", suffix);
802e08b60d3SLars-Peter Clausen 
80351239600SJonathan Cameron 	return len;
80451239600SJonathan Cameron }
80551239600SJonathan Cameron 
806eda20ba1SLars-Peter Clausen static ssize_t iio_format_avail_list(char *buf, const int *vals,
807eda20ba1SLars-Peter Clausen 				     int type, int length)
808eda20ba1SLars-Peter Clausen {
809eda20ba1SLars-Peter Clausen 
810eda20ba1SLars-Peter Clausen 	return iio_format_list(buf, vals, type, length, "", "");
811eda20ba1SLars-Peter Clausen }
812eda20ba1SLars-Peter Clausen 
81351239600SJonathan Cameron static ssize_t iio_format_avail_range(char *buf, const int *vals, int type)
81451239600SJonathan Cameron {
8155e1f9185SFawzi Khaber 	int length;
8165e1f9185SFawzi Khaber 
8175e1f9185SFawzi Khaber 	/*
8185e1f9185SFawzi Khaber 	 * length refers to the array size , not the number of elements.
8195e1f9185SFawzi Khaber 	 * The purpose is to print the range [min , step ,max] so length should
8205e1f9185SFawzi Khaber 	 * be 3 in case of int, and 6 for other types.
8215e1f9185SFawzi Khaber 	 */
8225e1f9185SFawzi Khaber 	switch (type) {
8235e1f9185SFawzi Khaber 	case IIO_VAL_INT:
8245e1f9185SFawzi Khaber 		length = 3;
8255e1f9185SFawzi Khaber 		break;
8265e1f9185SFawzi Khaber 	default:
8275e1f9185SFawzi Khaber 		length = 6;
8285e1f9185SFawzi Khaber 		break;
8295e1f9185SFawzi Khaber 	}
8305e1f9185SFawzi Khaber 
8315e1f9185SFawzi Khaber 	return iio_format_list(buf, vals, type, length, "[", "]");
83251239600SJonathan Cameron }
83351239600SJonathan Cameron 
83451239600SJonathan Cameron static ssize_t iio_read_channel_info_avail(struct device *dev,
83551239600SJonathan Cameron 					   struct device_attribute *attr,
83651239600SJonathan Cameron 					   char *buf)
83751239600SJonathan Cameron {
83851239600SJonathan Cameron 	struct iio_dev *indio_dev = dev_to_iio_dev(dev);
83951239600SJonathan Cameron 	struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
84051239600SJonathan Cameron 	const int *vals;
84151239600SJonathan Cameron 	int ret;
84251239600SJonathan Cameron 	int length;
84351239600SJonathan Cameron 	int type;
84451239600SJonathan Cameron 
84551239600SJonathan Cameron 	ret = indio_dev->info->read_avail(indio_dev, this_attr->c,
84651239600SJonathan Cameron 					  &vals, &type, &length,
84751239600SJonathan Cameron 					  this_attr->address);
84851239600SJonathan Cameron 
84951239600SJonathan Cameron 	if (ret < 0)
85051239600SJonathan Cameron 		return ret;
85151239600SJonathan Cameron 	switch (ret) {
85251239600SJonathan Cameron 	case IIO_AVAIL_LIST:
85351239600SJonathan Cameron 		return iio_format_avail_list(buf, vals, type, length);
85451239600SJonathan Cameron 	case IIO_AVAIL_RANGE:
85551239600SJonathan Cameron 		return iio_format_avail_range(buf, vals, type);
85651239600SJonathan Cameron 	default:
85751239600SJonathan Cameron 		return -EINVAL;
85851239600SJonathan Cameron 	}
85951239600SJonathan Cameron }
86051239600SJonathan Cameron 
8616807d721SLars-Peter Clausen /**
862b8528224SBeniamin Bia  * __iio_str_to_fixpoint() - Parse a fixed-point number from a string
8636807d721SLars-Peter Clausen  * @str: The string to parse
8646807d721SLars-Peter Clausen  * @fract_mult: Multiplier for the first decimal place, should be a power of 10
8656807d721SLars-Peter Clausen  * @integer: The integer part of the number
8666807d721SLars-Peter Clausen  * @fract: The fractional part of the number
867b8528224SBeniamin Bia  * @scale_db: True if this should parse as dB
8686807d721SLars-Peter Clausen  *
86965659a8dSAndy Shevchenko  * Returns:
87065659a8dSAndy Shevchenko  * 0 on success, or a negative error code if the string could not be parsed.
8716807d721SLars-Peter Clausen  */
872b8528224SBeniamin Bia static int __iio_str_to_fixpoint(const char *str, int fract_mult,
873b8528224SBeniamin Bia 				 int *integer, int *fract, bool scale_db)
8746807d721SLars-Peter Clausen {
8756807d721SLars-Peter Clausen 	int i = 0, f = 0;
8766807d721SLars-Peter Clausen 	bool integer_part = true, negative = false;
8776807d721SLars-Peter Clausen 
878f47dff32SSean Nyekjaer 	if (fract_mult == 0) {
879f47dff32SSean Nyekjaer 		*fract = 0;
880f47dff32SSean Nyekjaer 
881f47dff32SSean Nyekjaer 		return kstrtoint(str, 0, integer);
882f47dff32SSean Nyekjaer 	}
883f47dff32SSean Nyekjaer 
8846807d721SLars-Peter Clausen 	if (str[0] == '-') {
8856807d721SLars-Peter Clausen 		negative = true;
8866807d721SLars-Peter Clausen 		str++;
8876807d721SLars-Peter Clausen 	} else if (str[0] == '+') {
8886807d721SLars-Peter Clausen 		str++;
8896807d721SLars-Peter Clausen 	}
8906807d721SLars-Peter Clausen 
8916807d721SLars-Peter Clausen 	while (*str) {
8926807d721SLars-Peter Clausen 		if ('0' <= *str && *str <= '9') {
8936807d721SLars-Peter Clausen 			if (integer_part) {
8946807d721SLars-Peter Clausen 				i = i * 10 + *str - '0';
8956807d721SLars-Peter Clausen 			} else {
8966807d721SLars-Peter Clausen 				f += fract_mult * (*str - '0');
8976807d721SLars-Peter Clausen 				fract_mult /= 10;
8986807d721SLars-Peter Clausen 			}
8996807d721SLars-Peter Clausen 		} else if (*str == '\n') {
9006807d721SLars-Peter Clausen 			if (*(str + 1) == '\0')
9016807d721SLars-Peter Clausen 				break;
9026807d721SLars-Peter Clausen 			return -EINVAL;
903b8528224SBeniamin Bia 		} else if (!strncmp(str, " dB", sizeof(" dB") - 1) && scale_db) {
904b8528224SBeniamin Bia 			/* Ignore the dB suffix */
905b8528224SBeniamin Bia 			str += sizeof(" dB") - 1;
906b8528224SBeniamin Bia 			continue;
907b8528224SBeniamin Bia 		} else if (!strncmp(str, "dB", sizeof("dB") - 1) && scale_db) {
908b8528224SBeniamin Bia 			/* Ignore the dB suffix */
909b8528224SBeniamin Bia 			str += sizeof("dB") - 1;
910b8528224SBeniamin Bia 			continue;
9116807d721SLars-Peter Clausen 		} else if (*str == '.' && integer_part) {
9126807d721SLars-Peter Clausen 			integer_part = false;
9136807d721SLars-Peter Clausen 		} else {
9146807d721SLars-Peter Clausen 			return -EINVAL;
9156807d721SLars-Peter Clausen 		}
9166807d721SLars-Peter Clausen 		str++;
9176807d721SLars-Peter Clausen 	}
9186807d721SLars-Peter Clausen 
9196807d721SLars-Peter Clausen 	if (negative) {
9206807d721SLars-Peter Clausen 		if (i)
9216807d721SLars-Peter Clausen 			i = -i;
9226807d721SLars-Peter Clausen 		else
9236807d721SLars-Peter Clausen 			f = -f;
9246807d721SLars-Peter Clausen 	}
9256807d721SLars-Peter Clausen 
9266807d721SLars-Peter Clausen 	*integer = i;
9276807d721SLars-Peter Clausen 	*fract = f;
9286807d721SLars-Peter Clausen 
9296807d721SLars-Peter Clausen 	return 0;
9306807d721SLars-Peter Clausen }
931b8528224SBeniamin Bia 
932b8528224SBeniamin Bia /**
933b8528224SBeniamin Bia  * iio_str_to_fixpoint() - Parse a fixed-point number from a string
934b8528224SBeniamin Bia  * @str: The string to parse
935b8528224SBeniamin Bia  * @fract_mult: Multiplier for the first decimal place, should be a power of 10
936b8528224SBeniamin Bia  * @integer: The integer part of the number
937b8528224SBeniamin Bia  * @fract: The fractional part of the number
938b8528224SBeniamin Bia  *
93965659a8dSAndy Shevchenko  * Returns:
94065659a8dSAndy Shevchenko  * 0 on success, or a negative error code if the string could not be parsed.
941b8528224SBeniamin Bia  */
942b8528224SBeniamin Bia int iio_str_to_fixpoint(const char *str, int fract_mult,
943b8528224SBeniamin Bia 			int *integer, int *fract)
944b8528224SBeniamin Bia {
945b8528224SBeniamin Bia 	return __iio_str_to_fixpoint(str, fract_mult, integer, fract, false);
946b8528224SBeniamin Bia }
9476807d721SLars-Peter Clausen EXPORT_SYMBOL_GPL(iio_str_to_fixpoint);
9486807d721SLars-Peter Clausen 
949a980e046SJonathan Cameron static ssize_t iio_write_channel_info(struct device *dev,
950a980e046SJonathan Cameron 				      struct device_attribute *attr,
951a980e046SJonathan Cameron 				      const char *buf,
952a980e046SJonathan Cameron 				      size_t len)
953a980e046SJonathan Cameron {
954e53f5ac5SLars-Peter Clausen 	struct iio_dev *indio_dev = dev_to_iio_dev(dev);
955a980e046SJonathan Cameron 	struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
9566807d721SLars-Peter Clausen 	int ret, fract_mult = 100000;
9578cb34036SAndrea Merello 	int integer, fract = 0;
9588cb34036SAndrea Merello 	bool is_char = false;
959b8528224SBeniamin Bia 	bool scale_db = false;
960a980e046SJonathan Cameron 
961a980e046SJonathan Cameron 	/* Assumes decimal - precision based on number of digits */
962a980e046SJonathan Cameron 	if (!indio_dev->info->write_raw)
963a980e046SJonathan Cameron 		return -EINVAL;
964a980e046SJonathan Cameron 
965a980e046SJonathan Cameron 	if (indio_dev->info->write_raw_get_fmt)
966a980e046SJonathan Cameron 		switch (indio_dev->info->write_raw_get_fmt(indio_dev,
967a980e046SJonathan Cameron 			this_attr->c, this_attr->address)) {
968f47dff32SSean Nyekjaer 		case IIO_VAL_INT:
969f47dff32SSean Nyekjaer 			fract_mult = 0;
970f47dff32SSean Nyekjaer 			break;
971b8528224SBeniamin Bia 		case IIO_VAL_INT_PLUS_MICRO_DB:
972b8528224SBeniamin Bia 			scale_db = true;
973df561f66SGustavo A. R. Silva 			fallthrough;
974a980e046SJonathan Cameron 		case IIO_VAL_INT_PLUS_MICRO:
975a980e046SJonathan Cameron 			fract_mult = 100000;
976a980e046SJonathan Cameron 			break;
977a980e046SJonathan Cameron 		case IIO_VAL_INT_PLUS_NANO:
978a980e046SJonathan Cameron 			fract_mult = 100000000;
979a980e046SJonathan Cameron 			break;
9808cb34036SAndrea Merello 		case IIO_VAL_CHAR:
9818cb34036SAndrea Merello 			is_char = true;
9828cb34036SAndrea Merello 			break;
983a980e046SJonathan Cameron 		default:
984a980e046SJonathan Cameron 			return -EINVAL;
985a980e046SJonathan Cameron 		}
986a980e046SJonathan Cameron 
9878cb34036SAndrea Merello 	if (is_char) {
9888cb34036SAndrea Merello 		char ch;
9898cb34036SAndrea Merello 
9908cb34036SAndrea Merello 		if (sscanf(buf, "%c", &ch) != 1)
9918cb34036SAndrea Merello 			return -EINVAL;
9928cb34036SAndrea Merello 		integer = ch;
9938cb34036SAndrea Merello 	} else {
994b8528224SBeniamin Bia 		ret = __iio_str_to_fixpoint(buf, fract_mult, &integer, &fract,
995b8528224SBeniamin Bia 					    scale_db);
996b8528224SBeniamin Bia 		if (ret)
997b8528224SBeniamin Bia 			return ret;
9985403f280SMircea Caprioru 	}
999a980e046SJonathan Cameron 
1000a980e046SJonathan Cameron 	ret = indio_dev->info->write_raw(indio_dev, this_attr->c,
1001a980e046SJonathan Cameron 					 integer, fract, this_attr->address);
1002a980e046SJonathan Cameron 	if (ret)
1003a980e046SJonathan Cameron 		return ret;
1004a980e046SJonathan Cameron 
1005a980e046SJonathan Cameron 	return len;
1006a980e046SJonathan Cameron }
1007a980e046SJonathan Cameron 
1008a980e046SJonathan Cameron static
1009a980e046SJonathan Cameron int __iio_device_attr_init(struct device_attribute *dev_attr,
1010a980e046SJonathan Cameron 			   const char *postfix,
1011a980e046SJonathan Cameron 			   struct iio_chan_spec const *chan,
1012a980e046SJonathan Cameron 			   ssize_t (*readfunc)(struct device *dev,
1013a980e046SJonathan Cameron 					       struct device_attribute *attr,
1014a980e046SJonathan Cameron 					       char *buf),
1015a980e046SJonathan Cameron 			   ssize_t (*writefunc)(struct device *dev,
1016a980e046SJonathan Cameron 						struct device_attribute *attr,
1017a980e046SJonathan Cameron 						const char *buf,
1018a980e046SJonathan Cameron 						size_t len),
10193704432fSJonathan Cameron 			   enum iio_shared_by shared_by)
1020a980e046SJonathan Cameron {
10213704432fSJonathan Cameron 	int ret = 0;
10227bbcf7e1SLars-Peter Clausen 	char *name = NULL;
10233704432fSJonathan Cameron 	char *full_postfix;
10249d9ec8d0SJoe Simmons-Talbott 
1025a980e046SJonathan Cameron 	sysfs_attr_init(&dev_attr->attr);
1026a980e046SJonathan Cameron 
1027a980e046SJonathan Cameron 	/* Build up postfix of <extend_name>_<modifier>_postfix */
10283704432fSJonathan Cameron 	if (chan->modified && (shared_by == IIO_SEPARATE)) {
1029a980e046SJonathan Cameron 		if (chan->extend_name)
1030a980e046SJonathan Cameron 			full_postfix = kasprintf(GFP_KERNEL, "%s_%s_%s",
1031b662f4baSAndy Shevchenko 						 iio_modifier_names[chan->channel2],
1032a980e046SJonathan Cameron 						 chan->extend_name,
1033a980e046SJonathan Cameron 						 postfix);
1034a980e046SJonathan Cameron 		else
1035a980e046SJonathan Cameron 			full_postfix = kasprintf(GFP_KERNEL, "%s_%s",
1036b662f4baSAndy Shevchenko 						 iio_modifier_names[chan->channel2],
1037a980e046SJonathan Cameron 						 postfix);
1038a980e046SJonathan Cameron 	} else {
103977bfa8baSLars-Peter Clausen 		if (chan->extend_name == NULL || shared_by != IIO_SEPARATE)
1040a980e046SJonathan Cameron 			full_postfix = kstrdup(postfix, GFP_KERNEL);
1041a980e046SJonathan Cameron 		else
1042a980e046SJonathan Cameron 			full_postfix = kasprintf(GFP_KERNEL,
1043a980e046SJonathan Cameron 						 "%s_%s",
1044a980e046SJonathan Cameron 						 chan->extend_name,
1045a980e046SJonathan Cameron 						 postfix);
1046a980e046SJonathan Cameron 	}
10473704432fSJonathan Cameron 	if (full_postfix == NULL)
10483704432fSJonathan Cameron 		return -ENOMEM;
1049a980e046SJonathan Cameron 
1050a980e046SJonathan Cameron 	if (chan->differential) { /* Differential can not have modifier */
10513704432fSJonathan Cameron 		switch (shared_by) {
1052c006ec83SJonathan Cameron 		case IIO_SHARED_BY_ALL:
10537bbcf7e1SLars-Peter Clausen 			name = kasprintf(GFP_KERNEL, "%s", full_postfix);
1054c006ec83SJonathan Cameron 			break;
1055c006ec83SJonathan Cameron 		case IIO_SHARED_BY_DIR:
10567bbcf7e1SLars-Peter Clausen 			name = kasprintf(GFP_KERNEL, "%s_%s",
1057c006ec83SJonathan Cameron 						iio_direction[chan->output],
1058c006ec83SJonathan Cameron 						full_postfix);
1059c006ec83SJonathan Cameron 			break;
10603704432fSJonathan Cameron 		case IIO_SHARED_BY_TYPE:
10617bbcf7e1SLars-Peter Clausen 			name = kasprintf(GFP_KERNEL, "%s_%s-%s_%s",
1062a980e046SJonathan Cameron 					    iio_direction[chan->output],
1063a980e046SJonathan Cameron 					    iio_chan_type_name_spec[chan->type],
1064a980e046SJonathan Cameron 					    iio_chan_type_name_spec[chan->type],
1065a980e046SJonathan Cameron 					    full_postfix);
10663704432fSJonathan Cameron 			break;
10673704432fSJonathan Cameron 		case IIO_SEPARATE:
10683704432fSJonathan Cameron 			if (!chan->indexed) {
1069231bfe53SDan Carpenter 				WARN(1, "Differential channels must be indexed\n");
10703704432fSJonathan Cameron 				ret = -EINVAL;
10713704432fSJonathan Cameron 				goto error_free_full_postfix;
10723704432fSJonathan Cameron 			}
10737bbcf7e1SLars-Peter Clausen 			name = kasprintf(GFP_KERNEL,
10743704432fSJonathan Cameron 					    "%s_%s%d-%s%d_%s",
1075a980e046SJonathan Cameron 					    iio_direction[chan->output],
1076a980e046SJonathan Cameron 					    iio_chan_type_name_spec[chan->type],
1077a980e046SJonathan Cameron 					    chan->channel,
1078a980e046SJonathan Cameron 					    iio_chan_type_name_spec[chan->type],
1079a980e046SJonathan Cameron 					    chan->channel2,
1080a980e046SJonathan Cameron 					    full_postfix);
10813704432fSJonathan Cameron 			break;
1082a980e046SJonathan Cameron 		}
1083a980e046SJonathan Cameron 	} else { /* Single ended */
10843704432fSJonathan Cameron 		switch (shared_by) {
1085c006ec83SJonathan Cameron 		case IIO_SHARED_BY_ALL:
10867bbcf7e1SLars-Peter Clausen 			name = kasprintf(GFP_KERNEL, "%s", full_postfix);
1087c006ec83SJonathan Cameron 			break;
1088c006ec83SJonathan Cameron 		case IIO_SHARED_BY_DIR:
10897bbcf7e1SLars-Peter Clausen 			name = kasprintf(GFP_KERNEL, "%s_%s",
1090c006ec83SJonathan Cameron 						iio_direction[chan->output],
1091c006ec83SJonathan Cameron 						full_postfix);
1092c006ec83SJonathan Cameron 			break;
10933704432fSJonathan Cameron 		case IIO_SHARED_BY_TYPE:
10947bbcf7e1SLars-Peter Clausen 			name = kasprintf(GFP_KERNEL, "%s_%s_%s",
1095a980e046SJonathan Cameron 					    iio_direction[chan->output],
1096a980e046SJonathan Cameron 					    iio_chan_type_name_spec[chan->type],
1097a980e046SJonathan Cameron 					    full_postfix);
10983704432fSJonathan Cameron 			break;
10993704432fSJonathan Cameron 
11003704432fSJonathan Cameron 		case IIO_SEPARATE:
11013704432fSJonathan Cameron 			if (chan->indexed)
11027bbcf7e1SLars-Peter Clausen 				name = kasprintf(GFP_KERNEL, "%s_%s%d_%s",
1103a980e046SJonathan Cameron 						    iio_direction[chan->output],
1104a980e046SJonathan Cameron 						    iio_chan_type_name_spec[chan->type],
1105a980e046SJonathan Cameron 						    chan->channel,
1106a980e046SJonathan Cameron 						    full_postfix);
1107a980e046SJonathan Cameron 			else
11087bbcf7e1SLars-Peter Clausen 				name = kasprintf(GFP_KERNEL, "%s_%s_%s",
1109a980e046SJonathan Cameron 						    iio_direction[chan->output],
1110a980e046SJonathan Cameron 						    iio_chan_type_name_spec[chan->type],
1111a980e046SJonathan Cameron 						    full_postfix);
11123704432fSJonathan Cameron 			break;
11133704432fSJonathan Cameron 		}
1114a980e046SJonathan Cameron 	}
11157bbcf7e1SLars-Peter Clausen 	if (name == NULL) {
1116a980e046SJonathan Cameron 		ret = -ENOMEM;
1117a980e046SJonathan Cameron 		goto error_free_full_postfix;
1118a980e046SJonathan Cameron 	}
11197bbcf7e1SLars-Peter Clausen 	dev_attr->attr.name = name;
1120a980e046SJonathan Cameron 
1121a980e046SJonathan Cameron 	if (readfunc) {
11229cf0b618SJoe Simmons-Talbott 		dev_attr->attr.mode |= 0444;
1123a980e046SJonathan Cameron 		dev_attr->show = readfunc;
1124a980e046SJonathan Cameron 	}
1125a980e046SJonathan Cameron 
1126a980e046SJonathan Cameron 	if (writefunc) {
11279cf0b618SJoe Simmons-Talbott 		dev_attr->attr.mode |= 0200;
1128a980e046SJonathan Cameron 		dev_attr->store = writefunc;
1129a980e046SJonathan Cameron 	}
11307bbcf7e1SLars-Peter Clausen 
1131a980e046SJonathan Cameron error_free_full_postfix:
1132a980e046SJonathan Cameron 	kfree(full_postfix);
11333704432fSJonathan Cameron 
1134a980e046SJonathan Cameron 	return ret;
1135a980e046SJonathan Cameron }
1136a980e046SJonathan Cameron 
1137a980e046SJonathan Cameron static void __iio_device_attr_deinit(struct device_attribute *dev_attr)
1138a980e046SJonathan Cameron {
1139a980e046SJonathan Cameron 	kfree(dev_attr->attr.name);
1140a980e046SJonathan Cameron }
1141a980e046SJonathan Cameron 
1142a980e046SJonathan Cameron int __iio_add_chan_devattr(const char *postfix,
1143a980e046SJonathan Cameron 			   struct iio_chan_spec const *chan,
1144a980e046SJonathan Cameron 			   ssize_t (*readfunc)(struct device *dev,
1145a980e046SJonathan Cameron 					       struct device_attribute *attr,
1146a980e046SJonathan Cameron 					       char *buf),
1147a980e046SJonathan Cameron 			   ssize_t (*writefunc)(struct device *dev,
1148a980e046SJonathan Cameron 						struct device_attribute *attr,
1149a980e046SJonathan Cameron 						const char *buf,
1150a980e046SJonathan Cameron 						size_t len),
1151a980e046SJonathan Cameron 			   u64 mask,
11523704432fSJonathan Cameron 			   enum iio_shared_by shared_by,
1153a980e046SJonathan Cameron 			   struct device *dev,
11543e3d11b2SAlexandru Ardelean 			   struct iio_buffer *buffer,
1155a980e046SJonathan Cameron 			   struct list_head *attr_list)
1156a980e046SJonathan Cameron {
1157a980e046SJonathan Cameron 	int ret;
1158a980e046SJonathan Cameron 	struct iio_dev_attr *iio_attr, *t;
1159a980e046SJonathan Cameron 
1160670c1103SSachin Kamat 	iio_attr = kzalloc(sizeof(*iio_attr), GFP_KERNEL);
116192825ff9SHartmut Knaack 	if (iio_attr == NULL)
116292825ff9SHartmut Knaack 		return -ENOMEM;
1163a980e046SJonathan Cameron 	ret = __iio_device_attr_init(&iio_attr->dev_attr,
1164a980e046SJonathan Cameron 				     postfix, chan,
11653704432fSJonathan Cameron 				     readfunc, writefunc, shared_by);
1166a980e046SJonathan Cameron 	if (ret)
1167a980e046SJonathan Cameron 		goto error_iio_dev_attr_free;
1168a980e046SJonathan Cameron 	iio_attr->c = chan;
1169a980e046SJonathan Cameron 	iio_attr->address = mask;
11703e3d11b2SAlexandru Ardelean 	iio_attr->buffer = buffer;
1171a980e046SJonathan Cameron 	list_for_each_entry(t, attr_list, l)
1172a980e046SJonathan Cameron 		if (strcmp(t->dev_attr.attr.name,
1173a980e046SJonathan Cameron 			   iio_attr->dev_attr.attr.name) == 0) {
11743704432fSJonathan Cameron 			if (shared_by == IIO_SEPARATE)
1175a980e046SJonathan Cameron 				dev_err(dev, "tried to double register : %s\n",
1176a980e046SJonathan Cameron 					t->dev_attr.attr.name);
1177a980e046SJonathan Cameron 			ret = -EBUSY;
1178a980e046SJonathan Cameron 			goto error_device_attr_deinit;
1179a980e046SJonathan Cameron 		}
1180a980e046SJonathan Cameron 	list_add(&iio_attr->l, attr_list);
1181a980e046SJonathan Cameron 
1182a980e046SJonathan Cameron 	return 0;
1183a980e046SJonathan Cameron 
1184a980e046SJonathan Cameron error_device_attr_deinit:
1185a980e046SJonathan Cameron 	__iio_device_attr_deinit(&iio_attr->dev_attr);
1186a980e046SJonathan Cameron error_iio_dev_attr_free:
1187a980e046SJonathan Cameron 	kfree(iio_attr);
1188a980e046SJonathan Cameron 	return ret;
1189a980e046SJonathan Cameron }
1190a980e046SJonathan Cameron 
11911d4ef9b3SCristian Pop static int iio_device_add_channel_label(struct iio_dev *indio_dev,
11921d4ef9b3SCristian Pop 					 struct iio_chan_spec const *chan)
11931d4ef9b3SCristian Pop {
11941d4ef9b3SCristian Pop 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
11951d4ef9b3SCristian Pop 	int ret;
11961d4ef9b3SCristian Pop 
119713efdc3dSPaul Cercueil 	if (!indio_dev->info->read_label && !chan->extend_name)
11981d4ef9b3SCristian Pop 		return 0;
11991d4ef9b3SCristian Pop 
12001d4ef9b3SCristian Pop 	ret = __iio_add_chan_devattr("label",
12011d4ef9b3SCristian Pop 				     chan,
12021d4ef9b3SCristian Pop 				     &iio_read_channel_label,
12031d4ef9b3SCristian Pop 				     NULL,
12041d4ef9b3SCristian Pop 				     0,
12051d4ef9b3SCristian Pop 				     IIO_SEPARATE,
12061d4ef9b3SCristian Pop 				     &indio_dev->dev,
12073e3d11b2SAlexandru Ardelean 				     NULL,
12081d4ef9b3SCristian Pop 				     &iio_dev_opaque->channel_attr_list);
12091d4ef9b3SCristian Pop 	if (ret < 0)
12101d4ef9b3SCristian Pop 		return ret;
12111d4ef9b3SCristian Pop 
12121d4ef9b3SCristian Pop 	return 1;
12131d4ef9b3SCristian Pop }
12141d4ef9b3SCristian Pop 
12153704432fSJonathan Cameron static int iio_device_add_info_mask_type(struct iio_dev *indio_dev,
12163704432fSJonathan Cameron 					 struct iio_chan_spec const *chan,
12173704432fSJonathan Cameron 					 enum iio_shared_by shared_by,
12183704432fSJonathan Cameron 					 const long *infomask)
12193704432fSJonathan Cameron {
1220207c2d27SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
12213704432fSJonathan Cameron 	int i, ret, attrcount = 0;
12223704432fSJonathan Cameron 
12231016d567SOrson Zhai 	for_each_set_bit(i, infomask, sizeof(*infomask)*8) {
1224ef4b4856SJonathan Cameron 		if (i >= ARRAY_SIZE(iio_chan_info_postfix))
1225ef4b4856SJonathan Cameron 			return -EINVAL;
12263704432fSJonathan Cameron 		ret = __iio_add_chan_devattr(iio_chan_info_postfix[i],
12273704432fSJonathan Cameron 					     chan,
12283704432fSJonathan Cameron 					     &iio_read_channel_info,
12293704432fSJonathan Cameron 					     &iio_write_channel_info,
12303704432fSJonathan Cameron 					     i,
12313704432fSJonathan Cameron 					     shared_by,
12323704432fSJonathan Cameron 					     &indio_dev->dev,
12333e3d11b2SAlexandru Ardelean 					     NULL,
1234207c2d27SAlexandru Ardelean 					     &iio_dev_opaque->channel_attr_list);
12353704432fSJonathan Cameron 		if ((ret == -EBUSY) && (shared_by != IIO_SEPARATE))
12363704432fSJonathan Cameron 			continue;
12371702df5dSAndy Shevchenko 		if (ret < 0)
12383704432fSJonathan Cameron 			return ret;
12393704432fSJonathan Cameron 		attrcount++;
12403704432fSJonathan Cameron 	}
12413704432fSJonathan Cameron 
12423704432fSJonathan Cameron 	return attrcount;
12433704432fSJonathan Cameron }
12443704432fSJonathan Cameron 
124551239600SJonathan Cameron static int iio_device_add_info_mask_type_avail(struct iio_dev *indio_dev,
124651239600SJonathan Cameron 					       struct iio_chan_spec const *chan,
124751239600SJonathan Cameron 					       enum iio_shared_by shared_by,
124851239600SJonathan Cameron 					       const long *infomask)
124951239600SJonathan Cameron {
1250207c2d27SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
125151239600SJonathan Cameron 	int i, ret, attrcount = 0;
125251239600SJonathan Cameron 	char *avail_postfix;
125351239600SJonathan Cameron 
12541016d567SOrson Zhai 	for_each_set_bit(i, infomask, sizeof(*infomask) * 8) {
1255936d3e53SYoung Xiao 		if (i >= ARRAY_SIZE(iio_chan_info_postfix))
1256936d3e53SYoung Xiao 			return -EINVAL;
125751239600SJonathan Cameron 		avail_postfix = kasprintf(GFP_KERNEL,
125851239600SJonathan Cameron 					  "%s_available",
125951239600SJonathan Cameron 					  iio_chan_info_postfix[i]);
126051239600SJonathan Cameron 		if (!avail_postfix)
126151239600SJonathan Cameron 			return -ENOMEM;
126251239600SJonathan Cameron 
126351239600SJonathan Cameron 		ret = __iio_add_chan_devattr(avail_postfix,
126451239600SJonathan Cameron 					     chan,
126551239600SJonathan Cameron 					     &iio_read_channel_info_avail,
126651239600SJonathan Cameron 					     NULL,
126751239600SJonathan Cameron 					     i,
126851239600SJonathan Cameron 					     shared_by,
126951239600SJonathan Cameron 					     &indio_dev->dev,
12703e3d11b2SAlexandru Ardelean 					     NULL,
1271207c2d27SAlexandru Ardelean 					     &iio_dev_opaque->channel_attr_list);
127251239600SJonathan Cameron 		kfree(avail_postfix);
127351239600SJonathan Cameron 		if ((ret == -EBUSY) && (shared_by != IIO_SEPARATE))
127451239600SJonathan Cameron 			continue;
12751702df5dSAndy Shevchenko 		if (ret < 0)
127651239600SJonathan Cameron 			return ret;
127751239600SJonathan Cameron 		attrcount++;
127851239600SJonathan Cameron 	}
127951239600SJonathan Cameron 
128051239600SJonathan Cameron 	return attrcount;
128151239600SJonathan Cameron }
128251239600SJonathan Cameron 
1283a980e046SJonathan Cameron static int iio_device_add_channel_sysfs(struct iio_dev *indio_dev,
1284a980e046SJonathan Cameron 					struct iio_chan_spec const *chan)
1285a980e046SJonathan Cameron {
1286207c2d27SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
1287a980e046SJonathan Cameron 	int ret, attrcount = 0;
1288a980e046SJonathan Cameron 	const struct iio_chan_spec_ext_info *ext_info;
1289a980e046SJonathan Cameron 
1290a980e046SJonathan Cameron 	if (chan->channel < 0)
1291a980e046SJonathan Cameron 		return 0;
12923704432fSJonathan Cameron 	ret = iio_device_add_info_mask_type(indio_dev, chan,
12933704432fSJonathan Cameron 					    IIO_SEPARATE,
12943704432fSJonathan Cameron 					    &chan->info_mask_separate);
12958655cc49SJonathan Cameron 	if (ret < 0)
12963704432fSJonathan Cameron 		return ret;
12973704432fSJonathan Cameron 	attrcount += ret;
12983704432fSJonathan Cameron 
129951239600SJonathan Cameron 	ret = iio_device_add_info_mask_type_avail(indio_dev, chan,
130051239600SJonathan Cameron 						  IIO_SEPARATE,
1301682ca76bSJoe Simmons-Talbott 						  &chan->info_mask_separate_available);
130251239600SJonathan Cameron 	if (ret < 0)
130351239600SJonathan Cameron 		return ret;
130451239600SJonathan Cameron 	attrcount += ret;
130551239600SJonathan Cameron 
13063704432fSJonathan Cameron 	ret = iio_device_add_info_mask_type(indio_dev, chan,
13073704432fSJonathan Cameron 					    IIO_SHARED_BY_TYPE,
13083704432fSJonathan Cameron 					    &chan->info_mask_shared_by_type);
13093704432fSJonathan Cameron 	if (ret < 0)
13103704432fSJonathan Cameron 		return ret;
13113704432fSJonathan Cameron 	attrcount += ret;
1312a980e046SJonathan Cameron 
131351239600SJonathan Cameron 	ret = iio_device_add_info_mask_type_avail(indio_dev, chan,
131451239600SJonathan Cameron 						  IIO_SHARED_BY_TYPE,
1315682ca76bSJoe Simmons-Talbott 						  &chan->info_mask_shared_by_type_available);
131651239600SJonathan Cameron 	if (ret < 0)
131751239600SJonathan Cameron 		return ret;
131851239600SJonathan Cameron 	attrcount += ret;
131951239600SJonathan Cameron 
1320c006ec83SJonathan Cameron 	ret = iio_device_add_info_mask_type(indio_dev, chan,
1321c006ec83SJonathan Cameron 					    IIO_SHARED_BY_DIR,
1322c006ec83SJonathan Cameron 					    &chan->info_mask_shared_by_dir);
1323c006ec83SJonathan Cameron 	if (ret < 0)
1324c006ec83SJonathan Cameron 		return ret;
1325c006ec83SJonathan Cameron 	attrcount += ret;
1326c006ec83SJonathan Cameron 
132751239600SJonathan Cameron 	ret = iio_device_add_info_mask_type_avail(indio_dev, chan,
132851239600SJonathan Cameron 						  IIO_SHARED_BY_DIR,
132951239600SJonathan Cameron 						  &chan->info_mask_shared_by_dir_available);
133051239600SJonathan Cameron 	if (ret < 0)
133151239600SJonathan Cameron 		return ret;
133251239600SJonathan Cameron 	attrcount += ret;
133351239600SJonathan Cameron 
1334c006ec83SJonathan Cameron 	ret = iio_device_add_info_mask_type(indio_dev, chan,
1335c006ec83SJonathan Cameron 					    IIO_SHARED_BY_ALL,
1336c006ec83SJonathan Cameron 					    &chan->info_mask_shared_by_all);
1337c006ec83SJonathan Cameron 	if (ret < 0)
1338c006ec83SJonathan Cameron 		return ret;
1339c006ec83SJonathan Cameron 	attrcount += ret;
1340c006ec83SJonathan Cameron 
134151239600SJonathan Cameron 	ret = iio_device_add_info_mask_type_avail(indio_dev, chan,
134251239600SJonathan Cameron 						  IIO_SHARED_BY_ALL,
134351239600SJonathan Cameron 						  &chan->info_mask_shared_by_all_available);
134451239600SJonathan Cameron 	if (ret < 0)
134551239600SJonathan Cameron 		return ret;
134651239600SJonathan Cameron 	attrcount += ret;
134751239600SJonathan Cameron 
13481d4ef9b3SCristian Pop 	ret = iio_device_add_channel_label(indio_dev, chan);
13491d4ef9b3SCristian Pop 	if (ret < 0)
13501d4ef9b3SCristian Pop 		return ret;
13511d4ef9b3SCristian Pop 	attrcount += ret;
13521d4ef9b3SCristian Pop 
1353a980e046SJonathan Cameron 	if (chan->ext_info) {
1354a980e046SJonathan Cameron 		unsigned int i = 0;
13559d9ec8d0SJoe Simmons-Talbott 
1356a980e046SJonathan Cameron 		for (ext_info = chan->ext_info; ext_info->name; ext_info++) {
1357a980e046SJonathan Cameron 			ret = __iio_add_chan_devattr(ext_info->name,
1358a980e046SJonathan Cameron 					chan,
1359a980e046SJonathan Cameron 					ext_info->read ?
1360a980e046SJonathan Cameron 					    &iio_read_channel_ext_info : NULL,
1361a980e046SJonathan Cameron 					ext_info->write ?
1362a980e046SJonathan Cameron 					    &iio_write_channel_ext_info : NULL,
1363a980e046SJonathan Cameron 					i,
1364a980e046SJonathan Cameron 					ext_info->shared,
1365a980e046SJonathan Cameron 					&indio_dev->dev,
13663e3d11b2SAlexandru Ardelean 					NULL,
1367207c2d27SAlexandru Ardelean 					&iio_dev_opaque->channel_attr_list);
1368a980e046SJonathan Cameron 			i++;
1369a980e046SJonathan Cameron 			if (ret == -EBUSY && ext_info->shared)
1370a980e046SJonathan Cameron 				continue;
1371a980e046SJonathan Cameron 
1372a980e046SJonathan Cameron 			if (ret)
13733704432fSJonathan Cameron 				return ret;
1374a980e046SJonathan Cameron 
1375a980e046SJonathan Cameron 			attrcount++;
1376a980e046SJonathan Cameron 		}
1377a980e046SJonathan Cameron 	}
1378a980e046SJonathan Cameron 
13793704432fSJonathan Cameron 	return attrcount;
1380a980e046SJonathan Cameron }
1381a980e046SJonathan Cameron 
138284088ebdSLars-Peter Clausen /**
138384088ebdSLars-Peter Clausen  * iio_free_chan_devattr_list() - Free a list of IIO device attributes
138484088ebdSLars-Peter Clausen  * @attr_list: List of IIO device attributes
138584088ebdSLars-Peter Clausen  *
138684088ebdSLars-Peter Clausen  * This function frees the memory allocated for each of the IIO device
1387c1b03ab5SMartin Fuzzey  * attributes in the list.
138884088ebdSLars-Peter Clausen  */
138984088ebdSLars-Peter Clausen void iio_free_chan_devattr_list(struct list_head *attr_list)
1390a980e046SJonathan Cameron {
139184088ebdSLars-Peter Clausen 	struct iio_dev_attr *p, *n;
139284088ebdSLars-Peter Clausen 
139384088ebdSLars-Peter Clausen 	list_for_each_entry_safe(p, n, attr_list, l) {
139415097c7aSAlexandru Ardelean 		kfree_const(p->dev_attr.attr.name);
1395c1b03ab5SMartin Fuzzey 		list_del(&p->l);
1396a980e046SJonathan Cameron 		kfree(p);
1397a980e046SJonathan Cameron 	}
139884088ebdSLars-Peter Clausen }
1399a980e046SJonathan Cameron 
14009cf0b618SJoe Simmons-Talbott static ssize_t name_show(struct device *dev, struct device_attribute *attr,
1401a980e046SJonathan Cameron 			 char *buf)
1402a980e046SJonathan Cameron {
1403e53f5ac5SLars-Peter Clausen 	struct iio_dev *indio_dev = dev_to_iio_dev(dev);
14049d9ec8d0SJoe Simmons-Talbott 
140583ca56b6SLars-Peter Clausen 	return sysfs_emit(buf, "%s\n", indio_dev->name);
1406a980e046SJonathan Cameron }
1407a980e046SJonathan Cameron 
14089cf0b618SJoe Simmons-Talbott static DEVICE_ATTR_RO(name);
1409a980e046SJonathan Cameron 
14109cf0b618SJoe Simmons-Talbott static ssize_t label_show(struct device *dev, struct device_attribute *attr,
14112c3d0c9fSPhil Reid 			  char *buf)
14122c3d0c9fSPhil Reid {
14132c3d0c9fSPhil Reid 	struct iio_dev *indio_dev = dev_to_iio_dev(dev);
14149d9ec8d0SJoe Simmons-Talbott 
141583ca56b6SLars-Peter Clausen 	return sysfs_emit(buf, "%s\n", indio_dev->label);
14162c3d0c9fSPhil Reid }
14172c3d0c9fSPhil Reid 
14189cf0b618SJoe Simmons-Talbott static DEVICE_ATTR_RO(label);
14192c3d0c9fSPhil Reid 
1420971ddd4bSAndy Shevchenko static const char * const clock_names[] = {
1421971ddd4bSAndy Shevchenko 	[CLOCK_REALTIME]	 	= "realtime",
1422971ddd4bSAndy Shevchenko 	[CLOCK_MONOTONIC]	 	= "monotonic",
1423971ddd4bSAndy Shevchenko 	[CLOCK_PROCESS_CPUTIME_ID]	= "process_cputime_id",
1424971ddd4bSAndy Shevchenko 	[CLOCK_THREAD_CPUTIME_ID]	= "thread_cputime_id",
1425971ddd4bSAndy Shevchenko 	[CLOCK_MONOTONIC_RAW]	 	= "monotonic_raw",
1426971ddd4bSAndy Shevchenko 	[CLOCK_REALTIME_COARSE]	 	= "realtime_coarse",
1427971ddd4bSAndy Shevchenko 	[CLOCK_MONOTONIC_COARSE] 	= "monotonic_coarse",
1428971ddd4bSAndy Shevchenko 	[CLOCK_BOOTTIME]	 	= "boottime",
1429971ddd4bSAndy Shevchenko 	[CLOCK_REALTIME_ALARM]		= "realtime_alarm",
1430971ddd4bSAndy Shevchenko 	[CLOCK_BOOTTIME_ALARM]		= "boottime_alarm",
1431971ddd4bSAndy Shevchenko 	[CLOCK_SGI_CYCLE]		= "sgi_cycle",
1432971ddd4bSAndy Shevchenko 	[CLOCK_TAI]		 	= "tai",
1433971ddd4bSAndy Shevchenko };
1434971ddd4bSAndy Shevchenko 
14359cf0b618SJoe Simmons-Talbott static ssize_t current_timestamp_clock_show(struct device *dev,
1436bc2b7dabSGregor Boirie 					    struct device_attribute *attr,
1437bc2b7dabSGregor Boirie 					    char *buf)
1438bc2b7dabSGregor Boirie {
1439bc2b7dabSGregor Boirie 	const struct iio_dev *indio_dev = dev_to_iio_dev(dev);
1440bc2b7dabSGregor Boirie 	const clockid_t clk = iio_device_get_clock(indio_dev);
1441bc2b7dabSGregor Boirie 
1442bc2b7dabSGregor Boirie 	switch (clk) {
1443bc2b7dabSGregor Boirie 	case CLOCK_REALTIME:
1444bc2b7dabSGregor Boirie 	case CLOCK_MONOTONIC:
1445bc2b7dabSGregor Boirie 	case CLOCK_MONOTONIC_RAW:
1446bc2b7dabSGregor Boirie 	case CLOCK_REALTIME_COARSE:
1447bc2b7dabSGregor Boirie 	case CLOCK_MONOTONIC_COARSE:
1448bc2b7dabSGregor Boirie 	case CLOCK_BOOTTIME:
1449bc2b7dabSGregor Boirie 	case CLOCK_TAI:
1450bc2b7dabSGregor Boirie 		break;
1451bc2b7dabSGregor Boirie 	default:
1452bc2b7dabSGregor Boirie 		BUG();
1453bc2b7dabSGregor Boirie 	}
1454bc2b7dabSGregor Boirie 
1455971ddd4bSAndy Shevchenko 	return sysfs_emit(buf, "%s\n", clock_names[clk]);
1456bc2b7dabSGregor Boirie }
1457bc2b7dabSGregor Boirie 
14589cf0b618SJoe Simmons-Talbott static ssize_t current_timestamp_clock_store(struct device *dev,
1459bc2b7dabSGregor Boirie 					     struct device_attribute *attr,
1460bc2b7dabSGregor Boirie 					     const char *buf, size_t len)
1461bc2b7dabSGregor Boirie {
1462bc2b7dabSGregor Boirie 	clockid_t clk;
1463bc2b7dabSGregor Boirie 	int ret;
1464bc2b7dabSGregor Boirie 
1465971ddd4bSAndy Shevchenko 	ret = sysfs_match_string(clock_names, buf);
1466971ddd4bSAndy Shevchenko 	if (ret < 0)
1467971ddd4bSAndy Shevchenko 		return ret;
1468971ddd4bSAndy Shevchenko 	clk = ret;
1469971ddd4bSAndy Shevchenko 
1470971ddd4bSAndy Shevchenko 	switch (clk) {
1471971ddd4bSAndy Shevchenko 	case CLOCK_REALTIME:
1472971ddd4bSAndy Shevchenko 	case CLOCK_MONOTONIC:
1473971ddd4bSAndy Shevchenko 	case CLOCK_MONOTONIC_RAW:
1474971ddd4bSAndy Shevchenko 	case CLOCK_REALTIME_COARSE:
1475971ddd4bSAndy Shevchenko 	case CLOCK_MONOTONIC_COARSE:
1476971ddd4bSAndy Shevchenko 	case CLOCK_BOOTTIME:
1477971ddd4bSAndy Shevchenko 	case CLOCK_TAI:
1478971ddd4bSAndy Shevchenko 		break;
1479971ddd4bSAndy Shevchenko 	default:
1480bc2b7dabSGregor Boirie 		return -EINVAL;
1481971ddd4bSAndy Shevchenko 	}
1482bc2b7dabSGregor Boirie 
1483bc2b7dabSGregor Boirie 	ret = iio_device_set_clock(dev_to_iio_dev(dev), clk);
1484bc2b7dabSGregor Boirie 	if (ret)
1485bc2b7dabSGregor Boirie 		return ret;
1486bc2b7dabSGregor Boirie 
1487bc2b7dabSGregor Boirie 	return len;
1488bc2b7dabSGregor Boirie }
1489bc2b7dabSGregor Boirie 
149032f17172SAlexandru Ardelean int iio_device_register_sysfs_group(struct iio_dev *indio_dev,
149132f17172SAlexandru Ardelean 				    const struct attribute_group *group)
149232f17172SAlexandru Ardelean {
149332f17172SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
149432f17172SAlexandru Ardelean 	const struct attribute_group **new, **old = iio_dev_opaque->groups;
149532f17172SAlexandru Ardelean 	unsigned int cnt = iio_dev_opaque->groupcounter;
149632f17172SAlexandru Ardelean 
14975a0821e0SAndy Shevchenko 	new = krealloc_array(old, cnt + 2, sizeof(*new), GFP_KERNEL);
149832f17172SAlexandru Ardelean 	if (!new)
149932f17172SAlexandru Ardelean 		return -ENOMEM;
150032f17172SAlexandru Ardelean 
150132f17172SAlexandru Ardelean 	new[iio_dev_opaque->groupcounter++] = group;
150232f17172SAlexandru Ardelean 	new[iio_dev_opaque->groupcounter] = NULL;
150332f17172SAlexandru Ardelean 
150432f17172SAlexandru Ardelean 	iio_dev_opaque->groups = new;
150532f17172SAlexandru Ardelean 
150632f17172SAlexandru Ardelean 	return 0;
150732f17172SAlexandru Ardelean }
150832f17172SAlexandru Ardelean 
15099cf0b618SJoe Simmons-Talbott static DEVICE_ATTR_RW(current_timestamp_clock);
1510bc2b7dabSGregor Boirie 
1511a980e046SJonathan Cameron static int iio_device_register_sysfs(struct iio_dev *indio_dev)
1512a980e046SJonathan Cameron {
1513207c2d27SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
1514a980e046SJonathan Cameron 	int i, ret = 0, attrcount, attrn, attrcount_orig = 0;
151584088ebdSLars-Peter Clausen 	struct iio_dev_attr *p;
1516bc2b7dabSGregor Boirie 	struct attribute **attr, *clk = NULL;
1517a980e046SJonathan Cameron 
1518a980e046SJonathan Cameron 	/* First count elements in any existing group */
1519a980e046SJonathan Cameron 	if (indio_dev->info->attrs) {
1520a980e046SJonathan Cameron 		attr = indio_dev->info->attrs->attrs;
1521a980e046SJonathan Cameron 		while (*attr++ != NULL)
1522a980e046SJonathan Cameron 			attrcount_orig++;
1523a980e046SJonathan Cameron 	}
1524a980e046SJonathan Cameron 	attrcount = attrcount_orig;
1525a980e046SJonathan Cameron 	/*
1526a980e046SJonathan Cameron 	 * New channel registration method - relies on the fact a group does
1527d25b3808SPeter Meerwald 	 * not need to be initialized if its name is NULL.
1528a980e046SJonathan Cameron 	 */
1529a980e046SJonathan Cameron 	if (indio_dev->channels)
1530a980e046SJonathan Cameron 		for (i = 0; i < indio_dev->num_channels; i++) {
1531bc2b7dabSGregor Boirie 			const struct iio_chan_spec *chan =
1532bc2b7dabSGregor Boirie 				&indio_dev->channels[i];
1533bc2b7dabSGregor Boirie 
1534bc2b7dabSGregor Boirie 			if (chan->type == IIO_TIMESTAMP)
1535bc2b7dabSGregor Boirie 				clk = &dev_attr_current_timestamp_clock.attr;
1536bc2b7dabSGregor Boirie 
1537bc2b7dabSGregor Boirie 			ret = iio_device_add_channel_sysfs(indio_dev, chan);
1538a980e046SJonathan Cameron 			if (ret < 0)
1539a980e046SJonathan Cameron 				goto error_clear_attrs;
1540a980e046SJonathan Cameron 			attrcount += ret;
1541a980e046SJonathan Cameron 		}
1542a980e046SJonathan Cameron 
1543fa83c3baSAlexandru Ardelean 	if (iio_dev_opaque->event_interface)
1544bc2b7dabSGregor Boirie 		clk = &dev_attr_current_timestamp_clock.attr;
1545bc2b7dabSGregor Boirie 
1546a980e046SJonathan Cameron 	if (indio_dev->name)
1547a980e046SJonathan Cameron 		attrcount++;
15482c3d0c9fSPhil Reid 	if (indio_dev->label)
15492c3d0c9fSPhil Reid 		attrcount++;
1550bc2b7dabSGregor Boirie 	if (clk)
1551bc2b7dabSGregor Boirie 		attrcount++;
1552a980e046SJonathan Cameron 
1553207c2d27SAlexandru Ardelean 	iio_dev_opaque->chan_attr_group.attrs =
1554207c2d27SAlexandru Ardelean 		kcalloc(attrcount + 1,
1555207c2d27SAlexandru Ardelean 			sizeof(iio_dev_opaque->chan_attr_group.attrs[0]),
1556a980e046SJonathan Cameron 			GFP_KERNEL);
1557207c2d27SAlexandru Ardelean 	if (iio_dev_opaque->chan_attr_group.attrs == NULL) {
1558a980e046SJonathan Cameron 		ret = -ENOMEM;
1559a980e046SJonathan Cameron 		goto error_clear_attrs;
1560a980e046SJonathan Cameron 	}
1561e0d27ea3SAndrea Merello 	/* Copy across original attributes, and point to original binary attributes */
156218b4c9cdSHans de Goede 	if (indio_dev->info->attrs) {
1563207c2d27SAlexandru Ardelean 		memcpy(iio_dev_opaque->chan_attr_group.attrs,
1564a980e046SJonathan Cameron 		       indio_dev->info->attrs->attrs,
1565207c2d27SAlexandru Ardelean 		       sizeof(iio_dev_opaque->chan_attr_group.attrs[0])
1566a980e046SJonathan Cameron 		       *attrcount_orig);
156718b4c9cdSHans de Goede 		iio_dev_opaque->chan_attr_group.is_visible =
156818b4c9cdSHans de Goede 			indio_dev->info->attrs->is_visible;
1569e0d27ea3SAndrea Merello 		iio_dev_opaque->chan_attr_group.bin_attrs =
1570e0d27ea3SAndrea Merello 			indio_dev->info->attrs->bin_attrs;
157118b4c9cdSHans de Goede 	}
1572a980e046SJonathan Cameron 	attrn = attrcount_orig;
1573a980e046SJonathan Cameron 	/* Add all elements from the list. */
1574207c2d27SAlexandru Ardelean 	list_for_each_entry(p, &iio_dev_opaque->channel_attr_list, l)
1575207c2d27SAlexandru Ardelean 		iio_dev_opaque->chan_attr_group.attrs[attrn++] = &p->dev_attr.attr;
1576a980e046SJonathan Cameron 	if (indio_dev->name)
1577207c2d27SAlexandru Ardelean 		iio_dev_opaque->chan_attr_group.attrs[attrn++] = &dev_attr_name.attr;
15782c3d0c9fSPhil Reid 	if (indio_dev->label)
1579207c2d27SAlexandru Ardelean 		iio_dev_opaque->chan_attr_group.attrs[attrn++] = &dev_attr_label.attr;
1580bc2b7dabSGregor Boirie 	if (clk)
1581207c2d27SAlexandru Ardelean 		iio_dev_opaque->chan_attr_group.attrs[attrn++] = clk;
1582a980e046SJonathan Cameron 
158332f17172SAlexandru Ardelean 	ret = iio_device_register_sysfs_group(indio_dev,
158432f17172SAlexandru Ardelean 					      &iio_dev_opaque->chan_attr_group);
158532f17172SAlexandru Ardelean 	if (ret)
158695a0d596SDinghao Liu 		goto error_free_chan_attrs;
1587a980e046SJonathan Cameron 
1588a980e046SJonathan Cameron 	return 0;
1589a980e046SJonathan Cameron 
159095a0d596SDinghao Liu error_free_chan_attrs:
159195a0d596SDinghao Liu 	kfree(iio_dev_opaque->chan_attr_group.attrs);
159295a0d596SDinghao Liu 	iio_dev_opaque->chan_attr_group.attrs = NULL;
1593a980e046SJonathan Cameron error_clear_attrs:
1594207c2d27SAlexandru Ardelean 	iio_free_chan_devattr_list(&iio_dev_opaque->channel_attr_list);
1595a980e046SJonathan Cameron 
1596a980e046SJonathan Cameron 	return ret;
1597a980e046SJonathan Cameron }
1598a980e046SJonathan Cameron 
1599a980e046SJonathan Cameron static void iio_device_unregister_sysfs(struct iio_dev *indio_dev)
1600a980e046SJonathan Cameron {
1601207c2d27SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
1602a980e046SJonathan Cameron 
1603207c2d27SAlexandru Ardelean 	iio_free_chan_devattr_list(&iio_dev_opaque->channel_attr_list);
1604207c2d27SAlexandru Ardelean 	kfree(iio_dev_opaque->chan_attr_group.attrs);
1605207c2d27SAlexandru Ardelean 	iio_dev_opaque->chan_attr_group.attrs = NULL;
160632f17172SAlexandru Ardelean 	kfree(iio_dev_opaque->groups);
160719833c40SYang Yingliang 	iio_dev_opaque->groups = NULL;
1608a980e046SJonathan Cameron }
1609a980e046SJonathan Cameron 
1610a980e046SJonathan Cameron static void iio_dev_release(struct device *device)
1611a980e046SJonathan Cameron {
1612e53f5ac5SLars-Peter Clausen 	struct iio_dev *indio_dev = dev_to_iio_dev(device);
16136d4ebd56SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
16146d4ebd56SAlexandru Ardelean 
1615d89e119aSBenjamin Gaignard 	if (indio_dev->modes & INDIO_ALL_TRIGGERED_MODES)
1616a980e046SJonathan Cameron 		iio_device_unregister_trigger_consumer(indio_dev);
1617a980e046SJonathan Cameron 	iio_device_unregister_eventset(indio_dev);
1618a980e046SJonathan Cameron 	iio_device_unregister_sysfs(indio_dev);
1619e407fd65SLars-Peter Clausen 
1620218bc53dSAlexandru Ardelean 	iio_device_detach_buffers(indio_dev);
16219e69c935SLars-Peter Clausen 
16222bc9cd66SVincent Whitchurch 	lockdep_unregister_key(&iio_dev_opaque->mlock_key);
16232bc9cd66SVincent Whitchurch 
1624319dbcd8Skeliu 	ida_free(&iio_ida, iio_dev_opaque->id);
16256d4ebd56SAlexandru Ardelean 	kfree(iio_dev_opaque);
1626a980e046SJonathan Cameron }
1627a980e046SJonathan Cameron 
16283c33b7b8SLars-Peter Clausen const struct device_type iio_device_type = {
1629a980e046SJonathan Cameron 	.name = "iio_device",
1630a980e046SJonathan Cameron 	.release = iio_dev_release,
1631a980e046SJonathan Cameron };
1632a980e046SJonathan Cameron 
1633a7e57dceSSachin Kamat /**
1634a7e57dceSSachin Kamat  * iio_device_alloc() - allocate an iio_dev from a driver
1635c9561fd2SJonathan Cameron  * @parent:		Parent device.
1636a7e57dceSSachin Kamat  * @sizeof_priv:	Space to allocate for private structure.
163765659a8dSAndy Shevchenko  *
163865659a8dSAndy Shevchenko  * Returns:
163965659a8dSAndy Shevchenko  * Pointer to allocated iio_dev on success, NULL on failure.
164065659a8dSAndy Shevchenko  */
164178289b4aSAlexandru Ardelean struct iio_dev *iio_device_alloc(struct device *parent, int sizeof_priv)
1642a980e046SJonathan Cameron {
16436d4ebd56SAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque;
16440d596bb2SAlexandru Ardelean 	struct iio_dev *indio_dev;
1645a980e046SJonathan Cameron 	size_t alloc_size;
1646a980e046SJonathan Cameron 
16475c4e4115SAndy Shevchenko 	if (sizeof_priv)
16485c4e4115SAndy Shevchenko 		alloc_size = ALIGN(sizeof(*iio_dev_opaque), IIO_DMA_MINALIGN) + sizeof_priv;
16495c4e4115SAndy Shevchenko 	else
16505c4e4115SAndy Shevchenko 		alloc_size = sizeof(*iio_dev_opaque);
1651a980e046SJonathan Cameron 
16526d4ebd56SAlexandru Ardelean 	iio_dev_opaque = kzalloc(alloc_size, GFP_KERNEL);
16536d4ebd56SAlexandru Ardelean 	if (!iio_dev_opaque)
16540d4b2184SJonathan Cameron 		return NULL;
1655a980e046SJonathan Cameron 
16560d596bb2SAlexandru Ardelean 	indio_dev = &iio_dev_opaque->indio_dev;
1657f0245ab3SAndy Shevchenko 
1658f0245ab3SAndy Shevchenko 	if (sizeof_priv)
16590d596bb2SAlexandru Ardelean 		indio_dev->priv = (char *)iio_dev_opaque +
1660f0245ab3SAndy Shevchenko 			ALIGN(sizeof(*iio_dev_opaque), IIO_DMA_MINALIGN);
16616d4ebd56SAlexandru Ardelean 
16620d596bb2SAlexandru Ardelean 	indio_dev->dev.parent = parent;
16630d596bb2SAlexandru Ardelean 	indio_dev->dev.type = &iio_device_type;
16640d596bb2SAlexandru Ardelean 	indio_dev->dev.bus = &iio_bus_type;
16650d596bb2SAlexandru Ardelean 	device_initialize(&indio_dev->dev);
166616afe125SNuno Sá 	mutex_init(&iio_dev_opaque->mlock);
1667b804e2b7SJonathan Cameron 	mutex_init(&iio_dev_opaque->info_exist_lock);
1668207c2d27SAlexandru Ardelean 	INIT_LIST_HEAD(&iio_dev_opaque->channel_attr_list);
1669a980e046SJonathan Cameron 
1670319dbcd8Skeliu 	iio_dev_opaque->id = ida_alloc(&iio_ida, GFP_KERNEL);
167115ea2878SJonathan Cameron 	if (iio_dev_opaque->id < 0) {
1672a980e046SJonathan Cameron 		/* cannot use a dev_err as the name isn't available */
16733176dd5dSSachin Kamat 		pr_err("failed to get device id\n");
16746d4ebd56SAlexandru Ardelean 		kfree(iio_dev_opaque);
1675a980e046SJonathan Cameron 		return NULL;
1676a980e046SJonathan Cameron 	}
1677fe6f45f6SYang Yingliang 
1678fe6f45f6SYang Yingliang 	if (dev_set_name(&indio_dev->dev, "iio:device%d", iio_dev_opaque->id)) {
1679319dbcd8Skeliu 		ida_free(&iio_ida, iio_dev_opaque->id);
1680fe6f45f6SYang Yingliang 		kfree(iio_dev_opaque);
1681fe6f45f6SYang Yingliang 		return NULL;
1682fe6f45f6SYang Yingliang 	}
1683fe6f45f6SYang Yingliang 
16846a8c6b26SAlexandru Ardelean 	INIT_LIST_HEAD(&iio_dev_opaque->buffer_list);
16858dedcc3eSAlexandru Ardelean 	INIT_LIST_HEAD(&iio_dev_opaque->ioctl_handlers);
1686a980e046SJonathan Cameron 
16872bc9cd66SVincent Whitchurch 	lockdep_register_key(&iio_dev_opaque->mlock_key);
168816afe125SNuno Sá 	lockdep_set_class(&iio_dev_opaque->mlock, &iio_dev_opaque->mlock_key);
16892bc9cd66SVincent Whitchurch 
16900d596bb2SAlexandru Ardelean 	return indio_dev;
1691a980e046SJonathan Cameron }
16927cbb7537SLars-Peter Clausen EXPORT_SYMBOL(iio_device_alloc);
1693a980e046SJonathan Cameron 
1694a7e57dceSSachin Kamat /**
1695a7e57dceSSachin Kamat  * iio_device_free() - free an iio_dev from a driver
1696a7e57dceSSachin Kamat  * @dev:		the iio_dev associated with the device
169765659a8dSAndy Shevchenko  */
16987cbb7537SLars-Peter Clausen void iio_device_free(struct iio_dev *dev)
1699a980e046SJonathan Cameron {
1700e407fd65SLars-Peter Clausen 	if (dev)
1701e407fd65SLars-Peter Clausen 		put_device(&dev->dev);
1702a980e046SJonathan Cameron }
17037cbb7537SLars-Peter Clausen EXPORT_SYMBOL(iio_device_free);
1704a980e046SJonathan Cameron 
1705cf5724e9SYicong Yang static void devm_iio_device_release(void *iio_dev)
17069dabaf5eSGrygorii Strashko {
1707cf5724e9SYicong Yang 	iio_device_free(iio_dev);
17089dabaf5eSGrygorii Strashko }
17099dabaf5eSGrygorii Strashko 
1710a7e57dceSSachin Kamat /**
1711a7e57dceSSachin Kamat  * devm_iio_device_alloc - Resource-managed iio_device_alloc()
171278289b4aSAlexandru Ardelean  * @parent:		Device to allocate iio_dev for, and parent for this IIO device
1713a7e57dceSSachin Kamat  * @sizeof_priv:	Space to allocate for private structure.
1714a7e57dceSSachin Kamat  *
1715a7e57dceSSachin Kamat  * Managed iio_device_alloc. iio_dev allocated with this function is
1716a7e57dceSSachin Kamat  * automatically freed on driver detach.
1717a7e57dceSSachin Kamat  *
171865659a8dSAndy Shevchenko  * Returns:
1719a7e57dceSSachin Kamat  * Pointer to allocated iio_dev on success, NULL on failure.
1720a7e57dceSSachin Kamat  */
172178289b4aSAlexandru Ardelean struct iio_dev *devm_iio_device_alloc(struct device *parent, int sizeof_priv)
17229dabaf5eSGrygorii Strashko {
1723cf5724e9SYicong Yang 	struct iio_dev *iio_dev;
1724cf5724e9SYicong Yang 	int ret;
17259dabaf5eSGrygorii Strashko 
172678289b4aSAlexandru Ardelean 	iio_dev = iio_device_alloc(parent, sizeof_priv);
1727cf5724e9SYicong Yang 	if (!iio_dev)
1728cf5724e9SYicong Yang 		return NULL;
1729cf5724e9SYicong Yang 
1730cf5724e9SYicong Yang 	ret = devm_add_action_or_reset(parent, devm_iio_device_release,
1731cf5724e9SYicong Yang 				       iio_dev);
1732cf5724e9SYicong Yang 	if (ret)
173343fa7394SDan Carpenter 		return NULL;
17349dabaf5eSGrygorii Strashko 
17359dabaf5eSGrygorii Strashko 	return iio_dev;
17369dabaf5eSGrygorii Strashko }
17379dabaf5eSGrygorii Strashko EXPORT_SYMBOL_GPL(devm_iio_device_alloc);
17389dabaf5eSGrygorii Strashko 
1739a7e57dceSSachin Kamat /**
1740a980e046SJonathan Cameron  * iio_chrdev_open() - chrdev file open for buffer access and ioctls
17412498dcf6SCristina Opriceana  * @inode:	Inode structure for identifying the device in the file system
17422498dcf6SCristina Opriceana  * @filp:	File structure for iio device used to keep and later access
17432498dcf6SCristina Opriceana  *		private data
17442498dcf6SCristina Opriceana  *
174565659a8dSAndy Shevchenko  * Returns: 0 on success or -EBUSY if the device is already opened
174665659a8dSAndy Shevchenko  */
1747a980e046SJonathan Cameron static int iio_chrdev_open(struct inode *inode, struct file *filp)
1748a980e046SJonathan Cameron {
1749396f7234SJonathan Cameron 	struct iio_dev_opaque *iio_dev_opaque =
1750396f7234SJonathan Cameron 		container_of(inode->i_cdev, struct iio_dev_opaque, chrdev);
1751396f7234SJonathan Cameron 	struct iio_dev *indio_dev = &iio_dev_opaque->indio_dev;
1752be24dcb1SAlexandru Ardelean 	struct iio_dev_buffer_pair *ib;
1753a980e046SJonathan Cameron 
17548b1c82cbSJonathan Cameron 	if (test_and_set_bit(IIO_BUSY_BIT_POS, &iio_dev_opaque->flags))
1755a980e046SJonathan Cameron 		return -EBUSY;
1756a980e046SJonathan Cameron 
1757cadc2125SLars-Peter Clausen 	iio_device_get(indio_dev);
1758cadc2125SLars-Peter Clausen 
1759be24dcb1SAlexandru Ardelean 	ib = kmalloc(sizeof(*ib), GFP_KERNEL);
1760be24dcb1SAlexandru Ardelean 	if (!ib) {
1761be24dcb1SAlexandru Ardelean 		iio_device_put(indio_dev);
17628b1c82cbSJonathan Cameron 		clear_bit(IIO_BUSY_BIT_POS, &iio_dev_opaque->flags);
1763be24dcb1SAlexandru Ardelean 		return -ENOMEM;
1764be24dcb1SAlexandru Ardelean 	}
1765be24dcb1SAlexandru Ardelean 
1766be24dcb1SAlexandru Ardelean 	ib->indio_dev = indio_dev;
1767be24dcb1SAlexandru Ardelean 	ib->buffer = indio_dev->buffer;
1768be24dcb1SAlexandru Ardelean 
1769be24dcb1SAlexandru Ardelean 	filp->private_data = ib;
1770a980e046SJonathan Cameron 
1771a980e046SJonathan Cameron 	return 0;
1772a980e046SJonathan Cameron }
1773a980e046SJonathan Cameron 
1774a980e046SJonathan Cameron /**
1775a980e046SJonathan Cameron  * iio_chrdev_release() - chrdev file close buffer access and ioctls
17762498dcf6SCristina Opriceana  * @inode:	Inode structure pointer for the char device
17772498dcf6SCristina Opriceana  * @filp:	File structure pointer for the char device
17782498dcf6SCristina Opriceana  *
177965659a8dSAndy Shevchenko  * Returns: 0 for successful release.
17802498dcf6SCristina Opriceana  */
1781a980e046SJonathan Cameron static int iio_chrdev_release(struct inode *inode, struct file *filp)
1782a980e046SJonathan Cameron {
1783be24dcb1SAlexandru Ardelean 	struct iio_dev_buffer_pair *ib = filp->private_data;
1784396f7234SJonathan Cameron 	struct iio_dev_opaque *iio_dev_opaque =
1785396f7234SJonathan Cameron 		container_of(inode->i_cdev, struct iio_dev_opaque, chrdev);
1786396f7234SJonathan Cameron 	struct iio_dev *indio_dev = &iio_dev_opaque->indio_dev;
17879d9ec8d0SJoe Simmons-Talbott 
1788be24dcb1SAlexandru Ardelean 	kfree(ib);
17898b1c82cbSJonathan Cameron 	clear_bit(IIO_BUSY_BIT_POS, &iio_dev_opaque->flags);
1790cadc2125SLars-Peter Clausen 	iio_device_put(indio_dev);
1791cadc2125SLars-Peter Clausen 
1792a980e046SJonathan Cameron 	return 0;
1793a980e046SJonathan Cameron }
1794a980e046SJonathan Cameron 
17958dedcc3eSAlexandru Ardelean void iio_device_ioctl_handler_register(struct iio_dev *indio_dev,
17968dedcc3eSAlexandru Ardelean 				       struct iio_ioctl_handler *h)
17978dedcc3eSAlexandru Ardelean {
17988dedcc3eSAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
17998dedcc3eSAlexandru Ardelean 
18008dedcc3eSAlexandru Ardelean 	list_add_tail(&h->entry, &iio_dev_opaque->ioctl_handlers);
18018dedcc3eSAlexandru Ardelean }
18028dedcc3eSAlexandru Ardelean 
18038dedcc3eSAlexandru Ardelean void iio_device_ioctl_handler_unregister(struct iio_ioctl_handler *h)
18048dedcc3eSAlexandru Ardelean {
18058dedcc3eSAlexandru Ardelean 	list_del(&h->entry);
18068dedcc3eSAlexandru Ardelean }
18078dedcc3eSAlexandru Ardelean 
1808a980e046SJonathan Cameron static long iio_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
1809a980e046SJonathan Cameron {
1810be24dcb1SAlexandru Ardelean 	struct iio_dev_buffer_pair *ib = filp->private_data;
1811be24dcb1SAlexandru Ardelean 	struct iio_dev *indio_dev = ib->indio_dev;
18128dedcc3eSAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
18138dedcc3eSAlexandru Ardelean 	struct iio_ioctl_handler *h;
1814*42ea5992SNuno Sa 	int ret;
1815a980e046SJonathan Cameron 
1816*42ea5992SNuno Sa 	guard(mutex)(&iio_dev_opaque->info_exist_lock);
181765659a8dSAndy Shevchenko 	/*
18188dedcc3eSAlexandru Ardelean 	 * The NULL check here is required to prevent crashing when a device
18198dedcc3eSAlexandru Ardelean 	 * is being removed while userspace would still have open file handles
18208dedcc3eSAlexandru Ardelean 	 * to try to access this device.
18218dedcc3eSAlexandru Ardelean 	 */
1822f18e7a06SLars-Peter Clausen 	if (!indio_dev->info)
1823*42ea5992SNuno Sa 		return -ENODEV;
1824f18e7a06SLars-Peter Clausen 
18258dedcc3eSAlexandru Ardelean 	list_for_each_entry(h, &iio_dev_opaque->ioctl_handlers, entry) {
18268dedcc3eSAlexandru Ardelean 		ret = h->ioctl(indio_dev, filp, cmd, arg);
18278dedcc3eSAlexandru Ardelean 		if (ret != IIO_IOCTL_UNHANDLED)
1828*42ea5992SNuno Sa 			return ret;
1829a980e046SJonathan Cameron 	}
18308dedcc3eSAlexandru Ardelean 
1831*42ea5992SNuno Sa 	return -ENODEV;
1832a980e046SJonathan Cameron }
1833a980e046SJonathan Cameron 
1834a980e046SJonathan Cameron static const struct file_operations iio_buffer_fileops = {
1835a980e046SJonathan Cameron 	.owner = THIS_MODULE,
1836a980e046SJonathan Cameron 	.llseek = noop_llseek,
1837ee8caea0SAlexandru Ardelean 	.read = iio_buffer_read_outer_addr,
18389eeee3b0SMihail Chindris 	.write = iio_buffer_write_outer_addr,
1839ee8caea0SAlexandru Ardelean 	.poll = iio_buffer_poll_addr,
1840a980e046SJonathan Cameron 	.unlocked_ioctl = iio_ioctl,
18411832f2d8SArnd Bergmann 	.compat_ioctl = compat_ptr_ioctl,
1842ee8caea0SAlexandru Ardelean 	.open = iio_chrdev_open,
1843ee8caea0SAlexandru Ardelean 	.release = iio_chrdev_release,
1844a980e046SJonathan Cameron };
1845a980e046SJonathan Cameron 
18468ebaa3ffSAlexandru Ardelean static const struct file_operations iio_event_fileops = {
18478ebaa3ffSAlexandru Ardelean 	.owner = THIS_MODULE,
18488ebaa3ffSAlexandru Ardelean 	.llseek = noop_llseek,
18498ebaa3ffSAlexandru Ardelean 	.unlocked_ioctl = iio_ioctl,
18508ebaa3ffSAlexandru Ardelean 	.compat_ioctl = compat_ptr_ioctl,
18518ebaa3ffSAlexandru Ardelean 	.open = iio_chrdev_open,
18528ebaa3ffSAlexandru Ardelean 	.release = iio_chrdev_release,
18538ebaa3ffSAlexandru Ardelean };
18548ebaa3ffSAlexandru Ardelean 
18558f5d8727SVlad Dogaru static int iio_check_unique_scan_index(struct iio_dev *indio_dev)
18568f5d8727SVlad Dogaru {
18578f5d8727SVlad Dogaru 	int i, j;
18588f5d8727SVlad Dogaru 	const struct iio_chan_spec *channels = indio_dev->channels;
18598f5d8727SVlad Dogaru 
18608f5d8727SVlad Dogaru 	if (!(indio_dev->modes & INDIO_ALL_BUFFER_MODES))
18618f5d8727SVlad Dogaru 		return 0;
18628f5d8727SVlad Dogaru 
18638f5d8727SVlad Dogaru 	for (i = 0; i < indio_dev->num_channels - 1; i++) {
18648f5d8727SVlad Dogaru 		if (channels[i].scan_index < 0)
18658f5d8727SVlad Dogaru 			continue;
18668f5d8727SVlad Dogaru 		for (j = i + 1; j < indio_dev->num_channels; j++)
18678f5d8727SVlad Dogaru 			if (channels[i].scan_index == channels[j].scan_index) {
18688f5d8727SVlad Dogaru 				dev_err(&indio_dev->dev,
18698f5d8727SVlad Dogaru 					"Duplicate scan index %d\n",
18708f5d8727SVlad Dogaru 					channels[i].scan_index);
18718f5d8727SVlad Dogaru 				return -EINVAL;
18728f5d8727SVlad Dogaru 			}
18738f5d8727SVlad Dogaru 	}
18748f5d8727SVlad Dogaru 
18758f5d8727SVlad Dogaru 	return 0;
18768f5d8727SVlad Dogaru }
18778f5d8727SVlad Dogaru 
18780e0761f8SPaul Cercueil static int iio_check_extended_name(const struct iio_dev *indio_dev)
18790e0761f8SPaul Cercueil {
18800e0761f8SPaul Cercueil 	unsigned int i;
18810e0761f8SPaul Cercueil 
18820e0761f8SPaul Cercueil 	if (!indio_dev->info->read_label)
18830e0761f8SPaul Cercueil 		return 0;
18840e0761f8SPaul Cercueil 
18850e0761f8SPaul Cercueil 	for (i = 0; i < indio_dev->num_channels; i++) {
18860e0761f8SPaul Cercueil 		if (indio_dev->channels[i].extend_name) {
18870e0761f8SPaul Cercueil 			dev_err(&indio_dev->dev,
18880e0761f8SPaul Cercueil 				"Cannot use labels and extend_name at the same time\n");
18890e0761f8SPaul Cercueil 			return -EINVAL;
18900e0761f8SPaul Cercueil 		}
18910e0761f8SPaul Cercueil 	}
18920e0761f8SPaul Cercueil 
18930e0761f8SPaul Cercueil 	return 0;
18940e0761f8SPaul Cercueil }
18950e0761f8SPaul Cercueil 
1896a980e046SJonathan Cameron static const struct iio_buffer_setup_ops noop_ring_setup_ops;
1897a980e046SJonathan Cameron 
18982718f154SMatti Vaittinen static void iio_sanity_check_avail_scan_masks(struct iio_dev *indio_dev)
18992718f154SMatti Vaittinen {
19002718f154SMatti Vaittinen 	unsigned int num_masks, masklength, longs_per_mask;
19012718f154SMatti Vaittinen 	const unsigned long *av_masks;
19022718f154SMatti Vaittinen 	int i;
19032718f154SMatti Vaittinen 
19042718f154SMatti Vaittinen 	av_masks = indio_dev->available_scan_masks;
19052718f154SMatti Vaittinen 	masklength = indio_dev->masklength;
19062718f154SMatti Vaittinen 	longs_per_mask = BITS_TO_LONGS(masklength);
19072718f154SMatti Vaittinen 
19082718f154SMatti Vaittinen 	/*
19092718f154SMatti Vaittinen 	 * The code determining how many available_scan_masks is in the array
19102718f154SMatti Vaittinen 	 * will be assuming the end of masks when first long with all bits
19112718f154SMatti Vaittinen 	 * zeroed is encountered. This is incorrect for masks where mask
19122718f154SMatti Vaittinen 	 * consists of more than one long, and where some of the available masks
19132718f154SMatti Vaittinen 	 * has long worth of bits zeroed (but has subsequent bit(s) set). This
19142718f154SMatti Vaittinen 	 * is a safety measure against bug where array of masks is terminated by
19152718f154SMatti Vaittinen 	 * a single zero while mask width is greater than width of a long.
19162718f154SMatti Vaittinen 	 */
19172718f154SMatti Vaittinen 	if (longs_per_mask > 1)
19182718f154SMatti Vaittinen 		dev_warn(indio_dev->dev.parent,
19192718f154SMatti Vaittinen 			 "multi long available scan masks not fully supported\n");
19202718f154SMatti Vaittinen 
19212718f154SMatti Vaittinen 	if (bitmap_empty(av_masks, masklength))
19222718f154SMatti Vaittinen 		dev_warn(indio_dev->dev.parent, "empty scan mask\n");
19232718f154SMatti Vaittinen 
19242718f154SMatti Vaittinen 	for (num_masks = 0; *av_masks; num_masks++)
19252718f154SMatti Vaittinen 		av_masks += longs_per_mask;
19262718f154SMatti Vaittinen 
19272718f154SMatti Vaittinen 	if (num_masks < 2)
19282718f154SMatti Vaittinen 		return;
19292718f154SMatti Vaittinen 
19302718f154SMatti Vaittinen 	av_masks = indio_dev->available_scan_masks;
19312718f154SMatti Vaittinen 
19322718f154SMatti Vaittinen 	/*
19332718f154SMatti Vaittinen 	 * Go through all the masks from first to one before the last, and see
19342718f154SMatti Vaittinen 	 * that no mask found later from the available_scan_masks array is a
19352718f154SMatti Vaittinen 	 * subset of mask found earlier. If this happens, then the mask found
19362718f154SMatti Vaittinen 	 * later will never get used because scanning the array is stopped when
19372718f154SMatti Vaittinen 	 * the first suitable mask is found. Drivers should order the array of
19382718f154SMatti Vaittinen 	 * available masks in the order of preference (presumably the least
19392718f154SMatti Vaittinen 	 * costy to access masks first).
19402718f154SMatti Vaittinen 	 */
19412718f154SMatti Vaittinen 	for (i = 0; i < num_masks - 1; i++) {
19422718f154SMatti Vaittinen 		const unsigned long *mask1;
19432718f154SMatti Vaittinen 		int j;
19442718f154SMatti Vaittinen 
19452718f154SMatti Vaittinen 		mask1 = av_masks + i * longs_per_mask;
19462718f154SMatti Vaittinen 		for (j = i + 1; j < num_masks; j++) {
19472718f154SMatti Vaittinen 			const unsigned long *mask2;
19482718f154SMatti Vaittinen 
19492718f154SMatti Vaittinen 			mask2 = av_masks + j * longs_per_mask;
19502718f154SMatti Vaittinen 			if (bitmap_subset(mask2, mask1, masklength))
19512718f154SMatti Vaittinen 				dev_warn(indio_dev->dev.parent,
19522718f154SMatti Vaittinen 					 "available_scan_mask %d subset of %d. Never used\n",
19532718f154SMatti Vaittinen 					 j, i);
19542718f154SMatti Vaittinen 		}
19552718f154SMatti Vaittinen 	}
19562718f154SMatti Vaittinen }
19572718f154SMatti Vaittinen 
195863b19547SJonathan Cameron int __iio_device_register(struct iio_dev *indio_dev, struct module *this_mod)
1959a980e046SJonathan Cameron {
19608ebaa3ffSAlexandru Ardelean 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
1961b2a69969SMilan Zamazal 	struct fwnode_handle *fwnode = NULL;
1962a980e046SJonathan Cameron 	int ret;
1963a980e046SJonathan Cameron 
1964a17cb784SAlexandru Ardelean 	if (!indio_dev->info)
1965a17cb784SAlexandru Ardelean 		return -EINVAL;
1966a17cb784SAlexandru Ardelean 
19676eaf9f6aSJonathan Cameron 	iio_dev_opaque->driver_module = this_mod;
196817d82b47SGuenter Roeck 
196981366556SAndy Shevchenko 	/* If the calling driver did not initialize firmware node, do it here */
197081366556SAndy Shevchenko 	if (dev_fwnode(&indio_dev->dev))
197181366556SAndy Shevchenko 		fwnode = dev_fwnode(&indio_dev->dev);
1972b2a69969SMilan Zamazal 	/* The default dummy IIO device has no parent */
1973b2a69969SMilan Zamazal 	else if (indio_dev->dev.parent)
197481366556SAndy Shevchenko 		fwnode = dev_fwnode(indio_dev->dev.parent);
197581366556SAndy Shevchenko 	device_set_node(&indio_dev->dev, fwnode);
197681366556SAndy Shevchenko 
197781366556SAndy Shevchenko 	fwnode_property_read_string(fwnode, "label", &indio_dev->label);
19782c3d0c9fSPhil Reid 
19798f5d8727SVlad Dogaru 	ret = iio_check_unique_scan_index(indio_dev);
19808f5d8727SVlad Dogaru 	if (ret < 0)
19818f5d8727SVlad Dogaru 		return ret;
19828f5d8727SVlad Dogaru 
19830e0761f8SPaul Cercueil 	ret = iio_check_extended_name(indio_dev);
19840e0761f8SPaul Cercueil 	if (ret < 0)
19850e0761f8SPaul Cercueil 		return ret;
19860e0761f8SPaul Cercueil 
19878915aacaSGreg Kroah-Hartman 	iio_device_register_debugfs(indio_dev);
19883e1b6c95SLars-Peter Clausen 
1989ee708e6bSAlexandru Ardelean 	ret = iio_buffers_alloc_sysfs_and_mask(indio_dev);
19903e1b6c95SLars-Peter Clausen 	if (ret) {
19913e1b6c95SLars-Peter Clausen 		dev_err(indio_dev->dev.parent,
19923e1b6c95SLars-Peter Clausen 			"Failed to create buffer sysfs interfaces\n");
19933e1b6c95SLars-Peter Clausen 		goto error_unreg_debugfs;
19943e1b6c95SLars-Peter Clausen 	}
19953e1b6c95SLars-Peter Clausen 
19962718f154SMatti Vaittinen 	if (indio_dev->available_scan_masks)
19972718f154SMatti Vaittinen 		iio_sanity_check_avail_scan_masks(indio_dev);
19982718f154SMatti Vaittinen 
1999a980e046SJonathan Cameron 	ret = iio_device_register_sysfs(indio_dev);
2000a980e046SJonathan Cameron 	if (ret) {
2001a980e046SJonathan Cameron 		dev_err(indio_dev->dev.parent,
2002a980e046SJonathan Cameron 			"Failed to register sysfs interfaces\n");
20033e1b6c95SLars-Peter Clausen 		goto error_buffer_free_sysfs;
2004a980e046SJonathan Cameron 	}
2005a980e046SJonathan Cameron 	ret = iio_device_register_eventset(indio_dev);
2006a980e046SJonathan Cameron 	if (ret) {
2007a980e046SJonathan Cameron 		dev_err(indio_dev->dev.parent,
2008a980e046SJonathan Cameron 			"Failed to register event set\n");
2009a980e046SJonathan Cameron 		goto error_free_sysfs;
2010a980e046SJonathan Cameron 	}
2011d89e119aSBenjamin Gaignard 	if (indio_dev->modes & INDIO_ALL_TRIGGERED_MODES)
2012a980e046SJonathan Cameron 		iio_device_register_trigger_consumer(indio_dev);
2013a980e046SJonathan Cameron 
2014a980e046SJonathan Cameron 	if ((indio_dev->modes & INDIO_ALL_BUFFER_MODES) &&
2015a980e046SJonathan Cameron 		indio_dev->setup_ops == NULL)
2016a980e046SJonathan Cameron 		indio_dev->setup_ops = &noop_ring_setup_ops;
2017a980e046SJonathan Cameron 
2018ee708e6bSAlexandru Ardelean 	if (iio_dev_opaque->attached_buffers_cnt)
2019396f7234SJonathan Cameron 		cdev_init(&iio_dev_opaque->chrdev, &iio_buffer_fileops);
20208ebaa3ffSAlexandru Ardelean 	else if (iio_dev_opaque->event_interface)
2021396f7234SJonathan Cameron 		cdev_init(&iio_dev_opaque->chrdev, &iio_event_fileops);
202263b19547SJonathan Cameron 
2023ee708e6bSAlexandru Ardelean 	if (iio_dev_opaque->attached_buffers_cnt || iio_dev_opaque->event_interface) {
202415ea2878SJonathan Cameron 		indio_dev->dev.devt = MKDEV(MAJOR(iio_devt), iio_dev_opaque->id);
2025396f7234SJonathan Cameron 		iio_dev_opaque->chrdev.owner = this_mod;
20268ebaa3ffSAlexandru Ardelean 	}
202738923911SLogan Gunthorpe 
202832f17172SAlexandru Ardelean 	/* assign device groups now; they should be all registered now */
202932f17172SAlexandru Ardelean 	indio_dev->dev.groups = iio_dev_opaque->groups;
203032f17172SAlexandru Ardelean 
2031396f7234SJonathan Cameron 	ret = cdev_device_add(&iio_dev_opaque->chrdev, &indio_dev->dev);
2032a980e046SJonathan Cameron 	if (ret < 0)
20330d5b7daeSLars-Peter Clausen 		goto error_unreg_eventset;
2034a980e046SJonathan Cameron 
20350d5b7daeSLars-Peter Clausen 	return 0;
203638923911SLogan Gunthorpe 
2037a980e046SJonathan Cameron error_unreg_eventset:
2038a980e046SJonathan Cameron 	iio_device_unregister_eventset(indio_dev);
2039a980e046SJonathan Cameron error_free_sysfs:
2040a980e046SJonathan Cameron 	iio_device_unregister_sysfs(indio_dev);
20413e1b6c95SLars-Peter Clausen error_buffer_free_sysfs:
2042ee708e6bSAlexandru Ardelean 	iio_buffers_free_sysfs_and_mask(indio_dev);
2043a980e046SJonathan Cameron error_unreg_debugfs:
2044a980e046SJonathan Cameron 	iio_device_unregister_debugfs(indio_dev);
2045a980e046SJonathan Cameron 	return ret;
2046a980e046SJonathan Cameron }
204763b19547SJonathan Cameron EXPORT_SYMBOL(__iio_device_register);
2048a980e046SJonathan Cameron 
2049a7e57dceSSachin Kamat /**
2050a7e57dceSSachin Kamat  * iio_device_unregister() - unregister a device from the IIO subsystem
2051a7e57dceSSachin Kamat  * @indio_dev:		Device structure representing the device.
205265659a8dSAndy Shevchenko  */
2053a980e046SJonathan Cameron void iio_device_unregister(struct iio_dev *indio_dev)
2054a980e046SJonathan Cameron {
2055396f7234SJonathan Cameron 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
2056396f7234SJonathan Cameron 
2057396f7234SJonathan Cameron 	cdev_device_del(&iio_dev_opaque->chrdev, &indio_dev->dev);
2058a87c82e4SLars-Peter Clausen 
2059*42ea5992SNuno Sa 	scoped_guard(mutex, &iio_dev_opaque->info_exist_lock) {
2060bc4c9612SLars-Peter Clausen 		iio_device_unregister_debugfs(indio_dev);
20610d5b7daeSLars-Peter Clausen 
2062a87c82e4SLars-Peter Clausen 		iio_disable_all_buffers(indio_dev);
2063a87c82e4SLars-Peter Clausen 
2064a980e046SJonathan Cameron 		indio_dev->info = NULL;
2065d2f0a48fSLars-Peter Clausen 
2066d2f0a48fSLars-Peter Clausen 		iio_device_wakeup_eventset(indio_dev);
2067d2f0a48fSLars-Peter Clausen 		iio_buffer_wakeup_poll(indio_dev);
2068*42ea5992SNuno Sa 	}
20693e1b6c95SLars-Peter Clausen 
2070ee708e6bSAlexandru Ardelean 	iio_buffers_free_sysfs_and_mask(indio_dev);
2071a980e046SJonathan Cameron }
2072a980e046SJonathan Cameron EXPORT_SYMBOL(iio_device_unregister);
20738caa07c0SSachin Kamat 
2074cf5724e9SYicong Yang static void devm_iio_device_unreg(void *indio_dev)
20758caa07c0SSachin Kamat {
2076cf5724e9SYicong Yang 	iio_device_unregister(indio_dev);
20778caa07c0SSachin Kamat }
20788caa07c0SSachin Kamat 
207963b19547SJonathan Cameron int __devm_iio_device_register(struct device *dev, struct iio_dev *indio_dev,
208063b19547SJonathan Cameron 			       struct module *this_mod)
20818caa07c0SSachin Kamat {
20828caa07c0SSachin Kamat 	int ret;
20838caa07c0SSachin Kamat 
208463b19547SJonathan Cameron 	ret = __iio_device_register(indio_dev, this_mod);
2085cf5724e9SYicong Yang 	if (ret)
20868caa07c0SSachin Kamat 		return ret;
2087cf5724e9SYicong Yang 
2088cf5724e9SYicong Yang 	return devm_add_action_or_reset(dev, devm_iio_device_unreg, indio_dev);
20898caa07c0SSachin Kamat }
209063b19547SJonathan Cameron EXPORT_SYMBOL_GPL(__devm_iio_device_register);
20918caa07c0SSachin Kamat 
20928caa07c0SSachin Kamat /**
209308a33805SAlison Schofield  * iio_device_claim_direct_mode - Keep device in direct mode
209408a33805SAlison Schofield  * @indio_dev:	the iio_dev associated with the device
209508a33805SAlison Schofield  *
209608a33805SAlison Schofield  * If the device is in direct mode it is guaranteed to stay
209708a33805SAlison Schofield  * that way until iio_device_release_direct_mode() is called.
209808a33805SAlison Schofield  *
209908a33805SAlison Schofield  * Use with iio_device_release_direct_mode()
210008a33805SAlison Schofield  *
210165659a8dSAndy Shevchenko  * Returns: 0 on success, -EBUSY on failure.
210208a33805SAlison Schofield  */
210308a33805SAlison Schofield int iio_device_claim_direct_mode(struct iio_dev *indio_dev)
210408a33805SAlison Schofield {
210516afe125SNuno Sá 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
210616afe125SNuno Sá 
210716afe125SNuno Sá 	mutex_lock(&iio_dev_opaque->mlock);
210808a33805SAlison Schofield 
210908a33805SAlison Schofield 	if (iio_buffer_enabled(indio_dev)) {
211016afe125SNuno Sá 		mutex_unlock(&iio_dev_opaque->mlock);
211108a33805SAlison Schofield 		return -EBUSY;
211208a33805SAlison Schofield 	}
211308a33805SAlison Schofield 	return 0;
211408a33805SAlison Schofield }
211508a33805SAlison Schofield EXPORT_SYMBOL_GPL(iio_device_claim_direct_mode);
211608a33805SAlison Schofield 
211708a33805SAlison Schofield /**
211808a33805SAlison Schofield  * iio_device_release_direct_mode - releases claim on direct mode
211908a33805SAlison Schofield  * @indio_dev:	the iio_dev associated with the device
212008a33805SAlison Schofield  *
212108a33805SAlison Schofield  * Release the claim. Device is no longer guaranteed to stay
212208a33805SAlison Schofield  * in direct mode.
212308a33805SAlison Schofield  *
212408a33805SAlison Schofield  * Use with iio_device_claim_direct_mode()
212508a33805SAlison Schofield  */
212608a33805SAlison Schofield void iio_device_release_direct_mode(struct iio_dev *indio_dev)
212708a33805SAlison Schofield {
212816afe125SNuno Sá 	mutex_unlock(&to_iio_dev_opaque(indio_dev)->mlock);
212908a33805SAlison Schofield }
213008a33805SAlison Schofield EXPORT_SYMBOL_GPL(iio_device_release_direct_mode);
213108a33805SAlison Schofield 
21328c576f87SMiquel Raynal /**
21330a856542SNuno Sá  * iio_device_claim_buffer_mode - Keep device in buffer mode
21340a856542SNuno Sá  * @indio_dev:	the iio_dev associated with the device
21350a856542SNuno Sá  *
21360a856542SNuno Sá  * If the device is in buffer mode it is guaranteed to stay
21370a856542SNuno Sá  * that way until iio_device_release_buffer_mode() is called.
21380a856542SNuno Sá  *
21390a856542SNuno Sá  * Use with iio_device_release_buffer_mode().
21400a856542SNuno Sá  *
21410a856542SNuno Sá  * Returns: 0 on success, -EBUSY on failure.
21420a856542SNuno Sá  */
21430a856542SNuno Sá int iio_device_claim_buffer_mode(struct iio_dev *indio_dev)
21440a856542SNuno Sá {
214516afe125SNuno Sá 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
214616afe125SNuno Sá 
214716afe125SNuno Sá 	mutex_lock(&iio_dev_opaque->mlock);
21480a856542SNuno Sá 
21490a856542SNuno Sá 	if (iio_buffer_enabled(indio_dev))
21500a856542SNuno Sá 		return 0;
21510a856542SNuno Sá 
215216afe125SNuno Sá 	mutex_unlock(&iio_dev_opaque->mlock);
21530a856542SNuno Sá 	return -EBUSY;
21540a856542SNuno Sá }
21550a856542SNuno Sá EXPORT_SYMBOL_GPL(iio_device_claim_buffer_mode);
21560a856542SNuno Sá 
21570a856542SNuno Sá /**
21580a856542SNuno Sá  * iio_device_release_buffer_mode - releases claim on buffer mode
21590a856542SNuno Sá  * @indio_dev:	the iio_dev associated with the device
21600a856542SNuno Sá  *
21610a856542SNuno Sá  * Release the claim. Device is no longer guaranteed to stay
21620a856542SNuno Sá  * in buffer mode.
21630a856542SNuno Sá  *
21640a856542SNuno Sá  * Use with iio_device_claim_buffer_mode().
21650a856542SNuno Sá  */
21660a856542SNuno Sá void iio_device_release_buffer_mode(struct iio_dev *indio_dev)
21670a856542SNuno Sá {
216816afe125SNuno Sá 	mutex_unlock(&to_iio_dev_opaque(indio_dev)->mlock);
21690a856542SNuno Sá }
21700a856542SNuno Sá EXPORT_SYMBOL_GPL(iio_device_release_buffer_mode);
21710a856542SNuno Sá 
21720a856542SNuno Sá /**
21738c576f87SMiquel Raynal  * iio_device_get_current_mode() - helper function providing read-only access to
217451570c9dSMiquel Raynal  *				   the opaque @currentmode variable
21758c576f87SMiquel Raynal  * @indio_dev:			   IIO device structure for device
21768c576f87SMiquel Raynal  */
21778c576f87SMiquel Raynal int iio_device_get_current_mode(struct iio_dev *indio_dev)
21788c576f87SMiquel Raynal {
217951570c9dSMiquel Raynal 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(indio_dev);
218051570c9dSMiquel Raynal 
218151570c9dSMiquel Raynal 	return iio_dev_opaque->currentmode;
21828c576f87SMiquel Raynal }
21838c576f87SMiquel Raynal EXPORT_SYMBOL_GPL(iio_device_get_current_mode);
21848c576f87SMiquel Raynal 
2185a980e046SJonathan Cameron subsys_initcall(iio_init);
2186a980e046SJonathan Cameron module_exit(iio_exit);
2187a980e046SJonathan Cameron 
2188c8b95952SJonathan Cameron MODULE_AUTHOR("Jonathan Cameron <jic23@kernel.org>");
2189a980e046SJonathan Cameron MODULE_DESCRIPTION("Industrial I/O core");
2190a980e046SJonathan Cameron MODULE_LICENSE("GPL");
2191