industrialio-core.c 22.1 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19
/* The industrial I/O core
 *
 * Copyright (c) 2008 Jonathan Cameron
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 as published by
 * the Free Software Foundation.
 *
 * Based on elements of hwmon and input subsystems.
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/idr.h>
#include <linux/kdev_t.h>
#include <linux/err.h>
#include <linux/device.h>
#include <linux/fs.h>
#include <linux/poll.h>
20
#include <linux/sched.h>
21
#include <linux/wait.h>
22
#include <linux/cdev.h>
23
#include <linux/slab.h>
24
#include <linux/anon_inodes.h>
25
#include <linux/debugfs.h>
26
#include <linux/iio/iio.h>
27
#include "iio_core.h"
28
#include "iio_core_trigger.h"
29 30
#include <linux/iio/sysfs.h>
#include <linux/iio/events.h>
31

32
/* IDA to assign each registered device a unique id*/
33
static DEFINE_IDA(iio_ida);
34

35
static dev_t iio_devt;
36 37

#define IIO_DEV_MAX 256
38
struct bus_type iio_bus_type = {
39 40
	.name = "iio",
};
41
EXPORT_SYMBOL(iio_bus_type);
42

43 44
static struct dentry *iio_debugfs_dentry;

45 46 47 48 49
static const char * const iio_direction[] = {
	[0] = "in",
	[1] = "out",
};

50
static const char * const iio_chan_type_name_spec[] = {
51
	[IIO_VOLTAGE] = "voltage",
52 53
	[IIO_CURRENT] = "current",
	[IIO_POWER] = "power",
54
	[IIO_ACCEL] = "accel",
55
	[IIO_ANGL_VEL] = "anglvel",
56
	[IIO_MAGN] = "magn",
57 58
	[IIO_LIGHT] = "illuminance",
	[IIO_INTENSITY] = "intensity",
59
	[IIO_PROXIMITY] = "proximity",
60
	[IIO_TEMP] = "temp",
61 62 63
	[IIO_INCLI] = "incli",
	[IIO_ROT] = "rot",
	[IIO_ANGL] = "angl",
64
	[IIO_TIMESTAMP] = "timestamp",
65
	[IIO_CAPACITANCE] = "capacitance",
66
	[IIO_ALTVOLTAGE] = "altvoltage",
67 68
};

69
static const char * const iio_modifier_names[] = {
70 71 72
	[IIO_MOD_X] = "x",
	[IIO_MOD_Y] = "y",
	[IIO_MOD_Z] = "z",
73 74
	[IIO_MOD_LIGHT_BOTH] = "both",
	[IIO_MOD_LIGHT_IR] = "ir",
75 76 77 78
};

/* relies on pairs of these shared then separate */
static const char * const iio_chan_info_postfix[] = {
79 80
	[IIO_CHAN_INFO_RAW] = "raw",
	[IIO_CHAN_INFO_PROCESSED] = "input",
81 82 83 84 85 86 87 88
	[IIO_CHAN_INFO_SCALE] = "scale",
	[IIO_CHAN_INFO_OFFSET] = "offset",
	[IIO_CHAN_INFO_CALIBSCALE] = "calibscale",
	[IIO_CHAN_INFO_CALIBBIAS] = "calibbias",
	[IIO_CHAN_INFO_PEAK] = "peak_raw",
	[IIO_CHAN_INFO_PEAK_SCALE] = "peak_scale",
	[IIO_CHAN_INFO_QUADRATURE_CORRECTION_RAW] = "quadrature_correction_raw",
	[IIO_CHAN_INFO_AVERAGE_RAW] = "mean_raw",
89 90
	[IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY]
	= "filter_low_pass_3db_frequency",
91
	[IIO_CHAN_INFO_SAMP_FREQ] = "sampling_frequency",
92 93
	[IIO_CHAN_INFO_FREQUENCY] = "frequency",
	[IIO_CHAN_INFO_PHASE] = "phase",
94
	[IIO_CHAN_INFO_HARDWAREGAIN] = "hardwaregain",
95 96
};

97 98 99 100 101 102 103 104 105 106 107
const struct iio_chan_spec
*iio_find_channel_from_si(struct iio_dev *indio_dev, int si)
{
	int i;

	for (i = 0; i < indio_dev->num_channels; i++)
		if (indio_dev->channels[i].scan_index == si)
			return &indio_dev->channels[i];
	return NULL;
}

108 109 110 111 112 113 114 115 116 117 118 119 120
/* This turns up an awful lot */
ssize_t iio_read_const_attr(struct device *dev,
			    struct device_attribute *attr,
			    char *buf)
{
	return sprintf(buf, "%s\n", to_iio_const_attr(attr)->string);
}
EXPORT_SYMBOL(iio_read_const_attr);

static int __init iio_init(void)
{
	int ret;

121 122
	/* Register sysfs bus */
	ret  = bus_register(&iio_bus_type);
123 124
	if (ret < 0) {
		printk(KERN_ERR
125
		       "%s could not register bus type\n",
126 127 128 129
			__FILE__);
		goto error_nothing;
	}

130 131 132 133
	ret = alloc_chrdev_region(&iio_devt, 0, IIO_DEV_MAX, "iio");
	if (ret < 0) {
		printk(KERN_ERR "%s: failed to allocate char dev region\n",
		       __FILE__);
134
		goto error_unregister_bus_type;
135
	}
136

137 138
	iio_debugfs_dentry = debugfs_create_dir("iio", NULL);

139 140
	return 0;

141 142
error_unregister_bus_type:
	bus_unregister(&iio_bus_type);
143 144 145 146 147 148
error_nothing:
	return ret;
}

static void __exit iio_exit(void)
{
149 150
	if (iio_devt)
		unregister_chrdev_region(iio_devt, IIO_DEV_MAX);
151
	bus_unregister(&iio_bus_type);
152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213
	debugfs_remove(iio_debugfs_dentry);
}

#if defined(CONFIG_DEBUG_FS)
static ssize_t iio_debugfs_read_reg(struct file *file, char __user *userbuf,
			      size_t count, loff_t *ppos)
{
	struct iio_dev *indio_dev = file->private_data;
	char buf[20];
	unsigned val = 0;
	ssize_t len;
	int ret;

	ret = indio_dev->info->debugfs_reg_access(indio_dev,
						  indio_dev->cached_reg_addr,
						  0, &val);
	if (ret)
		dev_err(indio_dev->dev.parent, "%s: read failed\n", __func__);

	len = snprintf(buf, sizeof(buf), "0x%X\n", val);

	return simple_read_from_buffer(userbuf, count, ppos, buf, len);
}

static ssize_t iio_debugfs_write_reg(struct file *file,
		     const char __user *userbuf, size_t count, loff_t *ppos)
{
	struct iio_dev *indio_dev = file->private_data;
	unsigned reg, val;
	char buf[80];
	int ret;

	count = min_t(size_t, count, (sizeof(buf)-1));
	if (copy_from_user(buf, userbuf, count))
		return -EFAULT;

	buf[count] = 0;

	ret = sscanf(buf, "%i %i", &reg, &val);

	switch (ret) {
	case 1:
		indio_dev->cached_reg_addr = reg;
		break;
	case 2:
		indio_dev->cached_reg_addr = reg;
		ret = indio_dev->info->debugfs_reg_access(indio_dev, reg,
							  val, NULL);
		if (ret) {
			dev_err(indio_dev->dev.parent, "%s: write failed\n",
				__func__);
			return ret;
		}
		break;
	default:
		return -EINVAL;
	}

	return count;
}

static const struct file_operations iio_debugfs_reg_fops = {
214
	.open = simple_open,
215 216 217 218 219 220 221
	.read = iio_debugfs_read_reg,
	.write = iio_debugfs_write_reg,
};

static void iio_device_unregister_debugfs(struct iio_dev *indio_dev)
{
	debugfs_remove_recursive(indio_dev->debugfs_dentry);
222 223
}

224 225 226 227 228 229 230
static int iio_device_register_debugfs(struct iio_dev *indio_dev)
{
	struct dentry *d;

	if (indio_dev->info->debugfs_reg_access == NULL)
		return 0;

231
	if (!iio_debugfs_dentry)
232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263
		return 0;

	indio_dev->debugfs_dentry =
		debugfs_create_dir(dev_name(&indio_dev->dev),
				   iio_debugfs_dentry);
	if (indio_dev->debugfs_dentry == NULL) {
		dev_warn(indio_dev->dev.parent,
			 "Failed to create debugfs directory\n");
		return -EFAULT;
	}

	d = debugfs_create_file("direct_reg_access", 0644,
				indio_dev->debugfs_dentry,
				indio_dev, &iio_debugfs_reg_fops);
	if (!d) {
		iio_device_unregister_debugfs(indio_dev);
		return -ENOMEM;
	}

	return 0;
}
#else
static int iio_device_register_debugfs(struct iio_dev *indio_dev)
{
	return 0;
}

static void iio_device_unregister_debugfs(struct iio_dev *indio_dev)
{
}
#endif /* CONFIG_DEBUG_FS */

264 265 266 267 268 269 270 271 272 273
static ssize_t iio_read_channel_ext_info(struct device *dev,
				     struct device_attribute *attr,
				     char *buf)
{
	struct iio_dev *indio_dev = dev_get_drvdata(dev);
	struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
	const struct iio_chan_spec_ext_info *ext_info;

	ext_info = &this_attr->c->ext_info[this_attr->address];

274
	return ext_info->read(indio_dev, ext_info->private, this_attr->c, buf);
275 276 277 278 279 280 281 282 283 284 285 286 287
}

static ssize_t iio_write_channel_ext_info(struct device *dev,
				     struct device_attribute *attr,
				     const char *buf,
					 size_t len)
{
	struct iio_dev *indio_dev = dev_get_drvdata(dev);
	struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
	const struct iio_chan_spec_ext_info *ext_info;

	ext_info = &this_attr->c->ext_info[this_attr->address];

288 289
	return ext_info->write(indio_dev, ext_info->private,
			       this_attr->c, buf, len);
290 291
}

292 293 294
static ssize_t iio_read_channel_info(struct device *dev,
				     struct device_attribute *attr,
				     char *buf)
295
{
296 297 298
	struct iio_dev *indio_dev = dev_get_drvdata(dev);
	struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
	int val, val2;
299
	bool scale_db = false;
300 301
	int ret = indio_dev->info->read_raw(indio_dev, this_attr->c,
					    &val, &val2, this_attr->address);
302 303 304

	if (ret < 0)
		return ret;
305

306 307
	switch (ret) {
	case IIO_VAL_INT:
308
		return sprintf(buf, "%d\n", val);
309 310 311
	case IIO_VAL_INT_PLUS_MICRO_DB:
		scale_db = true;
	case IIO_VAL_INT_PLUS_MICRO:
312
		if (val2 < 0)
313 314
			return sprintf(buf, "-%d.%06u%s\n", val, -val2,
				scale_db ? " dB" : "");
315
		else
316 317 318
			return sprintf(buf, "%d.%06u%s\n", val, val2,
				scale_db ? " dB" : "");
	case IIO_VAL_INT_PLUS_NANO:
319 320 321 322
		if (val2 < 0)
			return sprintf(buf, "-%d.%09u\n", val, -val2);
		else
			return sprintf(buf, "%d.%09u\n", val, val2);
323
	default:
324
		return 0;
325
	}
326 327 328 329 330 331 332 333 334
}

static ssize_t iio_write_channel_info(struct device *dev,
				      struct device_attribute *attr,
				      const char *buf,
				      size_t len)
{
	struct iio_dev *indio_dev = dev_get_drvdata(dev);
	struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
335
	int ret, integer = 0, fract = 0, fract_mult = 100000;
336 337 338
	bool integer_part = true, negative = false;

	/* Assumes decimal - precision based on number of digits */
339
	if (!indio_dev->info->write_raw)
340
		return -EINVAL;
341 342 343 344 345 346 347 348 349 350 351 352 353 354

	if (indio_dev->info->write_raw_get_fmt)
		switch (indio_dev->info->write_raw_get_fmt(indio_dev,
			this_attr->c, this_attr->address)) {
		case IIO_VAL_INT_PLUS_MICRO:
			fract_mult = 100000;
			break;
		case IIO_VAL_INT_PLUS_NANO:
			fract_mult = 100000000;
			break;
		default:
			return -EINVAL;
		}

355 356 357 358
	if (buf[0] == '-') {
		negative = true;
		buf++;
	}
359

360 361 362 363 364
	while (*buf) {
		if ('0' <= *buf && *buf <= '9') {
			if (integer_part)
				integer = integer*10 + *buf - '0';
			else {
365 366
				fract += fract_mult*(*buf - '0');
				if (fract_mult == 1)
367
					break;
368
				fract_mult /= 10;
369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385
			}
		} else if (*buf == '\n') {
			if (*(buf + 1) == '\0')
				break;
			else
				return -EINVAL;
		} else if (*buf == '.') {
			integer_part = false;
		} else {
			return -EINVAL;
		}
		buf++;
	}
	if (negative) {
		if (integer)
			integer = -integer;
		else
386
			fract = -fract;
387 388
	}

389
	ret = indio_dev->info->write_raw(indio_dev, this_attr->c,
390
					 integer, fract, this_attr->address);
391 392 393 394 395 396
	if (ret)
		return ret;

	return len;
}

397
static
398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413
int __iio_device_attr_init(struct device_attribute *dev_attr,
			   const char *postfix,
			   struct iio_chan_spec const *chan,
			   ssize_t (*readfunc)(struct device *dev,
					       struct device_attribute *attr,
					       char *buf),
			   ssize_t (*writefunc)(struct device *dev,
						struct device_attribute *attr,
						const char *buf,
						size_t len),
			   bool generic)
{
	int ret;
	char *name_format, *full_postfix;
	sysfs_attr_init(&dev_attr->attr);

414
	/* Build up postfix of <extend_name>_<modifier>_postfix */
415
	if (chan->modified && !generic) {
416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439
		if (chan->extend_name)
			full_postfix = kasprintf(GFP_KERNEL, "%s_%s_%s",
						 iio_modifier_names[chan
								    ->channel2],
						 chan->extend_name,
						 postfix);
		else
			full_postfix = kasprintf(GFP_KERNEL, "%s_%s",
						 iio_modifier_names[chan
								    ->channel2],
						 postfix);
	} else {
		if (chan->extend_name == NULL)
			full_postfix = kstrdup(postfix, GFP_KERNEL);
		else
			full_postfix = kasprintf(GFP_KERNEL,
						 "%s_%s",
						 chan->extend_name,
						 postfix);
	}
	if (full_postfix == NULL) {
		ret = -ENOMEM;
		goto error_ret;
	}
440

441
	if (chan->differential) { /* Differential can not have modifier */
442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483
		if (generic)
			name_format
				= kasprintf(GFP_KERNEL, "%s_%s-%s_%s",
					    iio_direction[chan->output],
					    iio_chan_type_name_spec[chan->type],
					    iio_chan_type_name_spec[chan->type],
					    full_postfix);
		else if (chan->indexed)
			name_format
				= kasprintf(GFP_KERNEL, "%s_%s%d-%s%d_%s",
					    iio_direction[chan->output],
					    iio_chan_type_name_spec[chan->type],
					    chan->channel,
					    iio_chan_type_name_spec[chan->type],
					    chan->channel2,
					    full_postfix);
		else {
			WARN_ON("Differential channels must be indexed\n");
			ret = -EINVAL;
			goto error_free_full_postfix;
		}
	} else { /* Single ended */
		if (generic)
			name_format
				= kasprintf(GFP_KERNEL, "%s_%s_%s",
					    iio_direction[chan->output],
					    iio_chan_type_name_spec[chan->type],
					    full_postfix);
		else if (chan->indexed)
			name_format
				= kasprintf(GFP_KERNEL, "%s_%s%d_%s",
					    iio_direction[chan->output],
					    iio_chan_type_name_spec[chan->type],
					    chan->channel,
					    full_postfix);
		else
			name_format
				= kasprintf(GFP_KERNEL, "%s_%s_%s",
					    iio_direction[chan->output],
					    iio_chan_type_name_spec[chan->type],
					    full_postfix);
	}
484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518
	if (name_format == NULL) {
		ret = -ENOMEM;
		goto error_free_full_postfix;
	}
	dev_attr->attr.name = kasprintf(GFP_KERNEL,
					name_format,
					chan->channel,
					chan->channel2);
	if (dev_attr->attr.name == NULL) {
		ret = -ENOMEM;
		goto error_free_name_format;
	}

	if (readfunc) {
		dev_attr->attr.mode |= S_IRUGO;
		dev_attr->show = readfunc;
	}

	if (writefunc) {
		dev_attr->attr.mode |= S_IWUSR;
		dev_attr->store = writefunc;
	}
	kfree(name_format);
	kfree(full_postfix);

	return 0;

error_free_name_format:
	kfree(name_format);
error_free_full_postfix:
	kfree(full_postfix);
error_ret:
	return ret;
}

519
static void __iio_device_attr_deinit(struct device_attribute *dev_attr)
520 521 522 523 524 525 526 527 528 529 530 531 532
{
	kfree(dev_attr->attr.name);
}

int __iio_add_chan_devattr(const char *postfix,
			   struct iio_chan_spec const *chan,
			   ssize_t (*readfunc)(struct device *dev,
					       struct device_attribute *attr,
					       char *buf),
			   ssize_t (*writefunc)(struct device *dev,
						struct device_attribute *attr,
						const char *buf,
						size_t len),
533
			   u64 mask,
534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573
			   bool generic,
			   struct device *dev,
			   struct list_head *attr_list)
{
	int ret;
	struct iio_dev_attr *iio_attr, *t;

	iio_attr = kzalloc(sizeof *iio_attr, GFP_KERNEL);
	if (iio_attr == NULL) {
		ret = -ENOMEM;
		goto error_ret;
	}
	ret = __iio_device_attr_init(&iio_attr->dev_attr,
				     postfix, chan,
				     readfunc, writefunc, generic);
	if (ret)
		goto error_iio_dev_attr_free;
	iio_attr->c = chan;
	iio_attr->address = mask;
	list_for_each_entry(t, attr_list, l)
		if (strcmp(t->dev_attr.attr.name,
			   iio_attr->dev_attr.attr.name) == 0) {
			if (!generic)
				dev_err(dev, "tried to double register : %s\n",
					t->dev_attr.attr.name);
			ret = -EBUSY;
			goto error_device_attr_deinit;
		}
	list_add(&iio_attr->l, attr_list);

	return 0;

error_device_attr_deinit:
	__iio_device_attr_deinit(&iio_attr->dev_attr);
error_iio_dev_attr_free:
	kfree(iio_attr);
error_ret:
	return ret;
}

574
static int iio_device_add_channel_sysfs(struct iio_dev *indio_dev,
575 576
					struct iio_chan_spec const *chan)
{
577
	int ret, attrcount = 0;
578
	int i;
579
	const struct iio_chan_spec_ext_info *ext_info;
580 581 582

	if (chan->channel < 0)
		return 0;
583
	for_each_set_bit(i, &chan->info_mask, sizeof(long)*8) {
584
		ret = __iio_add_chan_devattr(iio_chan_info_postfix[i/2],
585
					     chan,
586 587
					     &iio_read_channel_info,
					     &iio_write_channel_info,
588
					     i/2,
589
					     !(i%2),
590 591
					     &indio_dev->dev,
					     &indio_dev->channel_attr_list);
592 593 594 595 596 597
		if (ret == -EBUSY && (i%2 == 0)) {
			ret = 0;
			continue;
		}
		if (ret < 0)
			goto error_ret;
598
		attrcount++;
599
	}
600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624

	if (chan->ext_info) {
		unsigned int i = 0;
		for (ext_info = chan->ext_info; ext_info->name; ext_info++) {
			ret = __iio_add_chan_devattr(ext_info->name,
					chan,
					ext_info->read ?
					    &iio_read_channel_ext_info : NULL,
					ext_info->write ?
					    &iio_write_channel_ext_info : NULL,
					i,
					ext_info->shared,
					&indio_dev->dev,
					&indio_dev->channel_attr_list);
			i++;
			if (ret == -EBUSY && ext_info->shared)
				continue;

			if (ret)
				goto error_ret;

			attrcount++;
		}
	}

625
	ret = attrcount;
626 627 628 629
error_ret:
	return ret;
}

630
static void iio_device_remove_and_free_read_attr(struct iio_dev *indio_dev,
631 632 633 634 635 636
						 struct iio_dev_attr *p)
{
	kfree(p->dev_attr.attr.name);
	kfree(p);
}

637 638 639 640 641 642 643 644 645 646
static ssize_t iio_show_dev_name(struct device *dev,
				 struct device_attribute *attr,
				 char *buf)
{
	struct iio_dev *indio_dev = dev_get_drvdata(dev);
	return sprintf(buf, "%s\n", indio_dev->name);
}

static DEVICE_ATTR(name, S_IRUGO, iio_show_dev_name, NULL);

647
static int iio_device_register_sysfs(struct iio_dev *indio_dev)
648
{
649
	int i, ret = 0, attrcount, attrn, attrcount_orig = 0;
650
	struct iio_dev_attr *p, *n;
651
	struct attribute **attr;
652

653
	/* First count elements in any existing group */
654 655
	if (indio_dev->info->attrs) {
		attr = indio_dev->info->attrs->attrs;
656 657
		while (*attr++ != NULL)
			attrcount_orig++;
658
	}
659
	attrcount = attrcount_orig;
660 661
	/*
	 * New channel registration method - relies on the fact a group does
662
	 * not need to be initialized if it is name is NULL.
663
	 */
664 665 666 667 668
	INIT_LIST_HEAD(&indio_dev->channel_attr_list);
	if (indio_dev->channels)
		for (i = 0; i < indio_dev->num_channels; i++) {
			ret = iio_device_add_channel_sysfs(indio_dev,
							   &indio_dev
669 670 671
							   ->channels[i]);
			if (ret < 0)
				goto error_clear_attrs;
672
			attrcount += ret;
673
		}
674

675
	if (indio_dev->name)
676 677
		attrcount++;

678 679 680
	indio_dev->chan_attr_group.attrs = kcalloc(attrcount + 1,
						   sizeof(indio_dev->chan_attr_group.attrs[0]),
						   GFP_KERNEL);
681
	if (indio_dev->chan_attr_group.attrs == NULL) {
682 683
		ret = -ENOMEM;
		goto error_clear_attrs;
684
	}
685
	/* Copy across original attributes */
686 687 688 689
	if (indio_dev->info->attrs)
		memcpy(indio_dev->chan_attr_group.attrs,
		       indio_dev->info->attrs->attrs,
		       sizeof(indio_dev->chan_attr_group.attrs[0])
690 691 692
		       *attrcount_orig);
	attrn = attrcount_orig;
	/* Add all elements from the list. */
693 694 695 696
	list_for_each_entry(p, &indio_dev->channel_attr_list, l)
		indio_dev->chan_attr_group.attrs[attrn++] = &p->dev_attr.attr;
	if (indio_dev->name)
		indio_dev->chan_attr_group.attrs[attrn++] = &dev_attr_name.attr;
697

698 699
	indio_dev->groups[indio_dev->groupcounter++] =
		&indio_dev->chan_attr_group;
700

701
	return 0;
702

703 704
error_clear_attrs:
	list_for_each_entry_safe(p, n,
705
				 &indio_dev->channel_attr_list, l) {
706
		list_del(&p->l);
707
		iio_device_remove_and_free_read_attr(indio_dev, p);
708 709
	}

710
	return ret;
711 712
}

713
static void iio_device_unregister_sysfs(struct iio_dev *indio_dev)
714
{
715 716

	struct iio_dev_attr *p, *n;
717

718
	list_for_each_entry_safe(p, n, &indio_dev->channel_attr_list, l) {
719
		list_del(&p->l);
720
		iio_device_remove_and_free_read_attr(indio_dev, p);
721
	}
722
	kfree(indio_dev->chan_attr_group.attrs);
723 724 725 726
}

static void iio_dev_release(struct device *device)
{
727 728 729 730 731 732
	struct iio_dev *indio_dev = container_of(device, struct iio_dev, dev);
	cdev_del(&indio_dev->chrdev);
	if (indio_dev->modes & INDIO_BUFFER_TRIGGERED)
		iio_device_unregister_trigger_consumer(indio_dev);
	iio_device_unregister_eventset(indio_dev);
	iio_device_unregister_sysfs(indio_dev);
733
	iio_device_unregister_debugfs(indio_dev);
734 735 736 737 738 739 740
}

static struct device_type iio_dev_type = {
	.name = "iio_device",
	.release = iio_dev_release,
};

741
struct iio_dev *iio_device_alloc(int sizeof_priv)
742
{
743 744 745 746 747 748 749 750 751 752 753 754
	struct iio_dev *dev;
	size_t alloc_size;

	alloc_size = sizeof(struct iio_dev);
	if (sizeof_priv) {
		alloc_size = ALIGN(alloc_size, IIO_ALIGN);
		alloc_size += sizeof_priv;
	}
	/* ensure 32-byte alignment of whole construct ? */
	alloc_size += IIO_ALIGN - 1;

	dev = kzalloc(alloc_size, GFP_KERNEL);
755 756

	if (dev) {
757
		dev->dev.groups = dev->groups;
758
		dev->dev.type = &iio_dev_type;
759
		dev->dev.bus = &iio_bus_type;
760 761 762
		device_initialize(&dev->dev);
		dev_set_drvdata(&dev->dev, (void *)dev);
		mutex_init(&dev->mlock);
763
		mutex_init(&dev->info_exist_lock);
764 765 766 767 768 769 770 771 772

		dev->id = ida_simple_get(&iio_ida, 0, 0, GFP_KERNEL);
		if (dev->id < 0) {
			/* cannot use a dev_err as the name isn't available */
			printk(KERN_ERR "Failed to get id\n");
			kfree(dev);
			return NULL;
		}
		dev_set_name(&dev->dev, "iio:device%d", dev->id);
773 774 775 776
	}

	return dev;
}
777
EXPORT_SYMBOL(iio_device_alloc);
778

779
void iio_device_free(struct iio_dev *dev)
780
{
781 782
	if (dev) {
		ida_simple_remove(&iio_ida, dev->id);
783
		kfree(dev);
784
	}
785
}
786
EXPORT_SYMBOL(iio_device_free);
787

788
/**
789
 * iio_chrdev_open() - chrdev file open for buffer access and ioctls
790 791 792
 **/
static int iio_chrdev_open(struct inode *inode, struct file *filp)
{
793
	struct iio_dev *indio_dev = container_of(inode->i_cdev,
794
						struct iio_dev, chrdev);
795 796 797 798

	if (test_and_set_bit(IIO_BUSY_BIT_POS, &indio_dev->flags))
		return -EBUSY;

799
	filp->private_data = indio_dev;
800

801
	return 0;
802 803 804
}

/**
805
 * iio_chrdev_release() - chrdev file close buffer access and ioctls
806 807 808
 **/
static int iio_chrdev_release(struct inode *inode, struct file *filp)
{
809 810 811
	struct iio_dev *indio_dev = container_of(inode->i_cdev,
						struct iio_dev, chrdev);
	clear_bit(IIO_BUSY_BIT_POS, &indio_dev->flags);
812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831
	return 0;
}

/* Somewhat of a cross file organization violation - ioctls here are actually
 * event related */
static long iio_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
{
	struct iio_dev *indio_dev = filp->private_data;
	int __user *ip = (int __user *)arg;
	int fd;

	if (cmd == IIO_GET_EVENT_FD_IOCTL) {
		fd = iio_event_getfd(indio_dev);
		if (copy_to_user(ip, &fd, sizeof(fd)))
			return -EFAULT;
		return 0;
	}
	return -EINVAL;
}

832 833
static const struct file_operations iio_buffer_fileops = {
	.read = iio_buffer_read_first_n_outer_addr,
834 835
	.release = iio_chrdev_release,
	.open = iio_chrdev_open,
836
	.poll = iio_buffer_poll_addr,
837 838 839 840 841 842
	.owner = THIS_MODULE,
	.llseek = noop_llseek,
	.unlocked_ioctl = iio_ioctl,
	.compat_ioctl = iio_ioctl,
};

843 844
static const struct iio_buffer_setup_ops noop_ring_setup_ops;

845
int iio_device_register(struct iio_dev *indio_dev)
846 847 848
{
	int ret;

849
	/* configure elements for the chrdev */
850
	indio_dev->dev.devt = MKDEV(MAJOR(iio_devt), indio_dev->id);
851

852 853 854 855 856 857
	ret = iio_device_register_debugfs(indio_dev);
	if (ret) {
		dev_err(indio_dev->dev.parent,
			"Failed to register debugfs interfaces\n");
		goto error_ret;
	}
858
	ret = iio_device_register_sysfs(indio_dev);
859
	if (ret) {
860
		dev_err(indio_dev->dev.parent,
861
			"Failed to register sysfs interfaces\n");
862
		goto error_unreg_debugfs;
863
	}
864
	ret = iio_device_register_eventset(indio_dev);
865
	if (ret) {
866
		dev_err(indio_dev->dev.parent,
867
			"Failed to register event set\n");
868 869
		goto error_free_sysfs;
	}
870 871
	if (indio_dev->modes & INDIO_BUFFER_TRIGGERED)
		iio_device_register_trigger_consumer(indio_dev);
872

873 874 875 876
	if ((indio_dev->modes & INDIO_ALL_BUFFER_MODES) &&
		indio_dev->setup_ops == NULL)
		indio_dev->setup_ops = &noop_ring_setup_ops;

877
	ret = device_add(&indio_dev->dev);
878 879
	if (ret < 0)
		goto error_unreg_eventset;
880 881 882
	cdev_init(&indio_dev->chrdev, &iio_buffer_fileops);
	indio_dev->chrdev.owner = indio_dev->info->driver_module;
	ret = cdev_add(&indio_dev->chrdev, indio_dev->dev.devt, 1);
883 884
	if (ret < 0)
		goto error_del_device;
885 886 887
	return 0;

error_del_device:
888
	device_del(&indio_dev->dev);
889
error_unreg_eventset:
890
	iio_device_unregister_eventset(indio_dev);
891
error_free_sysfs:
892
	iio_device_unregister_sysfs(indio_dev);
893 894
error_unreg_debugfs:
	iio_device_unregister_debugfs(indio_dev);
895 896 897 898 899
error_ret:
	return ret;
}
EXPORT_SYMBOL(iio_device_register);

900
void iio_device_unregister(struct iio_dev *indio_dev)
901
{
902 903 904
	mutex_lock(&indio_dev->info_exist_lock);
	indio_dev->info = NULL;
	mutex_unlock(&indio_dev->info_exist_lock);
905
	device_unregister(&indio_dev->dev);
906 907 908 909 910 911 912 913
}
EXPORT_SYMBOL(iio_device_unregister);
subsys_initcall(iio_init);
module_exit(iio_exit);

MODULE_AUTHOR("Jonathan Cameron <jic23@cam.ac.uk>");
MODULE_DESCRIPTION("Industrial I/O core");
MODULE_LICENSE("GPL");