industrialio-core.c 22.2 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 95
};

96 97 98 99 100 101 102 103 104 105 106
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;
}

107 108 109 110 111 112 113 114 115 116 117 118 119
/* 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;

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

129 130 131 132
	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__);
133
		goto error_unregister_bus_type;
134
	}
135

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

138 139
	return 0;

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

static void __exit iio_exit(void)
{
148 149
	if (iio_devt)
		unregister_chrdev_region(iio_devt, IIO_DEV_MAX);
150
	bus_unregister(&iio_bus_type);
151 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 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228
	debugfs_remove(iio_debugfs_dentry);
}

#if defined(CONFIG_DEBUG_FS)
static int iio_debugfs_open(struct inode *inode, struct file *file)
{
	if (inode->i_private)
		file->private_data = inode->i_private;

	return 0;
}

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 = {
	.open = iio_debugfs_open,
	.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);
229 230
}

231 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 264 265 266 267 268 269 270 271 272 273
static int iio_device_register_debugfs(struct iio_dev *indio_dev)
{
	struct dentry *d;

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

	if (IS_ERR(iio_debugfs_dentry))
		return 0;

	indio_dev->debugfs_dentry =
		debugfs_create_dir(dev_name(&indio_dev->dev),
				   iio_debugfs_dentry);
	if (IS_ERR(indio_dev->debugfs_dentry))
		return PTR_ERR(indio_dev->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 */

274 275 276 277 278 279 280 281 282 283
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];

284
	return ext_info->read(indio_dev, ext_info->private, this_attr->c, buf);
285 286 287 288 289 290 291 292 293 294 295 296 297
}

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];

298 299
	return ext_info->write(indio_dev, ext_info->private,
			       this_attr->c, buf, len);
300 301
}

302 303 304
static ssize_t iio_read_channel_info(struct device *dev,
				     struct device_attribute *attr,
				     char *buf)
305
{
306 307 308
	struct iio_dev *indio_dev = dev_get_drvdata(dev);
	struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
	int val, val2;
309 310
	int ret = indio_dev->info->read_raw(indio_dev, this_attr->c,
					    &val, &val2, this_attr->address);
311 312 313

	if (ret < 0)
		return ret;
314

315 316 317 318 319 320 321
	if (ret == IIO_VAL_INT)
		return sprintf(buf, "%d\n", val);
	else if (ret == IIO_VAL_INT_PLUS_MICRO) {
		if (val2 < 0)
			return sprintf(buf, "-%d.%06u\n", val, -val2);
		else
			return sprintf(buf, "%d.%06u\n", val, val2);
322 323 324 325 326
	} else if (ret == IIO_VAL_INT_PLUS_NANO) {
		if (val2 < 0)
			return sprintf(buf, "-%d.%09u\n", val, -val2);
		else
			return sprintf(buf, "%d.%09u\n", val, val2);
327 328 329 330 331 332 333 334 335 336 337
	} else
		return 0;
}

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);
338
	int ret, integer = 0, fract = 0, fract_mult = 100000;
339 340 341
	bool integer_part = true, negative = false;

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

	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;
		}

358 359 360 361
	if (buf[0] == '-') {
		negative = true;
		buf++;
	}
362

363 364 365 366 367
	while (*buf) {
		if ('0' <= *buf && *buf <= '9') {
			if (integer_part)
				integer = integer*10 + *buf - '0';
			else {
368 369
				fract += fract_mult*(*buf - '0');
				if (fract_mult == 1)
370
					break;
371
				fract_mult /= 10;
372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388
			}
		} 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
389
			fract = -fract;
390 391
	}

392
	ret = indio_dev->info->write_raw(indio_dev, this_attr->c,
393
					 integer, fract, this_attr->address);
394 395 396 397 398 399
	if (ret)
		return ret;

	return len;
}

400
static
401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416
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);

417
	/* Build up postfix of <extend_name>_<modifier>_postfix */
418
	if (chan->modified && !generic) {
419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442
		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;
	}
443

444
	if (chan->differential) { /* Differential can not have modifier */
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 484 485 486
		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);
	}
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 519 520 521
	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;
}

522
static void __iio_device_attr_deinit(struct device_attribute *dev_attr)
523 524 525 526 527 528 529 530 531 532 533 534 535
{
	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),
536
			   u64 mask,
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 574 575 576
			   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;
}

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

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

	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++;
		}
	}

628
	ret = attrcount;
629 630 631 632
error_ret:
	return ret;
}

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

640 641 642 643 644 645 646 647 648 649
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);

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

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

678
	if (indio_dev->name)
679 680
		attrcount++;

681 682 683
	indio_dev->chan_attr_group.attrs = kcalloc(attrcount + 1,
						   sizeof(indio_dev->chan_attr_group.attrs[0]),
						   GFP_KERNEL);
684
	if (indio_dev->chan_attr_group.attrs == NULL) {
685 686
		ret = -ENOMEM;
		goto error_clear_attrs;
687
	}
688
	/* Copy across original attributes */
689 690 691 692
	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])
693 694 695
		       *attrcount_orig);
	attrn = attrcount_orig;
	/* Add all elements from the list. */
696 697 698 699
	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;
700

701 702
	indio_dev->groups[indio_dev->groupcounter++] =
		&indio_dev->chan_attr_group;
703

704
	return 0;
705

706 707
error_clear_attrs:
	list_for_each_entry_safe(p, n,
708
				 &indio_dev->channel_attr_list, l) {
709
		list_del(&p->l);
710
		iio_device_remove_and_free_read_attr(indio_dev, p);
711 712
	}

713
	return ret;
714 715
}

716
static void iio_device_unregister_sysfs(struct iio_dev *indio_dev)
717
{
718 719

	struct iio_dev_attr *p, *n;
720

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

static void iio_dev_release(struct device *device)
{
730 731 732 733 734 735
	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);
736
	iio_device_unregister_debugfs(indio_dev);
737 738 739 740 741 742 743
}

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

744
struct iio_dev *iio_device_alloc(int sizeof_priv)
745
{
746 747 748 749 750 751 752 753 754 755 756 757
	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);
758 759

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

		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);
776 777 778 779
	}

	return dev;
}
780
EXPORT_SYMBOL(iio_device_alloc);
781

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

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

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

802
	filp->private_data = indio_dev;
803

804
	return 0;
805 806 807
}

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

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

846 847
static const struct iio_buffer_setup_ops noop_ring_setup_ops;

848
int iio_device_register(struct iio_dev *indio_dev)
849 850 851
{
	int ret;

852
	/* configure elements for the chrdev */
853
	indio_dev->dev.devt = MKDEV(MAJOR(iio_devt), indio_dev->id);
854

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

876 877 878 879
	if ((indio_dev->modes & INDIO_ALL_BUFFER_MODES) &&
		indio_dev->setup_ops == NULL)
		indio_dev->setup_ops = &noop_ring_setup_ops;

880
	ret = device_add(&indio_dev->dev);
881 882
	if (ret < 0)
		goto error_unreg_eventset;
883 884 885
	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);
886 887
	if (ret < 0)
		goto error_del_device;
888 889 890
	return 0;

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

903
void iio_device_unregister(struct iio_dev *indio_dev)
904
{
905 906 907
	mutex_lock(&indio_dev->info_exist_lock);
	indio_dev->info = NULL;
	mutex_unlock(&indio_dev->info_exist_lock);
908
	device_unregister(&indio_dev->dev);
909 910 911 912 913 914 915 916
}
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");