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