i2c-core-base.c 66.5 KB
Newer Older
1
// SPDX-License-Identifier: GPL-2.0-or-later
2 3 4 5 6 7 8 9
/*
 * Linux I2C core
 *
 * Copyright (C) 1995-99 Simon G. Vogl
 *   With some changes from Kyösti Mälkki <kmalkki@cc.hut.fi>
 *   Mux support by Rodolfo Giometti <giometti@enneenne.com> and
 *   Michael Lawnick <michael.lawnick.ext@nsn.com>
 *
10
 * Copyright (C) 2013-2017 Wolfram Sang <wsa@kernel.org>
11
 */
L
Linus Torvalds 已提交
12

W
Wolfram Sang 已提交
13 14
#define pr_fmt(fmt) "i2c-core: " fmt

W
Wolfram Sang 已提交
15
#include <dt-bindings/i2c/i2c.h>
W
Wolfram Sang 已提交
16 17 18
#include <linux/acpi.h>
#include <linux/clk/clk-conf.h>
#include <linux/completion.h>
19
#include <linux/delay.h>
W
Wolfram Sang 已提交
20
#include <linux/err.h>
L
Linus Torvalds 已提交
21
#include <linux/errno.h>
22
#include <linux/gpio/consumer.h>
L
Linus Torvalds 已提交
23
#include <linux/i2c.h>
24
#include <linux/i2c-smbus.h>
L
Linus Torvalds 已提交
25
#include <linux/idr.h>
W
Wolfram Sang 已提交
26 27 28 29 30
#include <linux/init.h>
#include <linux/irqflags.h>
#include <linux/jump_label.h>
#include <linux/kernel.h>
#include <linux/module.h>
31
#include <linux/mutex.h>
32
#include <linux/of_device.h>
W
Wolfram Sang 已提交
33
#include <linux/of.h>
34
#include <linux/of_irq.h>
35
#include <linux/pinctrl/consumer.h>
36
#include <linux/pm_domain.h>
W
Wolfram Sang 已提交
37
#include <linux/pm_runtime.h>
38
#include <linux/pm_wakeirq.h>
39
#include <linux/property.h>
W
Wolfram Sang 已提交
40 41
#include <linux/rwsem.h>
#include <linux/slab.h>
L
Linus Torvalds 已提交
42

43 44
#include "i2c-core.h"

45 46
#define CREATE_TRACE_POINTS
#include <trace/events/i2c.h>
L
Linus Torvalds 已提交
47

48 49 50
#define I2C_ADDR_OFFSET_TEN_BIT	0xa000
#define I2C_ADDR_OFFSET_SLAVE	0x1000

51 52 53
#define I2C_ADDR_7BITS_MAX	0x77
#define I2C_ADDR_7BITS_COUNT	(I2C_ADDR_7BITS_MAX + 1)

54 55
#define I2C_ADDR_DEVICE_ID	0x7c

56 57
/*
 * core_lock protects i2c_adapter_idr, and guarantees that device detection,
58
 * deletion of detected devices are serialized
59
 */
J
Jean Delvare 已提交
60
static DEFINE_MUTEX(core_lock);
L
Linus Torvalds 已提交
61 62
static DEFINE_IDR(i2c_adapter_idr);

63
static int i2c_detect(struct i2c_adapter *adapter, struct i2c_driver *driver);
64

65
static DEFINE_STATIC_KEY_FALSE(i2c_trace_msg_key);
66
static bool is_registered;
67

68
int i2c_transfer_trace_reg(void)
69
{
70
	static_branch_inc(&i2c_trace_msg_key);
71
	return 0;
72 73 74 75
}

void i2c_transfer_trace_unreg(void)
{
76
	static_branch_dec(&i2c_trace_msg_key);
77 78
}

79
const struct i2c_device_id *i2c_match_id(const struct i2c_device_id *id,
80 81
						const struct i2c_client *client)
{
82 83 84
	if (!(id && client))
		return NULL;

85 86 87 88 89 90 91
	while (id->name[0]) {
		if (strcmp(client->name, id->name) == 0)
			return id;
		id++;
	}
	return NULL;
}
92
EXPORT_SYMBOL_GPL(i2c_match_id);
93

L
Linus Torvalds 已提交
94 95
static int i2c_device_match(struct device *dev, struct device_driver *drv)
{
96 97 98
	struct i2c_client	*client = i2c_verify_client(dev);
	struct i2c_driver	*driver;

D
David Brownell 已提交
99

100
	/* Attempt an OF style match */
101
	if (i2c_of_match_device(drv->of_match_table, client))
102 103
		return 1;

104 105 106 107
	/* Then ACPI style match */
	if (acpi_driver_match_device(dev, drv))
		return 1;

108
	driver = to_i2c_driver(drv);
109 110 111 112

	/* Finally an I2C match */
	if (i2c_match_id(driver->id_table, client))
		return 1;
113

114
	return 0;
L
Linus Torvalds 已提交
115 116
}

117
static int i2c_device_uevent(struct device *dev, struct kobj_uevent_env *env)
D
David Brownell 已提交
118
{
119
	struct i2c_client *client = to_i2c_client(dev);
120 121
	int rc;

122 123 124 125
	rc = of_device_uevent_modalias(dev, env);
	if (rc != -ENODEV)
		return rc;

126 127 128
	rc = acpi_device_uevent_modalias(dev, env);
	if (rc != -ENODEV)
		return rc;
D
David Brownell 已提交
129

130
	return add_uevent_var(env, "MODALIAS=%s%s", I2C_MODULE_PREFIX, client->name);
D
David Brownell 已提交
131 132
}

133 134 135
/* i2c bus recovery routines */
static int get_scl_gpio_value(struct i2c_adapter *adap)
{
136
	return gpiod_get_value_cansleep(adap->bus_recovery_info->scl_gpiod);
137 138 139 140
}

static void set_scl_gpio_value(struct i2c_adapter *adap, int val)
{
141
	gpiod_set_value_cansleep(adap->bus_recovery_info->scl_gpiod, val);
142 143 144 145
}

static int get_sda_gpio_value(struct i2c_adapter *adap)
{
146
	return gpiod_get_value_cansleep(adap->bus_recovery_info->sda_gpiod);
147 148
}

149
static void set_sda_gpio_value(struct i2c_adapter *adap, int val)
150
{
151
	gpiod_set_value_cansleep(adap->bus_recovery_info->sda_gpiod, val);
152 153
}

154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169
static int i2c_generic_bus_free(struct i2c_adapter *adap)
{
	struct i2c_bus_recovery_info *bri = adap->bus_recovery_info;
	int ret = -EOPNOTSUPP;

	if (bri->get_bus_free)
		ret = bri->get_bus_free(adap);
	else if (bri->get_sda)
		ret = bri->get_sda(adap);

	if (ret < 0)
		return ret;

	return ret ? 0 : -EBUSY;
}

170 171 172 173 174 175 176 177
/*
 * We are generating clock pulses. ndelay() determines durating of clk pulses.
 * We will generate clock with rate 100 KHz and so duration of both clock levels
 * is: delay in ns = (10^6 / 100) / 2
 */
#define RECOVERY_NDELAY		5000
#define RECOVERY_CLK_CNT	9

178
int i2c_generic_scl_recovery(struct i2c_adapter *adap)
179 180
{
	struct i2c_bus_recovery_info *bri = adap->bus_recovery_info;
181
	int i = 0, scl = 1, ret = 0;
182 183

	if (bri->prepare_recovery)
184
		bri->prepare_recovery(adap);
185 186
	if (bri->pinctrl)
		pinctrl_select_state(bri->pinctrl, bri->pins_gpio);
187

188 189 190 191
	/*
	 * If we can set SDA, we will always create a STOP to ensure additional
	 * pulses will do no harm. This is achieved by letting SDA follow SCL
	 * half a cycle later. Check the 'incomplete_write_byte' fault injector
192 193
	 * for details. Note that we must honour tsu:sto, 4us, but lets use 5us
	 * here for simplicity.
194
	 */
195
	bri->set_scl(adap, scl);
196
	ndelay(RECOVERY_NDELAY);
197
	if (bri->set_sda)
198 199
		bri->set_sda(adap, scl);
	ndelay(RECOVERY_NDELAY / 2);
200

201 202 203 204
	/*
	 * By this time SCL is high, as we need to give 9 falling-rising edges
	 */
	while (i++ < RECOVERY_CLK_CNT * 2) {
205
		if (scl) {
206 207 208 209 210 211 212 213 214
			/* SCL shouldn't be low here */
			if (!bri->get_scl(adap)) {
				dev_err(&adap->dev,
					"SCL is stuck low, exit recovery\n");
				ret = -EBUSY;
				break;
			}
		}

215 216
		scl = !scl;
		bri->set_scl(adap, scl);
217
		/* Creating STOP again, see above */
218 219 220 221 222 223 224
		if (scl)  {
			/* Honour minimum tsu:sto */
			ndelay(RECOVERY_NDELAY);
		} else {
			/* Honour minimum tf and thd:dat */
			ndelay(RECOVERY_NDELAY / 2);
		}
225
		if (bri->set_sda)
226
			bri->set_sda(adap, scl);
227
		ndelay(RECOVERY_NDELAY / 2);
228

229
		if (scl) {
230
			ret = i2c_generic_bus_free(adap);
231 232 233
			if (ret == 0)
				break;
		}
234 235
	}

236 237 238 239
	/* If we can't check bus status, assume recovery worked */
	if (ret == -EOPNOTSUPP)
		ret = 0;

240
	if (bri->unprepare_recovery)
241
		bri->unprepare_recovery(adap);
242 243
	if (bri->pinctrl)
		pinctrl_select_state(bri->pinctrl, bri->pins_default);
244 245 246

	return ret;
}
247
EXPORT_SYMBOL_GPL(i2c_generic_scl_recovery);
248 249 250 251 252 253 254 255 256

int i2c_recover_bus(struct i2c_adapter *adap)
{
	if (!adap->bus_recovery_info)
		return -EOPNOTSUPP;

	dev_dbg(&adap->dev, "Trying i2c bus recovery\n");
	return adap->bus_recovery_info->recover_bus(adap);
}
257
EXPORT_SYMBOL_GPL(i2c_recover_bus);
258

259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377
static void i2c_gpio_init_pinctrl_recovery(struct i2c_adapter *adap)
{
	struct i2c_bus_recovery_info *bri = adap->bus_recovery_info;
	struct device *dev = &adap->dev;
	struct pinctrl *p = bri->pinctrl;

	/*
	 * we can't change states without pinctrl, so remove the states if
	 * populated
	 */
	if (!p) {
		bri->pins_default = NULL;
		bri->pins_gpio = NULL;
		return;
	}

	if (!bri->pins_default) {
		bri->pins_default = pinctrl_lookup_state(p,
							 PINCTRL_STATE_DEFAULT);
		if (IS_ERR(bri->pins_default)) {
			dev_dbg(dev, PINCTRL_STATE_DEFAULT " state not found for GPIO recovery\n");
			bri->pins_default = NULL;
		}
	}
	if (!bri->pins_gpio) {
		bri->pins_gpio = pinctrl_lookup_state(p, "gpio");
		if (IS_ERR(bri->pins_gpio))
			bri->pins_gpio = pinctrl_lookup_state(p, "recovery");

		if (IS_ERR(bri->pins_gpio)) {
			dev_dbg(dev, "no gpio or recovery state found for GPIO recovery\n");
			bri->pins_gpio = NULL;
		}
	}

	/* for pinctrl state changes, we need all the information */
	if (bri->pins_default && bri->pins_gpio) {
		dev_info(dev, "using pinctrl states for GPIO recovery");
	} else {
		bri->pinctrl = NULL;
		bri->pins_default = NULL;
		bri->pins_gpio = NULL;
	}
}

static int i2c_gpio_init_generic_recovery(struct i2c_adapter *adap)
{
	struct i2c_bus_recovery_info *bri = adap->bus_recovery_info;
	struct device *dev = &adap->dev;
	struct gpio_desc *gpiod;
	int ret = 0;

	/*
	 * don't touch the recovery information if the driver is not using
	 * generic SCL recovery
	 */
	if (bri->recover_bus && bri->recover_bus != i2c_generic_scl_recovery)
		return 0;

	/*
	 * pins might be taken as GPIO, so we should inform pinctrl about
	 * this and move the state to GPIO
	 */
	if (bri->pinctrl)
		pinctrl_select_state(bri->pinctrl, bri->pins_gpio);

	/*
	 * if there is incomplete or no recovery information, see if generic
	 * GPIO recovery is available
	 */
	if (!bri->scl_gpiod) {
		gpiod = devm_gpiod_get(dev, "scl", GPIOD_OUT_HIGH_OPEN_DRAIN);
		if (PTR_ERR(gpiod) == -EPROBE_DEFER) {
			ret  = -EPROBE_DEFER;
			goto cleanup_pinctrl_state;
		}
		if (!IS_ERR(gpiod)) {
			bri->scl_gpiod = gpiod;
			bri->recover_bus = i2c_generic_scl_recovery;
			dev_info(dev, "using generic GPIOs for recovery\n");
		}
	}

	/* SDA GPIOD line is optional, so we care about DEFER only */
	if (!bri->sda_gpiod) {
		/*
		 * We have SCL. Pull SCL low and wait a bit so that SDA glitches
		 * have no effect.
		 */
		gpiod_direction_output(bri->scl_gpiod, 0);
		udelay(10);
		gpiod = devm_gpiod_get(dev, "sda", GPIOD_IN);

		/* Wait a bit in case of a SDA glitch, and then release SCL. */
		udelay(10);
		gpiod_direction_output(bri->scl_gpiod, 1);

		if (PTR_ERR(gpiod) == -EPROBE_DEFER) {
			ret = -EPROBE_DEFER;
			goto cleanup_pinctrl_state;
		}
		if (!IS_ERR(gpiod))
			bri->sda_gpiod = gpiod;
	}

cleanup_pinctrl_state:
	/* change the state of the pins back to their default state */
	if (bri->pinctrl)
		pinctrl_select_state(bri->pinctrl, bri->pins_default);

	return ret;
}

static int i2c_gpio_init_recovery(struct i2c_adapter *adap)
{
	i2c_gpio_init_pinctrl_recovery(adap);
	return i2c_gpio_init_generic_recovery(adap);
}

378
static int i2c_init_recovery(struct i2c_adapter *adap)
379 380 381 382 383
{
	struct i2c_bus_recovery_info *bri = adap->bus_recovery_info;
	char *err_str;

	if (!bri)
384
		return 0;
385

386 387
	if (i2c_gpio_init_recovery(adap) == -EPROBE_DEFER)
		return -EPROBE_DEFER;
388

389 390 391 392 393
	if (!bri->recover_bus) {
		err_str = "no recover_bus() found";
		goto err;
	}

394
	if (bri->scl_gpiod && bri->recover_bus == i2c_generic_scl_recovery) {
395 396
		bri->get_scl = get_scl_gpio_value;
		bri->set_scl = set_scl_gpio_value;
397
		if (bri->sda_gpiod) {
398
			bri->get_sda = get_sda_gpio_value;
399 400 401 402
			/* FIXME: add proper flag instead of '0' once available */
			if (gpiod_get_direction(bri->sda_gpiod) == 0)
				bri->set_sda = set_sda_gpio_value;
		}
403
	} else if (bri->recover_bus == i2c_generic_scl_recovery) {
404 405 406 407 408
		/* Generic SCL recovery */
		if (!bri->set_scl || !bri->get_scl) {
			err_str = "no {get|set}_scl() found";
			goto err;
		}
409 410 411 412
		if (!bri->set_sda && !bri->get_sda) {
			err_str = "either get_sda() or set_sda() needed";
			goto err;
		}
413 414
	}

415
	return 0;
416 417 418
 err:
	dev_err(&adap->dev, "Not using recovery: %s\n", err_str);
	adap->bus_recovery_info = NULL;
419 420

	return -EINVAL;
421 422
}

423 424 425 426 427 428 429 430 431 432 433
static int i2c_smbus_host_notify_to_irq(const struct i2c_client *client)
{
	struct i2c_adapter *adap = client->adapter;
	unsigned int irq;

	if (!adap->host_notify_domain)
		return -ENXIO;

	if (client->flags & I2C_CLIENT_TEN)
		return -EINVAL;

434
	irq = irq_create_mapping(adap->host_notify_domain, client->addr);
435 436 437 438

	return irq > 0 ? irq : -ENXIO;
}

439
static int i2c_device_probe(struct device *dev)
L
Linus Torvalds 已提交
440
{
441 442
	struct i2c_client	*client = i2c_verify_client(dev);
	struct i2c_driver	*driver;
443
	int status;
D
David Brownell 已提交
444

445 446 447
	if (!client)
		return 0;

448 449
	client->irq = client->init_irq;

450
	if (!client->irq) {
451 452
		int irq = -ENOENT;

453 454
		if (client->flags & I2C_CLIENT_HOST_NOTIFY) {
			dev_dbg(dev, "Using Host Notify IRQ\n");
455 456
			/* Keep adapter active when Host Notify is required */
			pm_runtime_get_sync(&client->adapter->dev);
457 458
			irq = i2c_smbus_host_notify_to_irq(client);
		} else if (dev->of_node) {
459 460 461 462
			irq = of_irq_get_byname(dev->of_node, "irq");
			if (irq == -EINVAL || irq == -ENODATA)
				irq = of_irq_get(dev->of_node, 0);
		} else if (ACPI_COMPANION(dev)) {
463
			irq = i2c_acpi_get_irq(client);
464
		}
465 466 467 468
		if (irq == -EPROBE_DEFER) {
			status = irq;
			goto put_sync_adapter;
		}
469

470 471
		if (irq < 0)
			irq = 0;
472 473 474 475

		client->irq = irq;
	}

476 477
	driver = to_i2c_driver(dev->driver);

478
	/*
479 480
	 * An I2C ID table is not mandatory, if and only if, a suitable OF
	 * or ACPI ID table is supplied for the probing device.
481 482
	 */
	if (!driver->id_table &&
483
	    !acpi_driver_match_device(dev, dev->driver) &&
484 485 486 487
	    !i2c_of_match_device(dev->driver->of_match_table, client)) {
		status = -ENODEV;
		goto put_sync_adapter;
	}
488

489
	if (client->flags & I2C_CLIENT_WAKE) {
490
		int wakeirq;
491

492
		wakeirq = of_irq_get_byname(dev->of_node, "wakeup");
493 494 495 496
		if (wakeirq == -EPROBE_DEFER) {
			status = wakeirq;
			goto put_sync_adapter;
		}
497 498 499 500 501 502

		device_init_wakeup(&client->dev, true);

		if (wakeirq > 0 && wakeirq != client->irq)
			status = dev_pm_set_dedicated_wake_irq(dev, wakeirq);
		else if (client->irq > 0)
G
Grygorii Strashko 已提交
503
			status = dev_pm_set_wake_irq(dev, client->irq);
504 505 506 507
		else
			status = 0;

		if (status)
508
			dev_warn(&client->dev, "failed to set up wakeup irq\n");
509 510
	}

D
David Brownell 已提交
511
	dev_dbg(dev, "probe\n");
512

513 514
	status = of_clk_set_defaults(dev->of_node, false);
	if (status < 0)
515
		goto err_clear_wakeup_irq;
516

517
	status = dev_pm_domain_attach(&client->dev, true);
518
	if (status)
519 520
		goto err_clear_wakeup_irq;

521 522 523 524 525 526 527 528 529 530 531 532
	/*
	 * When there are no more users of probe(),
	 * rename probe_new to probe.
	 */
	if (driver->probe_new)
		status = driver->probe_new(client);
	else if (driver->probe)
		status = driver->probe(client,
				       i2c_match_id(driver->id_table, client));
	else
		status = -EINVAL;

533 534
	if (status)
		goto err_detach_pm_domain;
535

536 537 538 539 540 541 542
	return 0;

err_detach_pm_domain:
	dev_pm_domain_detach(&client->dev, true);
err_clear_wakeup_irq:
	dev_pm_clear_wake_irq(&client->dev);
	device_init_wakeup(&client->dev, false);
543 544 545 546
put_sync_adapter:
	if (client->flags & I2C_CLIENT_HOST_NOTIFY)
		pm_runtime_put_sync(&client->adapter->dev);

547
	return status;
548
}
L
Linus Torvalds 已提交
549

550 551
static int i2c_device_remove(struct device *dev)
{
552
	struct i2c_client	*client = i2c_verify_client(dev);
D
David Brownell 已提交
553
	struct i2c_driver	*driver;
554
	int status = 0;
D
David Brownell 已提交
555

556
	if (!client || !dev->driver)
D
David Brownell 已提交
557 558 559 560 561 562 563
		return 0;

	driver = to_i2c_driver(dev->driver);
	if (driver->remove) {
		dev_dbg(dev, "remove\n");
		status = driver->remove(client);
	}
564

565
	dev_pm_domain_detach(&client->dev, true);
566 567 568 569

	dev_pm_clear_wake_irq(&client->dev);
	device_init_wakeup(&client->dev, false);

570
	client->irq = 0;
571 572
	if (client->flags & I2C_CLIENT_HOST_NOTIFY)
		pm_runtime_put(&client->adapter->dev);
573

D
David Brownell 已提交
574
	return status;
L
Linus Torvalds 已提交
575 576
}

577
static void i2c_device_shutdown(struct device *dev)
L
Linus Torvalds 已提交
578
{
579
	struct i2c_client *client = i2c_verify_client(dev);
580 581
	struct i2c_driver *driver;

582
	if (!client || !dev->driver)
583 584 585
		return;
	driver = to_i2c_driver(dev->driver);
	if (driver->shutdown)
586
		driver->shutdown(client);
L
Linus Torvalds 已提交
587 588
}

589 590 591 592 593
static void i2c_client_dev_release(struct device *dev)
{
	kfree(to_i2c_client(dev));
}

Z
Zhenwen Xu 已提交
594
static ssize_t
595
name_show(struct device *dev, struct device_attribute *attr, char *buf)
D
David Brownell 已提交
596
{
597 598
	return sprintf(buf, "%s\n", dev->type == &i2c_client_type ?
		       to_i2c_client(dev)->name : to_i2c_adapter(dev)->name);
D
David Brownell 已提交
599
}
600
static DEVICE_ATTR_RO(name);
D
David Brownell 已提交
601

Z
Zhenwen Xu 已提交
602
static ssize_t
603
modalias_show(struct device *dev, struct device_attribute *attr, char *buf)
D
David Brownell 已提交
604 605
{
	struct i2c_client *client = to_i2c_client(dev);
606 607
	int len;

608 609 610 611
	len = of_device_modalias(dev, buf, PAGE_SIZE);
	if (len != -ENODEV)
		return len;

612 613 614 615
	len = acpi_device_modalias(dev, buf, PAGE_SIZE -1);
	if (len != -ENODEV)
		return len;

616
	return sprintf(buf, "%s%s\n", I2C_MODULE_PREFIX, client->name);
D
David Brownell 已提交
617
}
618
static DEVICE_ATTR_RO(modalias);
619 620 621

static struct attribute *i2c_dev_attrs[] = {
	&dev_attr_name.attr,
D
David Brownell 已提交
622
	/* modalias helps coldplug:  modprobe $(cat .../modalias) */
623 624 625
	&dev_attr_modalias.attr,
	NULL
};
626
ATTRIBUTE_GROUPS(i2c_dev);
627

J
Jon Smirl 已提交
628
struct bus_type i2c_bus_type = {
629 630 631 632 633
	.name		= "i2c",
	.match		= i2c_device_match,
	.probe		= i2c_device_probe,
	.remove		= i2c_device_remove,
	.shutdown	= i2c_device_shutdown,
634
};
J
Jon Smirl 已提交
635
EXPORT_SYMBOL_GPL(i2c_bus_type);
636

637
struct device_type i2c_client_type = {
638
	.groups		= i2c_dev_groups,
639 640 641
	.uevent		= i2c_device_uevent,
	.release	= i2c_client_dev_release,
};
642
EXPORT_SYMBOL_GPL(i2c_client_type);
643

644 645 646 647 648 649 650 651 652 653 654 655

/**
 * i2c_verify_client - return parameter as i2c_client, or NULL
 * @dev: device, probably from some driver model iterator
 *
 * When traversing the driver model tree, perhaps using driver model
 * iterators like @device_for_each_child(), you can't assume very much
 * about the nodes you find.  Use this function to avoid oopses caused
 * by wrongly treating some non-I2C device as an i2c_client.
 */
struct i2c_client *i2c_verify_client(struct device *dev)
{
656
	return (dev->type == &i2c_client_type)
657 658 659 660 661 662
			? to_i2c_client(dev)
			: NULL;
}
EXPORT_SYMBOL(i2c_verify_client);


663 664 665 666 667 668 669 670 671 672 673 674 675 676 677
/* Return a unique address which takes the flags of the client into account */
static unsigned short i2c_encode_flags_to_addr(struct i2c_client *client)
{
	unsigned short addr = client->addr;

	/* For some client flags, add an arbitrary offset to avoid collisions */
	if (client->flags & I2C_CLIENT_TEN)
		addr |= I2C_ADDR_OFFSET_TEN_BIT;

	if (client->flags & I2C_CLIENT_SLAVE)
		addr |= I2C_ADDR_OFFSET_SLAVE;

	return addr;
}

678
/* This is a permissive address validity check, I2C address map constraints
L
Lucas De Marchi 已提交
679
 * are purposely not enforced, except for the general call address. */
680
static int i2c_check_addr_validity(unsigned int addr, unsigned short flags)
681
{
682
	if (flags & I2C_CLIENT_TEN) {
683
		/* 10-bit address, all values are valid */
684
		if (addr > 0x3ff)
685 686 687
			return -EINVAL;
	} else {
		/* 7-bit address, reject the general call address */
688
		if (addr == 0x00 || addr > 0x7f)
689 690 691 692 693
			return -EINVAL;
	}
	return 0;
}

694 695 696 697
/* And this is a strict address validity check, used when probing. If a
 * device uses a reserved address, then it shouldn't be probed. 7-bit
 * addressing is assumed, 10-bit address devices are rare and should be
 * explicitly enumerated. */
698
int i2c_check_7bit_addr_validity_strict(unsigned short addr)
699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714
{
	/*
	 * Reserved addresses per I2C specification:
	 *  0x00       General call address / START byte
	 *  0x01       CBUS address
	 *  0x02       Reserved for different bus format
	 *  0x03       Reserved for future purposes
	 *  0x04-0x07  Hs-mode master code
	 *  0x78-0x7b  10-bit slave addressing
	 *  0x7c-0x7f  Reserved for future purposes
	 */
	if (addr < 0x08 || addr > 0x77)
		return -EINVAL;
	return 0;
}

715 716 717 718 719
static int __i2c_check_addr_busy(struct device *dev, void *addrp)
{
	struct i2c_client	*client = i2c_verify_client(dev);
	int			addr = *(int *)addrp;

720
	if (client && i2c_encode_flags_to_addr(client) == addr)
721 722 723 724
		return -EBUSY;
	return 0;
}

725 726 727
/* walk up mux tree */
static int i2c_check_mux_parents(struct i2c_adapter *adapter, int addr)
{
728
	struct i2c_adapter *parent = i2c_parent_is_i2c_adapter(adapter);
729 730 731 732 733
	int result;

	result = device_for_each_child(&adapter->dev, &addr,
					__i2c_check_addr_busy);

734 735
	if (!result && parent)
		result = i2c_check_mux_parents(parent, addr);
736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753

	return result;
}

/* recurse down mux tree */
static int i2c_check_mux_children(struct device *dev, void *addrp)
{
	int result;

	if (dev->type == &i2c_adapter_type)
		result = device_for_each_child(dev, addrp,
						i2c_check_mux_children);
	else
		result = __i2c_check_addr_busy(dev, addrp);

	return result;
}

754 755
static int i2c_check_addr_busy(struct i2c_adapter *adapter, int addr)
{
756
	struct i2c_adapter *parent = i2c_parent_is_i2c_adapter(adapter);
757 758
	int result = 0;

759 760
	if (parent)
		result = i2c_check_mux_parents(parent, addr);
761 762 763 764 765 766

	if (!result)
		result = device_for_each_child(&adapter->dev, &addr,
						i2c_check_mux_children);

	return result;
767 768
}

769
/**
770
 * i2c_adapter_lock_bus - Get exclusive access to an I2C bus segment
771
 * @adapter: Target I2C bus segment
772 773
 * @flags: I2C_LOCK_ROOT_ADAPTER locks the root i2c adapter, I2C_LOCK_SEGMENT
 *	locks only this branch in the adapter tree
774
 */
775 776
static void i2c_adapter_lock_bus(struct i2c_adapter *adapter,
				 unsigned int flags)
777
{
778
	rt_mutex_lock_nested(&adapter->bus_lock, i2c_adapter_depth(adapter));
779 780 781
}

/**
782
 * i2c_adapter_trylock_bus - Try to get exclusive access to an I2C bus segment
783
 * @adapter: Target I2C bus segment
784 785
 * @flags: I2C_LOCK_ROOT_ADAPTER trylocks the root i2c adapter, I2C_LOCK_SEGMENT
 *	trylocks only this branch in the adapter tree
786
 */
787 788
static int i2c_adapter_trylock_bus(struct i2c_adapter *adapter,
				   unsigned int flags)
789
{
790
	return rt_mutex_trylock(&adapter->bus_lock);
791 792 793
}

/**
794
 * i2c_adapter_unlock_bus - Release exclusive access to an I2C bus segment
795
 * @adapter: Target I2C bus segment
796 797
 * @flags: I2C_LOCK_ROOT_ADAPTER unlocks the root i2c adapter, I2C_LOCK_SEGMENT
 *	unlocks only this branch in the adapter tree
798
 */
799 800
static void i2c_adapter_unlock_bus(struct i2c_adapter *adapter,
				   unsigned int flags)
801
{
802
	rt_mutex_unlock(&adapter->bus_lock);
803 804
}

805
static void i2c_dev_set_name(struct i2c_adapter *adap,
806 807
			     struct i2c_client *client,
			     struct i2c_board_info const *info)
808 809 810
{
	struct acpi_device *adev = ACPI_COMPANION(&client->dev);

811 812 813 814 815
	if (info && info->dev_name) {
		dev_set_name(&client->dev, "i2c-%s", info->dev_name);
		return;
	}

816 817 818 819 820 821
	if (adev) {
		dev_set_name(&client->dev, "i2c-%s", acpi_dev_name(adev));
		return;
	}

	dev_set_name(&client->dev, "%d-%04x", i2c_adapter_id(adap),
822
		     i2c_encode_flags_to_addr(client));
823 824
}

825 826
int i2c_dev_irq_from_resources(const struct resource *resources,
			       unsigned int num_resources)
827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850
{
	struct irq_data *irqd;
	int i;

	for (i = 0; i < num_resources; i++) {
		const struct resource *r = &resources[i];

		if (resource_type(r) != IORESOURCE_IRQ)
			continue;

		if (r->flags & IORESOURCE_BITS) {
			irqd = irq_get_irq_data(r->start);
			if (!irqd)
				break;

			irqd_set_trigger_type(irqd, r->flags & IORESOURCE_BITS);
		}

		return r->start;
	}

	return 0;
}

851
/**
852
 * i2c_new_client_device - instantiate an i2c device
853 854
 * @adap: the adapter managing the device
 * @info: describes one I2C device; bus_num is ignored
D
David Brownell 已提交
855
 * Context: can sleep
856
 *
857 858 859 860 861 862
 * Create an i2c device. Binding is handled through driver model
 * probe()/remove() methods.  A driver may be bound to this device when we
 * return from this function, or any later moment (e.g. maybe hotplugging will
 * load the driver module).  This call is not appropriate for use by mainboard
 * initialization logic, which usually runs during an arch_initcall() long
 * before any i2c_adapter could exist.
863 864
 *
 * This returns the new i2c client, which may be saved for later use with
865
 * i2c_unregister_device(); or an ERR_PTR to describe the error.
866
 */
867
struct i2c_client *
868
i2c_new_client_device(struct i2c_adapter *adap, struct i2c_board_info const *info)
869 870 871 872 873 874
{
	struct i2c_client	*client;
	int			status;

	client = kzalloc(sizeof *client, GFP_KERNEL);
	if (!client)
875
		return ERR_PTR(-ENOMEM);
876 877 878 879

	client->adapter = adap;

	client->dev.platform_data = info->platform_data;
M
Marc Pignat 已提交
880
	client->flags = info->flags;
881
	client->addr = info->addr;
882

883 884 885
	client->init_irq = info->irq;
	if (!client->init_irq)
		client->init_irq = i2c_dev_irq_from_resources(info->resources,
886
							 info->num_resources);
887 888 889

	strlcpy(client->name, info->type, sizeof(client->name));

890
	status = i2c_check_addr_validity(client->addr, client->flags);
891 892 893 894 895 896
	if (status) {
		dev_err(&adap->dev, "Invalid %d-bit I2C address 0x%02hx\n",
			client->flags & I2C_CLIENT_TEN ? 10 : 7, client->addr);
		goto out_err_silent;
	}

897
	/* Check for address business */
898
	status = i2c_check_addr_busy(adap, i2c_encode_flags_to_addr(client));
899 900 901 902 903
	if (status)
		goto out_err;

	client->dev.parent = &client->adapter->dev;
	client->dev.bus = &i2c_bus_type;
904
	client->dev.type = &i2c_client_type;
905
	client->dev.of_node = of_node_get(info->of_node);
906
	client->dev.fwnode = info->fwnode;
907

908
	i2c_dev_set_name(adap, client, info);
909 910 911 912 913 914 915

	if (info->properties) {
		status = device_add_properties(&client->dev, info->properties);
		if (status) {
			dev_err(&adap->dev,
				"Failed to add properties to client %s: %d\n",
				client->name, status);
916
			goto out_err_put_of_node;
917 918 919
		}
	}

920 921
	status = device_register(&client->dev);
	if (status)
922
		goto out_free_props;
923 924 925 926

	dev_dbg(&adap->dev, "client [%s] registered with bus id %s\n",
		client->name, dev_name(&client->dev));

927
	return client;
928

929 930 931
out_free_props:
	if (info->properties)
		device_remove_properties(&client->dev);
932 933
out_err_put_of_node:
	of_node_put(info->of_node);
934
out_err:
935 936 937
	dev_err(&adap->dev,
		"Failed to register i2c client %s at 0x%02x (%d)\n",
		client->name, client->addr, status);
938
out_err_silent:
939
	kfree(client);
940 941 942 943
	return ERR_PTR(status);
}
EXPORT_SYMBOL_GPL(i2c_new_client_device);

944
/**
945 946
 * i2c_unregister_device - reverse effect of i2c_new_*_device()
 * @client: value returned from i2c_new_*_device()
D
David Brownell 已提交
947
 * Context: can sleep
948 949
 */
void i2c_unregister_device(struct i2c_client *client)
D
David Brownell 已提交
950
{
951
	if (IS_ERR_OR_NULL(client))
952
		return;
953 954

	if (client->dev.of_node) {
955
		of_node_clear_flag(client->dev.of_node, OF_POPULATED);
956 957 958
		of_node_put(client->dev.of_node);
	}

959 960
	if (ACPI_COMPANION(&client->dev))
		acpi_device_clear_enumerated(ACPI_COMPANION(&client->dev));
D
David Brownell 已提交
961 962
	device_unregister(&client->dev);
}
963
EXPORT_SYMBOL_GPL(i2c_unregister_device);
D
David Brownell 已提交
964 965


J
Jean Delvare 已提交
966 967 968 969 970
static const struct i2c_device_id dummy_id[] = {
	{ "dummy", 0 },
	{ },
};

971 972 973 974 975 976 977
static int dummy_probe(struct i2c_client *client,
		       const struct i2c_device_id *id)
{
	return 0;
}

static int dummy_remove(struct i2c_client *client)
978 979 980 981 982 983
{
	return 0;
}

static struct i2c_driver dummy_driver = {
	.driver.name	= "dummy",
984 985
	.probe		= dummy_probe,
	.remove		= dummy_remove,
J
Jean Delvare 已提交
986
	.id_table	= dummy_id,
987 988 989
};

/**
990
 * i2c_new_dummy_device - return a new i2c device bound to a dummy driver
991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004
 * @adapter: the adapter managing the device
 * @address: seven bit address to be used
 * Context: can sleep
 *
 * This returns an I2C client bound to the "dummy" driver, intended for use
 * with devices that consume multiple addresses.  Examples of such chips
 * include various EEPROMS (like 24c04 and 24c08 models).
 *
 * These dummy devices have two main uses.  First, most I2C and SMBus calls
 * except i2c_transfer() need a client handle; the dummy will be that handle.
 * And second, this prevents the specified address from being bound to a
 * different driver.
 *
 * This returns the new i2c client, which should be saved for later use with
1005
 * i2c_unregister_device(); or an ERR_PTR to describe the error.
1006
 */
1007
struct i2c_client *i2c_new_dummy_device(struct i2c_adapter *adapter, u16 address)
1008 1009
{
	struct i2c_board_info info = {
J
Jean Delvare 已提交
1010
		I2C_BOARD_INFO("dummy", address),
1011 1012
	};

1013 1014 1015 1016
	return i2c_new_client_device(adapter, &info);
}
EXPORT_SYMBOL_GPL(i2c_new_dummy_device);

1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060
struct i2c_dummy_devres {
	struct i2c_client *client;
};

static void devm_i2c_release_dummy(struct device *dev, void *res)
{
	struct i2c_dummy_devres *this = res;

	i2c_unregister_device(this->client);
}

/**
 * devm_i2c_new_dummy_device - return a new i2c device bound to a dummy driver
 * @dev: device the managed resource is bound to
 * @adapter: the adapter managing the device
 * @address: seven bit address to be used
 * Context: can sleep
 *
 * This is the device-managed version of @i2c_new_dummy_device. It returns the
 * new i2c client or an ERR_PTR in case of an error.
 */
struct i2c_client *devm_i2c_new_dummy_device(struct device *dev,
					     struct i2c_adapter *adapter,
					     u16 address)
{
	struct i2c_dummy_devres *dr;
	struct i2c_client *client;

	dr = devres_alloc(devm_i2c_release_dummy, sizeof(*dr), GFP_KERNEL);
	if (!dr)
		return ERR_PTR(-ENOMEM);

	client = i2c_new_dummy_device(adapter, address);
	if (IS_ERR(client)) {
		devres_free(dr);
	} else {
		dr->client = client;
		devres_add(dev, dr);
	}

	return client;
}
EXPORT_SYMBOL_GPL(devm_i2c_new_dummy_device);

1061
/**
1062
 * i2c_new_ancillary_device - Helper to get the instantiated secondary address
1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080
 * and create the associated device
 * @client: Handle to the primary client
 * @name: Handle to specify which secondary address to get
 * @default_addr: Used as a fallback if no secondary address was specified
 * Context: can sleep
 *
 * I2C clients can be composed of multiple I2C slaves bound together in a single
 * component. The I2C client driver then binds to the master I2C slave and needs
 * to create I2C dummy clients to communicate with all the other slaves.
 *
 * This function creates and returns an I2C dummy client whose I2C address is
 * retrieved from the platform firmware based on the given slave name. If no
 * address is specified by the firmware default_addr is used.
 *
 * On DT-based platforms the address is retrieved from the "reg" property entry
 * cell whose "reg-names" value matches the slave name.
 *
 * This returns the new i2c client, which should be saved for later use with
1081
 * i2c_unregister_device(); or an ERR_PTR to describe the error.
1082
 */
1083
struct i2c_client *i2c_new_ancillary_device(struct i2c_client *client,
1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097
						const char *name,
						u16 default_addr)
{
	struct device_node *np = client->dev.of_node;
	u32 addr = default_addr;
	int i;

	if (np) {
		i = of_property_match_string(np, "reg-names", name);
		if (i >= 0)
			of_property_read_u32_index(np, "reg", i, &addr);
	}

	dev_dbg(&client->adapter->dev, "Address for %s : 0x%x\n", name, addr);
1098
	return i2c_new_dummy_device(client->adapter, addr);
1099
}
1100
EXPORT_SYMBOL_GPL(i2c_new_ancillary_device);
1101

1102 1103
/* ------------------------------------------------------------------------- */

D
David Brownell 已提交
1104 1105
/* I2C bus adapters -- one roots each I2C or SMBUS segment */

A
Adrian Bunk 已提交
1106
static void i2c_adapter_dev_release(struct device *dev)
L
Linus Torvalds 已提交
1107
{
1108
	struct i2c_adapter *adap = to_i2c_adapter(dev);
L
Linus Torvalds 已提交
1109 1110 1111
	complete(&adap->dev_released);
}

1112
unsigned int i2c_adapter_depth(struct i2c_adapter *adapter)
1113 1114 1115 1116 1117 1118
{
	unsigned int depth = 0;

	while ((adapter = i2c_parent_is_i2c_adapter(adapter)))
		depth++;

1119 1120 1121
	WARN_ONCE(depth >= MAX_LOCKDEP_SUBCLASSES,
		  "adapter depth exceeds lockdep subclass limit\n");

1122 1123
	return depth;
}
1124
EXPORT_SYMBOL_GPL(i2c_adapter_depth);
1125

1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136
/*
 * Let users instantiate I2C devices through sysfs. This can be used when
 * platform initialization code doesn't contain the proper data for
 * whatever reason. Also useful for drivers that do device detection and
 * detection fails, either because the device uses an unexpected address,
 * or this is a compatible device with different ID register values.
 *
 * Parameter checking may look overzealous, but we really don't want
 * the user to provide incorrect parameters.
 */
static ssize_t
1137 1138
new_device_store(struct device *dev, struct device_attribute *attr,
		 const char *buf, size_t count)
1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169
{
	struct i2c_adapter *adap = to_i2c_adapter(dev);
	struct i2c_board_info info;
	struct i2c_client *client;
	char *blank, end;
	int res;

	memset(&info, 0, sizeof(struct i2c_board_info));

	blank = strchr(buf, ' ');
	if (!blank) {
		dev_err(dev, "%s: Missing parameters\n", "new_device");
		return -EINVAL;
	}
	if (blank - buf > I2C_NAME_SIZE - 1) {
		dev_err(dev, "%s: Invalid device name\n", "new_device");
		return -EINVAL;
	}
	memcpy(info.type, buf, blank - buf);

	/* Parse remaining parameters, reject extra parameters */
	res = sscanf(++blank, "%hi%c", &info.addr, &end);
	if (res < 1) {
		dev_err(dev, "%s: Can't parse I2C address\n", "new_device");
		return -EINVAL;
	}
	if (res > 1  && end != '\n') {
		dev_err(dev, "%s: Extra parameters\n", "new_device");
		return -EINVAL;
	}

1170 1171 1172 1173 1174 1175 1176 1177 1178 1179
	if ((info.addr & I2C_ADDR_OFFSET_TEN_BIT) == I2C_ADDR_OFFSET_TEN_BIT) {
		info.addr &= ~I2C_ADDR_OFFSET_TEN_BIT;
		info.flags |= I2C_CLIENT_TEN;
	}

	if (info.addr & I2C_ADDR_OFFSET_SLAVE) {
		info.addr &= ~I2C_ADDR_OFFSET_SLAVE;
		info.flags |= I2C_CLIENT_SLAVE;
	}

1180 1181 1182
	client = i2c_new_client_device(adap, &info);
	if (IS_ERR(client))
		return PTR_ERR(client);
1183 1184

	/* Keep track of the added device */
1185
	mutex_lock(&adap->userspace_clients_lock);
1186
	list_add_tail(&client->detected, &adap->userspace_clients);
1187
	mutex_unlock(&adap->userspace_clients_lock);
1188 1189 1190 1191 1192
	dev_info(dev, "%s: Instantiated device %s at 0x%02hx\n", "new_device",
		 info.type, info.addr);

	return count;
}
1193
static DEVICE_ATTR_WO(new_device);
1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204

/*
 * And of course let the users delete the devices they instantiated, if
 * they got it wrong. This interface can only be used to delete devices
 * instantiated by i2c_sysfs_new_device above. This guarantees that we
 * don't delete devices to which some kernel code still has references.
 *
 * Parameter checking may look overzealous, but we really don't want
 * the user to delete the wrong device.
 */
static ssize_t
1205 1206
delete_device_store(struct device *dev, struct device_attribute *attr,
		    const char *buf, size_t count)
1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226
{
	struct i2c_adapter *adap = to_i2c_adapter(dev);
	struct i2c_client *client, *next;
	unsigned short addr;
	char end;
	int res;

	/* Parse parameters, reject extra parameters */
	res = sscanf(buf, "%hi%c", &addr, &end);
	if (res < 1) {
		dev_err(dev, "%s: Can't parse I2C address\n", "delete_device");
		return -EINVAL;
	}
	if (res > 1  && end != '\n') {
		dev_err(dev, "%s: Extra parameters\n", "delete_device");
		return -EINVAL;
	}

	/* Make sure the device was added through sysfs */
	res = -ENOENT;
1227 1228
	mutex_lock_nested(&adap->userspace_clients_lock,
			  i2c_adapter_depth(adap));
1229 1230
	list_for_each_entry_safe(client, next, &adap->userspace_clients,
				 detected) {
1231
		if (i2c_encode_flags_to_addr(client) == addr) {
1232 1233 1234 1235 1236 1237 1238 1239 1240
			dev_info(dev, "%s: Deleting device %s at 0x%02hx\n",
				 "delete_device", client->name, client->addr);

			list_del(&client->detected);
			i2c_unregister_device(client);
			res = count;
			break;
		}
	}
1241
	mutex_unlock(&adap->userspace_clients_lock);
1242 1243 1244 1245 1246 1247

	if (res < 0)
		dev_err(dev, "%s: Can't find device in list\n",
			"delete_device");
	return res;
}
1248
static DEVICE_ATTR_IGNORE_LOCKDEP(delete_device, S_IWUSR, NULL,
1249
				  delete_device_store);
1250 1251 1252 1253 1254 1255 1256

static struct attribute *i2c_adapter_attrs[] = {
	&dev_attr_name.attr,
	&dev_attr_new_device.attr,
	&dev_attr_delete_device.attr,
	NULL
};
1257
ATTRIBUTE_GROUPS(i2c_adapter);
1258

1259
struct device_type i2c_adapter_type = {
1260
	.groups		= i2c_adapter_groups,
1261
	.release	= i2c_adapter_dev_release,
L
Linus Torvalds 已提交
1262
};
1263
EXPORT_SYMBOL_GPL(i2c_adapter_type);
L
Linus Torvalds 已提交
1264

1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281
/**
 * i2c_verify_adapter - return parameter as i2c_adapter or NULL
 * @dev: device, probably from some driver model iterator
 *
 * When traversing the driver model tree, perhaps using driver model
 * iterators like @device_for_each_child(), you can't assume very much
 * about the nodes you find.  Use this function to avoid oopses caused
 * by wrongly treating some non-I2C device as an i2c_adapter.
 */
struct i2c_adapter *i2c_verify_adapter(struct device *dev)
{
	return (dev->type == &i2c_adapter_type)
			? to_i2c_adapter(dev)
			: NULL;
}
EXPORT_SYMBOL(i2c_verify_adapter);

1282 1283 1284 1285
#ifdef CONFIG_I2C_COMPAT
static struct class_compat *i2c_adapter_compat_class;
#endif

1286 1287 1288 1289
static void i2c_scan_static_board_info(struct i2c_adapter *adapter)
{
	struct i2c_devinfo	*devinfo;

1290
	down_read(&__i2c_board_lock);
1291
	list_for_each_entry(devinfo, &__i2c_board_list, list) {
1292 1293
		if (devinfo->busnum == adapter->nr &&
		    IS_ERR(i2c_new_client_device(adapter, &devinfo->board_info)))
Z
Zhenwen Xu 已提交
1294 1295
			dev_err(&adapter->dev,
				"Can't create device at 0x%02x\n",
1296 1297
				devinfo->board_info.addr);
	}
1298
	up_read(&__i2c_board_lock);
1299 1300
}

J
Jean Delvare 已提交
1301 1302
static int i2c_do_add_adapter(struct i2c_driver *driver,
			      struct i2c_adapter *adap)
1303
{
1304 1305 1306
	/* Detect supported devices on that bus, and instantiate them */
	i2c_detect(adap, driver);

1307 1308 1309
	return 0;
}

J
Jean Delvare 已提交
1310 1311 1312 1313 1314
static int __process_new_adapter(struct device_driver *d, void *data)
{
	return i2c_do_add_adapter(to_i2c_driver(d), data);
}

1315 1316 1317 1318 1319 1320
static const struct i2c_lock_operations i2c_adapter_lock_ops = {
	.lock_bus =    i2c_adapter_lock_bus,
	.trylock_bus = i2c_adapter_trylock_bus,
	.unlock_bus =  i2c_adapter_unlock_bus,
};

1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355
static void i2c_host_notify_irq_teardown(struct i2c_adapter *adap)
{
	struct irq_domain *domain = adap->host_notify_domain;
	irq_hw_number_t hwirq;

	if (!domain)
		return;

	for (hwirq = 0 ; hwirq < I2C_ADDR_7BITS_COUNT ; hwirq++)
		irq_dispose_mapping(irq_find_mapping(domain, hwirq));

	irq_domain_remove(domain);
	adap->host_notify_domain = NULL;
}

static int i2c_host_notify_irq_map(struct irq_domain *h,
					  unsigned int virq,
					  irq_hw_number_t hw_irq_num)
{
	irq_set_chip_and_handler(virq, &dummy_irq_chip, handle_simple_irq);

	return 0;
}

static const struct irq_domain_ops i2c_host_notify_irq_ops = {
	.map = i2c_host_notify_irq_map,
};

static int i2c_setup_host_notify_irq_domain(struct i2c_adapter *adap)
{
	struct irq_domain *domain;

	if (!i2c_check_functionality(adap, I2C_FUNC_SMBUS_HOST_NOTIFY))
		return 0;

1356
	domain = irq_domain_create_linear(adap->dev.parent->fwnode,
1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393
					  I2C_ADDR_7BITS_COUNT,
					  &i2c_host_notify_irq_ops, adap);
	if (!domain)
		return -ENOMEM;

	adap->host_notify_domain = domain;

	return 0;
}

/**
 * i2c_handle_smbus_host_notify - Forward a Host Notify event to the correct
 * I2C client.
 * @adap: the adapter
 * @addr: the I2C address of the notifying device
 * Context: can't sleep
 *
 * Helper function to be called from an I2C bus driver's interrupt
 * handler. It will schedule the Host Notify IRQ.
 */
int i2c_handle_smbus_host_notify(struct i2c_adapter *adap, unsigned short addr)
{
	int irq;

	if (!adap)
		return -EINVAL;

	irq = irq_find_mapping(adap->host_notify_domain, addr);
	if (irq <= 0)
		return -ENXIO;

	generic_handle_irq(irq);

	return 0;
}
EXPORT_SYMBOL_GPL(i2c_handle_smbus_host_notify);

1394
static int i2c_register_adapter(struct i2c_adapter *adap)
L
Linus Torvalds 已提交
1395
{
1396
	int res = -EINVAL;
L
Linus Torvalds 已提交
1397

1398
	/* Can't register until after driver model init */
1399
	if (WARN_ON(!is_registered)) {
1400 1401 1402
		res = -EAGAIN;
		goto out_list;
	}
1403

1404
	/* Sanity checks */
1405
	if (WARN(!adap->name[0], "i2c adapter has no name"))
1406
		goto out_list;
1407 1408

	if (!adap->algo) {
W
Wolfram Sang 已提交
1409
		pr_err("adapter '%s': no algo supplied!\n", adap->name);
1410
		goto out_list;
1411 1412
	}

1413 1414
	if (!adap->lock_ops)
		adap->lock_ops = &i2c_adapter_lock_ops;
1415

1416
	adap->locked_flags = 0;
1417
	rt_mutex_init(&adap->bus_lock);
1418
	rt_mutex_init(&adap->mux_lock);
1419
	mutex_init(&adap->userspace_clients_lock);
1420
	INIT_LIST_HEAD(&adap->userspace_clients);
L
Linus Torvalds 已提交
1421

1422 1423 1424 1425
	/* Set default timeout to 1 second if not already set */
	if (adap->timeout == 0)
		adap->timeout = HZ;

1426 1427 1428 1429 1430 1431 1432 1433
	/* register soft irqs for Host Notify */
	res = i2c_setup_host_notify_irq_domain(adap);
	if (res) {
		pr_err("adapter '%s': can't create Host Notify IRQs (%d)\n",
		       adap->name, res);
		goto out_list;
	}

1434
	dev_set_name(&adap->dev, "i2c-%d", adap->nr);
1435 1436
	adap->dev.bus = &i2c_bus_type;
	adap->dev.type = &i2c_adapter_type;
1437
	res = device_register(&adap->dev);
1438
	if (res) {
W
Wolfram Sang 已提交
1439
		pr_err("adapter '%s': can't register device (%d)\n", adap->name, res);
1440
		goto out_list;
1441
	}
L
Linus Torvalds 已提交
1442

1443 1444 1445 1446
	res = of_i2c_setup_smbus_alert(adap);
	if (res)
		goto out_reg;

1447
	pm_runtime_no_callbacks(&adap->dev);
1448
	pm_suspend_ignore_children(&adap->dev, true);
1449
	pm_runtime_enable(&adap->dev);
1450

1451 1452 1453 1454 1455 1456
	res = i2c_init_recovery(adap);
	if (res == -EPROBE_DEFER)
		goto out_reg;

	dev_dbg(&adap->dev, "adapter [%s] registered\n", adap->name);

1457 1458 1459 1460 1461 1462 1463 1464
#ifdef CONFIG_I2C_COMPAT
	res = class_compat_create_link(i2c_adapter_compat_class, &adap->dev,
				       adap->dev.parent);
	if (res)
		dev_warn(&adap->dev,
			 "Failed to create compatibility class link\n");
#endif

1465
	/* create pre-declared device nodes */
1466
	of_i2c_register_devices(adap);
1467 1468
	i2c_acpi_register_devices(adap);
	i2c_acpi_install_space_handler(adap);
1469

1470 1471 1472
	if (adap->nr < __i2c_first_dynamic_bus_num)
		i2c_scan_static_board_info(adap);

1473
	/* Notify drivers */
1474
	mutex_lock(&core_lock);
J
Jean Delvare 已提交
1475
	bus_for_each_drv(&i2c_bus_type, NULL, adap, __process_new_adapter);
J
Jean Delvare 已提交
1476
	mutex_unlock(&core_lock);
1477 1478

	return 0;
1479

1480 1481 1482 1483
out_reg:
	init_completion(&adap->dev_released);
	device_unregister(&adap->dev);
	wait_for_completion(&adap->dev_released);
1484
out_list:
1485
	mutex_lock(&core_lock);
1486
	idr_remove(&i2c_adapter_idr, adap->nr);
1487 1488
	mutex_unlock(&core_lock);
	return res;
L
Linus Torvalds 已提交
1489 1490
}

1491 1492 1493 1494 1495 1496 1497 1498 1499
/**
 * __i2c_add_numbered_adapter - i2c_add_numbered_adapter where nr is never -1
 * @adap: the adapter to register (with adap->nr initialized)
 * Context: can sleep
 *
 * See i2c_add_numbered_adapter() for details.
 */
static int __i2c_add_numbered_adapter(struct i2c_adapter *adap)
{
1500
	int id;
1501 1502

	mutex_lock(&core_lock);
1503
	id = idr_alloc(&i2c_adapter_idr, adap, adap->nr, adap->nr + 1, GFP_KERNEL);
1504
	mutex_unlock(&core_lock);
1505
	if (WARN(id < 0, "couldn't get idr"))
1506 1507 1508 1509 1510
		return id == -ENOSPC ? -EBUSY : id;

	return i2c_register_adapter(adap);
}

1511 1512 1513
/**
 * i2c_add_adapter - declare i2c adapter, use dynamic bus number
 * @adapter: the adapter to add
D
David Brownell 已提交
1514
 * Context: can sleep
1515 1516
 *
 * This routine is used to declare an I2C adapter when its bus number
1517 1518 1519
 * doesn't matter or when its bus number is specified by an dt alias.
 * Examples of bases when the bus number doesn't matter: I2C adapters
 * dynamically added by USB links or PCI plugin cards.
1520 1521 1522 1523 1524 1525 1526
 *
 * When this returns zero, a new bus number was allocated and stored
 * in adap->nr, and the specified adapter became available for clients.
 * Otherwise, a negative errno value is returned.
 */
int i2c_add_adapter(struct i2c_adapter *adapter)
{
1527
	struct device *dev = &adapter->dev;
T
Tejun Heo 已提交
1528
	int id;
1529

1530 1531 1532 1533 1534 1535 1536 1537
	if (dev->of_node) {
		id = of_alias_get_id(dev->of_node, "i2c");
		if (id >= 0) {
			adapter->nr = id;
			return __i2c_add_numbered_adapter(adapter);
		}
	}

J
Jean Delvare 已提交
1538
	mutex_lock(&core_lock);
T
Tejun Heo 已提交
1539 1540
	id = idr_alloc(&i2c_adapter_idr, adapter,
		       __i2c_first_dynamic_bus_num, 0, GFP_KERNEL);
J
Jean Delvare 已提交
1541
	mutex_unlock(&core_lock);
1542
	if (WARN(id < 0, "couldn't get idr"))
T
Tejun Heo 已提交
1543
		return id;
1544 1545

	adapter->nr = id;
T
Tejun Heo 已提交
1546

1547 1548 1549 1550 1551 1552 1553
	return i2c_register_adapter(adapter);
}
EXPORT_SYMBOL(i2c_add_adapter);

/**
 * i2c_add_numbered_adapter - declare i2c adapter, use static bus number
 * @adap: the adapter to register (with adap->nr initialized)
D
David Brownell 已提交
1554
 * Context: can sleep
1555 1556
 *
 * This routine is used to declare an I2C adapter when its bus number
R
Randy Dunlap 已提交
1557 1558
 * matters.  For example, use it for I2C adapters from system-on-chip CPUs,
 * or otherwise built in to the system's mainboard, and where i2c_board_info
1559 1560
 * is used to properly configure I2C devices.
 *
1561 1562 1563
 * If the requested bus number is set to -1, then this function will behave
 * identically to i2c_add_adapter, and will dynamically assign a bus number.
 *
1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575
 * If no devices have pre-been declared for this bus, then be sure to
 * register the adapter before any dynamically allocated ones.  Otherwise
 * the required bus ID may not be available.
 *
 * When this returns zero, the specified adapter became available for
 * clients using the bus number provided in adap->nr.  Also, the table
 * of I2C devices pre-declared using i2c_register_board_info() is scanned,
 * and the appropriate driver model device nodes are created.  Otherwise, a
 * negative errno value is returned.
 */
int i2c_add_numbered_adapter(struct i2c_adapter *adap)
{
1576 1577
	if (adap->nr == -1) /* -1 means dynamically assign bus id */
		return i2c_add_adapter(adap);
1578

1579
	return __i2c_add_numbered_adapter(adap);
1580 1581 1582
}
EXPORT_SYMBOL_GPL(i2c_add_numbered_adapter);

L
Lars-Peter Clausen 已提交
1583
static void i2c_do_del_adapter(struct i2c_driver *driver,
J
Jean Delvare 已提交
1584
			      struct i2c_adapter *adapter)
1585
{
1586
	struct i2c_client *client, *_n;
1587

1588 1589
	/* Remove the devices we created ourselves as the result of hardware
	 * probing (using a driver's detect method) */
1590 1591 1592 1593 1594 1595 1596 1597
	list_for_each_entry_safe(client, _n, &driver->clients, detected) {
		if (client->adapter == adapter) {
			dev_dbg(&adapter->dev, "Removing %s at 0x%x\n",
				client->name, client->addr);
			list_del(&client->detected);
			i2c_unregister_device(client);
		}
	}
1598 1599
}

1600
static int __unregister_client(struct device *dev, void *dummy)
1601 1602 1603 1604 1605 1606 1607 1608
{
	struct i2c_client *client = i2c_verify_client(dev);
	if (client && strcmp(client->name, "dummy"))
		i2c_unregister_device(client);
	return 0;
}

static int __unregister_dummy(struct device *dev, void *dummy)
1609 1610
{
	struct i2c_client *client = i2c_verify_client(dev);
1611
	i2c_unregister_device(client);
1612 1613 1614
	return 0;
}

J
Jean Delvare 已提交
1615 1616
static int __process_removed_adapter(struct device_driver *d, void *data)
{
L
Lars-Peter Clausen 已提交
1617 1618
	i2c_do_del_adapter(to_i2c_driver(d), data);
	return 0;
J
Jean Delvare 已提交
1619 1620
}

D
David Brownell 已提交
1621 1622 1623 1624 1625 1626 1627 1628
/**
 * i2c_del_adapter - unregister I2C adapter
 * @adap: the adapter being unregistered
 * Context: can sleep
 *
 * This unregisters an I2C adapter which was previously registered
 * by @i2c_add_adapter or @i2c_add_numbered_adapter.
 */
1629
void i2c_del_adapter(struct i2c_adapter *adap)
L
Linus Torvalds 已提交
1630
{
1631
	struct i2c_adapter *found;
1632
	struct i2c_client *client, *next;
L
Linus Torvalds 已提交
1633 1634

	/* First make sure that this adapter was ever added */
1635 1636 1637 1638
	mutex_lock(&core_lock);
	found = idr_find(&i2c_adapter_idr, adap->nr);
	mutex_unlock(&core_lock);
	if (found != adap) {
W
Wolfram Sang 已提交
1639
		pr_debug("attempting to delete unregistered adapter [%s]\n", adap->name);
1640
		return;
L
Linus Torvalds 已提交
1641 1642
	}

1643
	i2c_acpi_remove_space_handler(adap);
1644
	/* Tell drivers about this removal */
1645
	mutex_lock(&core_lock);
L
Lars-Peter Clausen 已提交
1646
	bus_for_each_drv(&i2c_bus_type, NULL, adap,
J
Jean Delvare 已提交
1647
			       __process_removed_adapter);
1648
	mutex_unlock(&core_lock);
L
Linus Torvalds 已提交
1649

1650
	/* Remove devices instantiated from sysfs */
1651 1652
	mutex_lock_nested(&adap->userspace_clients_lock,
			  i2c_adapter_depth(adap));
1653 1654 1655 1656 1657 1658
	list_for_each_entry_safe(client, next, &adap->userspace_clients,
				 detected) {
		dev_dbg(&adap->dev, "Removing %s at 0x%x\n", client->name,
			client->addr);
		list_del(&client->detected);
		i2c_unregister_device(client);
1659
	}
1660
	mutex_unlock(&adap->userspace_clients_lock);
1661

1662
	/* Detach any active clients. This can't fail, thus we do not
1663 1664 1665 1666
	 * check the returned value. This is a two-pass process, because
	 * we can't remove the dummy devices during the first pass: they
	 * could have been instantiated by real devices wishing to clean
	 * them up properly, so we give them a chance to do that first. */
L
Lars-Peter Clausen 已提交
1667 1668
	device_for_each_child(&adap->dev, NULL, __unregister_client);
	device_for_each_child(&adap->dev, NULL, __unregister_dummy);
L
Linus Torvalds 已提交
1669

1670 1671 1672 1673 1674
#ifdef CONFIG_I2C_COMPAT
	class_compat_remove_link(i2c_adapter_compat_class, &adap->dev,
				 adap->dev.parent);
#endif

1675 1676 1677
	/* device name is gone after device_unregister */
	dev_dbg(&adap->dev, "adapter [%s] unregistered\n", adap->name);

1678 1679
	pm_runtime_disable(&adap->dev);

1680 1681
	i2c_host_notify_irq_teardown(adap);

1682 1683 1684 1685 1686
	/* wait until all references to the device are gone
	 *
	 * FIXME: This is old code and should ideally be replaced by an
	 * alternative which results in decoupling the lifetime of the struct
	 * device from the i2c_adapter, like spi or netdev do. Any solution
1687
	 * should be thoroughly tested with DEBUG_KOBJECT_RELEASE enabled!
1688
	 */
L
Linus Torvalds 已提交
1689 1690 1691 1692
	init_completion(&adap->dev_released);
	device_unregister(&adap->dev);
	wait_for_completion(&adap->dev_released);

1693
	/* free bus id */
1694
	mutex_lock(&core_lock);
L
Linus Torvalds 已提交
1695
	idr_remove(&i2c_adapter_idr, adap->nr);
1696
	mutex_unlock(&core_lock);
L
Linus Torvalds 已提交
1697

1698 1699 1700
	/* Clear the device structure in case this adapter is ever going to be
	   added again */
	memset(&adap->dev, 0, sizeof(adap->dev));
L
Linus Torvalds 已提交
1701
}
D
David Brownell 已提交
1702
EXPORT_SYMBOL(i2c_del_adapter);
L
Linus Torvalds 已提交
1703

W
Wolfram Sang 已提交
1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715
static void i2c_parse_timing(struct device *dev, char *prop_name, u32 *cur_val_p,
			    u32 def_val, bool use_def)
{
	int ret;

	ret = device_property_read_u32(dev, prop_name, cur_val_p);
	if (ret && use_def)
		*cur_val_p = def_val;

	dev_dbg(dev, "%s: %u\n", prop_name, *cur_val_p);
}

1716 1717 1718 1719 1720
/**
 * i2c_parse_fw_timings - get I2C related timing parameters from firmware
 * @dev: The device to scan for I2C timing properties
 * @t: the i2c_timings struct to be filled with values
 * @use_defaults: bool to use sane defaults derived from the I2C specification
1721
 *		  when properties are not found, otherwise don't update
1722 1723 1724 1725 1726
 *
 * Scan the device for the generic I2C properties describing timing parameters
 * for the signal and fill the given struct with the results. If a property was
 * not found and use_defaults was true, then maximum timings are assumed which
 * are derived from the I2C specification. If use_defaults is not used, the
1727 1728 1729 1730
 * results will be as before, so drivers can apply their own defaults before
 * calling this helper. The latter is mainly intended for avoiding regressions
 * of existing drivers which want to switch to this function. New drivers
 * almost always should use the defaults.
1731 1732 1733
 */
void i2c_parse_fw_timings(struct device *dev, struct i2c_timings *t, bool use_defaults)
{
W
Wolfram Sang 已提交
1734 1735
	bool u = use_defaults;
	u32 d;
1736

W
Wolfram Sang 已提交
1737 1738
	i2c_parse_timing(dev, "clock-frequency", &t->bus_freq_hz,
			 I2C_MAX_STANDARD_MODE_FREQ, u);
1739

W
Wolfram Sang 已提交
1740 1741 1742
	d = t->bus_freq_hz <= I2C_MAX_STANDARD_MODE_FREQ ? 1000 :
	    t->bus_freq_hz <= I2C_MAX_FAST_MODE_FREQ ? 300 : 120;
	i2c_parse_timing(dev, "i2c-scl-rising-time-ns", &t->scl_rise_ns, d, u);
1743

W
Wolfram Sang 已提交
1744 1745
	d = t->bus_freq_hz <= I2C_MAX_FAST_MODE_FREQ ? 300 : 120;
	i2c_parse_timing(dev, "i2c-scl-falling-time-ns", &t->scl_fall_ns, d, u);
1746

W
Wolfram Sang 已提交
1747 1748 1749 1750 1751 1752 1753 1754 1755
	i2c_parse_timing(dev, "i2c-scl-internal-delay-ns",
			 &t->scl_int_delay_ns, 0, u);
	i2c_parse_timing(dev, "i2c-sda-falling-time-ns", &t->sda_fall_ns,
			 t->scl_fall_ns, u);
	i2c_parse_timing(dev, "i2c-sda-hold-time-ns", &t->sda_hold_ns, 0, u);
	i2c_parse_timing(dev, "i2c-digital-filter-width-ns",
			 &t->digital_filter_width_ns, 0, u);
	i2c_parse_timing(dev, "i2c-analog-filter-cutoff-frequency",
			 &t->analog_filter_cutoff_freq_hz, 0, u);
1756 1757 1758
}
EXPORT_SYMBOL_GPL(i2c_parse_fw_timings);

D
David Brownell 已提交
1759 1760
/* ------------------------------------------------------------------------- */

1761
int i2c_for_each_dev(void *data, int (*fn)(struct device *dev, void *data))
J
Jean Delvare 已提交
1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772
{
	int res;

	mutex_lock(&core_lock);
	res = bus_for_each_dev(&i2c_bus_type, NULL, data, fn);
	mutex_unlock(&core_lock);

	return res;
}
EXPORT_SYMBOL_GPL(i2c_for_each_dev);

J
Jean Delvare 已提交
1773
static int __process_new_driver(struct device *dev, void *data)
D
Dave Young 已提交
1774
{
1775 1776
	if (dev->type != &i2c_adapter_type)
		return 0;
J
Jean Delvare 已提交
1777
	return i2c_do_add_adapter(data, to_i2c_adapter(dev));
D
Dave Young 已提交
1778 1779
}

D
David Brownell 已提交
1780 1781
/*
 * An i2c_driver is used with one or more i2c_client (device) nodes to access
1782
 * i2c slave chips, on a bus instance associated with some i2c_adapter.
L
Linus Torvalds 已提交
1783 1784
 */

1785
int i2c_register_driver(struct module *owner, struct i2c_driver *driver)
L
Linus Torvalds 已提交
1786
{
1787
	int res;
L
Linus Torvalds 已提交
1788

1789
	/* Can't register until after driver model init */
1790
	if (WARN_ON(!is_registered))
1791 1792
		return -EAGAIN;

L
Linus Torvalds 已提交
1793
	/* add the driver to the list of i2c drivers in the driver core */
1794
	driver->driver.owner = owner;
L
Linus Torvalds 已提交
1795
	driver->driver.bus = &i2c_bus_type;
1796
	INIT_LIST_HEAD(&driver->clients);
L
Linus Torvalds 已提交
1797

1798
	/* When registration returns, the driver core
1799 1800
	 * will have called probe() for all matching-but-unbound devices.
	 */
L
Linus Torvalds 已提交
1801 1802
	res = driver_register(&driver->driver);
	if (res)
1803
		return res;
D
David Brownell 已提交
1804

W
Wolfram Sang 已提交
1805
	pr_debug("driver [%s] registered\n", driver->driver.name);
L
Linus Torvalds 已提交
1806

1807
	/* Walk the adapters that are already present */
J
Jean Delvare 已提交
1808
	i2c_for_each_dev(driver, __process_new_driver);
1809

D
Dave Young 已提交
1810 1811 1812 1813
	return 0;
}
EXPORT_SYMBOL(i2c_register_driver);

J
Jean Delvare 已提交
1814
static int __process_removed_driver(struct device *dev, void *data)
D
Dave Young 已提交
1815
{
L
Lars-Peter Clausen 已提交
1816 1817 1818
	if (dev->type == &i2c_adapter_type)
		i2c_do_del_adapter(data, to_i2c_adapter(dev));
	return 0;
L
Linus Torvalds 已提交
1819 1820
}

D
David Brownell 已提交
1821 1822 1823
/**
 * i2c_del_driver - unregister I2C driver
 * @driver: the driver being unregistered
D
David Brownell 已提交
1824
 * Context: can sleep
D
David Brownell 已提交
1825
 */
1826
void i2c_del_driver(struct i2c_driver *driver)
L
Linus Torvalds 已提交
1827
{
J
Jean Delvare 已提交
1828
	i2c_for_each_dev(driver, __process_removed_driver);
L
Linus Torvalds 已提交
1829 1830

	driver_unregister(&driver->driver);
W
Wolfram Sang 已提交
1831
	pr_debug("driver [%s] unregistered\n", driver->driver.name);
L
Linus Torvalds 已提交
1832
}
D
David Brownell 已提交
1833
EXPORT_SYMBOL(i2c_del_driver);
L
Linus Torvalds 已提交
1834

D
David Brownell 已提交
1835 1836
/* ------------------------------------------------------------------------- */

1837 1838 1839 1840 1841 1842 1843 1844 1845
struct i2c_cmd_arg {
	unsigned	cmd;
	void		*arg;
};

static int i2c_cmd(struct device *dev, void *_arg)
{
	struct i2c_client	*client = i2c_verify_client(dev);
	struct i2c_cmd_arg	*arg = _arg;
1846 1847 1848 1849
	struct i2c_driver	*driver;

	if (!client || !client->dev.driver)
		return 0;
1850

1851 1852 1853
	driver = to_i2c_driver(client->dev.driver);
	if (driver->command)
		driver->command(client, arg->cmd, arg->arg);
1854 1855 1856
	return 0;
}

L
Linus Torvalds 已提交
1857 1858
void i2c_clients_command(struct i2c_adapter *adap, unsigned int cmd, void *arg)
{
1859
	struct i2c_cmd_arg	cmd_arg;
L
Linus Torvalds 已提交
1860

1861 1862 1863
	cmd_arg.cmd = cmd;
	cmd_arg.arg = arg;
	device_for_each_child(&adap->dev, &cmd_arg, i2c_cmd);
L
Linus Torvalds 已提交
1864
}
D
David Brownell 已提交
1865
EXPORT_SYMBOL(i2c_clients_command);
L
Linus Torvalds 已提交
1866 1867 1868 1869 1870

static int __init i2c_init(void)
{
	int retval;

1871 1872 1873 1874 1875 1876 1877
	retval = of_alias_get_highest_id("i2c");

	down_write(&__i2c_board_lock);
	if (retval >= __i2c_first_dynamic_bus_num)
		__i2c_first_dynamic_bus_num = retval + 1;
	up_write(&__i2c_board_lock);

L
Linus Torvalds 已提交
1878 1879 1880
	retval = bus_register(&i2c_bus_type);
	if (retval)
		return retval;
1881 1882 1883

	is_registered = true;

1884 1885 1886 1887 1888 1889 1890
#ifdef CONFIG_I2C_COMPAT
	i2c_adapter_compat_class = class_compat_register("i2c-adapter");
	if (!i2c_adapter_compat_class) {
		retval = -ENOMEM;
		goto bus_err;
	}
#endif
1891 1892
	retval = i2c_add_driver(&dummy_driver);
	if (retval)
1893
		goto class_err;
1894 1895 1896

	if (IS_ENABLED(CONFIG_OF_DYNAMIC))
		WARN_ON(of_reconfig_notifier_register(&i2c_of_notifier));
1897 1898
	if (IS_ENABLED(CONFIG_ACPI))
		WARN_ON(acpi_reconfig_notifier_register(&i2c_acpi_notifier));
1899

1900 1901
	return 0;

1902 1903 1904
class_err:
#ifdef CONFIG_I2C_COMPAT
	class_compat_unregister(i2c_adapter_compat_class);
1905
bus_err:
1906
#endif
1907
	is_registered = false;
1908 1909
	bus_unregister(&i2c_bus_type);
	return retval;
L
Linus Torvalds 已提交
1910 1911 1912 1913
}

static void __exit i2c_exit(void)
{
1914 1915
	if (IS_ENABLED(CONFIG_ACPI))
		WARN_ON(acpi_reconfig_notifier_unregister(&i2c_acpi_notifier));
1916 1917
	if (IS_ENABLED(CONFIG_OF_DYNAMIC))
		WARN_ON(of_reconfig_notifier_unregister(&i2c_of_notifier));
1918
	i2c_del_driver(&dummy_driver);
1919 1920 1921
#ifdef CONFIG_I2C_COMPAT
	class_compat_unregister(i2c_adapter_compat_class);
#endif
L
Linus Torvalds 已提交
1922
	bus_unregister(&i2c_bus_type);
1923
	tracepoint_synchronize_unregister();
L
Linus Torvalds 已提交
1924 1925
}

D
David Brownell 已提交
1926 1927 1928 1929
/* We must initialize early, because some subsystems register i2c drivers
 * in subsys_initcall() code, but are linked (and initialized) before i2c.
 */
postcore_initcall(i2c_init);
L
Linus Torvalds 已提交
1930 1931 1932 1933 1934 1935 1936
module_exit(i2c_exit);

/* ----------------------------------------------------
 * the functional interface to the i2c busses.
 * ----------------------------------------------------
 */

W
Wolfram Sang 已提交
1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984 1985 1986
/* Check if val is exceeding the quirk IFF quirk is non 0 */
#define i2c_quirk_exceeded(val, quirk) ((quirk) && ((val) > (quirk)))

static int i2c_quirk_error(struct i2c_adapter *adap, struct i2c_msg *msg, char *err_msg)
{
	dev_err_ratelimited(&adap->dev, "adapter quirk: %s (addr 0x%04x, size %u, %s)\n",
			    err_msg, msg->addr, msg->len,
			    msg->flags & I2C_M_RD ? "read" : "write");
	return -EOPNOTSUPP;
}

static int i2c_check_for_quirks(struct i2c_adapter *adap, struct i2c_msg *msgs, int num)
{
	const struct i2c_adapter_quirks *q = adap->quirks;
	int max_num = q->max_num_msgs, i;
	bool do_len_check = true;

	if (q->flags & I2C_AQ_COMB) {
		max_num = 2;

		/* special checks for combined messages */
		if (num == 2) {
			if (q->flags & I2C_AQ_COMB_WRITE_FIRST && msgs[0].flags & I2C_M_RD)
				return i2c_quirk_error(adap, &msgs[0], "1st comb msg must be write");

			if (q->flags & I2C_AQ_COMB_READ_SECOND && !(msgs[1].flags & I2C_M_RD))
				return i2c_quirk_error(adap, &msgs[1], "2nd comb msg must be read");

			if (q->flags & I2C_AQ_COMB_SAME_ADDR && msgs[0].addr != msgs[1].addr)
				return i2c_quirk_error(adap, &msgs[0], "comb msg only to same addr");

			if (i2c_quirk_exceeded(msgs[0].len, q->max_comb_1st_msg_len))
				return i2c_quirk_error(adap, &msgs[0], "msg too long");

			if (i2c_quirk_exceeded(msgs[1].len, q->max_comb_2nd_msg_len))
				return i2c_quirk_error(adap, &msgs[1], "msg too long");

			do_len_check = false;
		}
	}

	if (i2c_quirk_exceeded(num, max_num))
		return i2c_quirk_error(adap, &msgs[0], "too many messages");

	for (i = 0; i < num; i++) {
		u16 len = msgs[i].len;

		if (msgs[i].flags & I2C_M_RD) {
			if (do_len_check && i2c_quirk_exceeded(len, q->max_read_len))
				return i2c_quirk_error(adap, &msgs[i], "msg too long");
1987 1988 1989

			if (q->flags & I2C_AQ_NO_ZERO_LEN_READ && len == 0)
				return i2c_quirk_error(adap, &msgs[i], "no zero length");
W
Wolfram Sang 已提交
1990 1991 1992
		} else {
			if (do_len_check && i2c_quirk_exceeded(len, q->max_write_len))
				return i2c_quirk_error(adap, &msgs[i], "msg too long");
1993 1994 1995

			if (q->flags & I2C_AQ_NO_ZERO_LEN_WRITE && len == 0)
				return i2c_quirk_error(adap, &msgs[i], "no zero length");
W
Wolfram Sang 已提交
1996 1997 1998 1999 2000 2001
		}
	}

	return 0;
}

2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 2014 2015 2016 2017 2018
/**
 * __i2c_transfer - unlocked flavor of i2c_transfer
 * @adap: Handle to I2C bus
 * @msgs: One or more messages to execute before STOP is issued to
 *	terminate the operation; each message begins with a START.
 * @num: Number of messages to be executed.
 *
 * Returns negative errno, else the number of messages executed.
 *
 * Adapter lock must be held when calling this function. No debug logging
 * takes place. adap->algo->master_xfer existence isn't checked.
 */
int __i2c_transfer(struct i2c_adapter *adap, struct i2c_msg *msgs, int num)
{
	unsigned long orig_jiffies;
	int ret, try;

2019 2020
	if (WARN_ON(!msgs || num < 1))
		return -EINVAL;
2021 2022 2023 2024

	ret = __i2c_check_suspended(adap);
	if (ret)
		return ret;
2025

W
Wolfram Sang 已提交
2026 2027 2028
	if (adap->quirks && i2c_check_for_quirks(adap, msgs, num))
		return -EOPNOTSUPP;

2029 2030
	/*
	 * i2c_trace_msg_key gets enabled when tracepoint i2c_transfer gets
2031 2032 2033
	 * enabled.  This is an efficient way of keeping the for-loop from
	 * being executed when not needed.
	 */
2034
	if (static_branch_unlikely(&i2c_trace_msg_key)) {
2035 2036 2037 2038 2039 2040 2041 2042
		int i;
		for (i = 0; i < num; i++)
			if (msgs[i].flags & I2C_M_RD)
				trace_i2c_read(adap, &msgs[i], i);
			else
				trace_i2c_write(adap, &msgs[i], i);
	}

2043 2044 2045
	/* Retry automatically on arbitration loss */
	orig_jiffies = jiffies;
	for (ret = 0, try = 0; try <= adap->retries; try++) {
2046 2047 2048 2049 2050
		if (i2c_in_atomic_xfer_mode() && adap->algo->master_xfer_atomic)
			ret = adap->algo->master_xfer_atomic(adap, msgs, num);
		else
			ret = adap->algo->master_xfer(adap, msgs, num);

2051 2052 2053 2054 2055 2056
		if (ret != -EAGAIN)
			break;
		if (time_after(jiffies, orig_jiffies + adap->timeout))
			break;
	}

2057
	if (static_branch_unlikely(&i2c_trace_msg_key)) {
2058 2059 2060 2061
		int i;
		for (i = 0; i < ret; i++)
			if (msgs[i].flags & I2C_M_RD)
				trace_i2c_reply(adap, &msgs[i], i);
2062
		trace_i2c_result(adap, num, ret);
2063 2064
	}

2065 2066 2067 2068
	return ret;
}
EXPORT_SYMBOL(__i2c_transfer);

2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080
/**
 * i2c_transfer - execute a single or combined I2C message
 * @adap: Handle to I2C bus
 * @msgs: One or more messages to execute before STOP is issued to
 *	terminate the operation; each message begins with a START.
 * @num: Number of messages to be executed.
 *
 * Returns negative errno, else the number of messages executed.
 *
 * Note that there is no requirement that each message be sent to
 * the same slave address, although that is the most common model.
 */
Z
Zhenwen Xu 已提交
2081
int i2c_transfer(struct i2c_adapter *adap, struct i2c_msg *msgs, int num)
L
Linus Torvalds 已提交
2082
{
2083
	int ret;
L
Linus Torvalds 已提交
2084

2085 2086 2087 2088 2089
	if (!adap->algo->master_xfer) {
		dev_dbg(&adap->dev, "I2C level transfers not supported\n");
		return -EOPNOTSUPP;
	}

2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105
	/* REVISIT the fault reporting model here is weak:
	 *
	 *  - When we get an error after receiving N bytes from a slave,
	 *    there is no way to report "N".
	 *
	 *  - When we get a NAK after transmitting N bytes to a slave,
	 *    there is no way to report "N" ... or to let the master
	 *    continue executing the rest of this combined message, if
	 *    that's the appropriate response.
	 *
	 *  - When for example "num" is two and we successfully complete
	 *    the first message but get an error part way through the
	 *    second, it's unclear whether that should be reported as
	 *    one (discarding status on the second message) or errno
	 *    (discarding status on the first one).
	 */
2106 2107 2108
	ret = __i2c_lock_bus_helper(adap);
	if (ret)
		return ret;
2109 2110 2111 2112 2113

	ret = __i2c_transfer(adap, msgs, num);
	i2c_unlock_bus(adap, I2C_LOCK_SEGMENT);

	return ret;
L
Linus Torvalds 已提交
2114
}
D
David Brownell 已提交
2115
EXPORT_SYMBOL(i2c_transfer);
L
Linus Torvalds 已提交
2116

2117
/**
2118 2119
 * i2c_transfer_buffer_flags - issue a single I2C message transferring data
 *			       to/from a buffer
2120
 * @client: Handle to slave device
2121 2122 2123
 * @buf: Where the data is stored
 * @count: How many bytes to transfer, must be less than 64k since msg.len is u16
 * @flags: The flags to be used for the message, e.g. I2C_M_RD for reads
2124
 *
2125
 * Returns negative errno, or else the number of bytes transferred.
2126
 */
2127 2128
int i2c_transfer_buffer_flags(const struct i2c_client *client, char *buf,
			      int count, u16 flags)
L
Linus Torvalds 已提交
2129 2130
{
	int ret;
2131 2132 2133 2134 2135 2136
	struct i2c_msg msg = {
		.addr = client->addr,
		.flags = flags | (client->flags & I2C_M_TEN),
		.len = count,
		.buf = buf,
	};
2137

2138
	ret = i2c_transfer(client->adapter, &msg, 1);
2139

2140
	/*
2141 2142
	 * If everything went ok (i.e. 1 msg transferred), return #bytes
	 * transferred, else error code.
2143
	 */
2144
	return (ret == 1) ? count : ret;
L
Linus Torvalds 已提交
2145
}
2146
EXPORT_SYMBOL(i2c_transfer_buffer_flags);
L
Linus Torvalds 已提交
2147

2148 2149 2150 2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169 2170 2171 2172 2173 2174 2175 2176 2177 2178
/**
 * i2c_get_device_id - get manufacturer, part id and die revision of a device
 * @client: The device to query
 * @id: The queried information
 *
 * Returns negative errno on error, zero on success.
 */
int i2c_get_device_id(const struct i2c_client *client,
		      struct i2c_device_identity *id)
{
	struct i2c_adapter *adap = client->adapter;
	union i2c_smbus_data raw_id;
	int ret;

	if (!i2c_check_functionality(adap, I2C_FUNC_SMBUS_READ_I2C_BLOCK))
		return -EOPNOTSUPP;

	raw_id.block[0] = 3;
	ret = i2c_smbus_xfer(adap, I2C_ADDR_DEVICE_ID, 0,
			     I2C_SMBUS_READ, client->addr << 1,
			     I2C_SMBUS_I2C_BLOCK_DATA, &raw_id);
	if (ret)
		return ret;

	id->manufacturer_id = (raw_id.block[1] << 4) | (raw_id.block[2] >> 4);
	id->part_id = ((raw_id.block[2] & 0xf) << 5) | (raw_id.block[3] >> 3);
	id->die_revision = raw_id.block[3] & 0x7;
	return 0;
}
EXPORT_SYMBOL_GPL(i2c_get_device_id);

L
Linus Torvalds 已提交
2179 2180 2181 2182 2183 2184
/* ----------------------------------------------------
 * the i2c address scanning function
 * Will not work for 10-bit addresses!
 * ----------------------------------------------------
 */

2185 2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196 2197 2198 2199 2200 2201 2202 2203 2204 2205 2206 2207 2208
/*
 * Legacy default probe function, mostly relevant for SMBus. The default
 * probe method is a quick write, but it is known to corrupt the 24RF08
 * EEPROMs due to a state machine bug, and could also irreversibly
 * write-protect some EEPROMs, so for address ranges 0x30-0x37 and 0x50-0x5f,
 * we use a short byte read instead. Also, some bus drivers don't implement
 * quick write, so we fallback to a byte read in that case too.
 * On x86, there is another special case for FSC hardware monitoring chips,
 * which want regular byte reads (address 0x73.) Fortunately, these are the
 * only known chips using this I2C address on PC hardware.
 * Returns 1 if probe succeeded, 0 if not.
 */
static int i2c_default_probe(struct i2c_adapter *adap, unsigned short addr)
{
	int err;
	union i2c_smbus_data dummy;

#ifdef CONFIG_X86
	if (addr == 0x73 && (adap->class & I2C_CLASS_HWMON)
	 && i2c_check_functionality(adap, I2C_FUNC_SMBUS_READ_BYTE_DATA))
		err = i2c_smbus_xfer(adap, addr, 0, I2C_SMBUS_READ, 0,
				     I2C_SMBUS_BYTE_DATA, &dummy);
	else
#endif
2209 2210
	if (!((addr & ~0x07) == 0x30 || (addr & ~0x0f) == 0x50)
	 && i2c_check_functionality(adap, I2C_FUNC_SMBUS_QUICK))
2211 2212
		err = i2c_smbus_xfer(adap, addr, 0, I2C_SMBUS_WRITE, 0,
				     I2C_SMBUS_QUICK, NULL);
2213 2214 2215 2216
	else if (i2c_check_functionality(adap, I2C_FUNC_SMBUS_READ_BYTE))
		err = i2c_smbus_xfer(adap, addr, 0, I2C_SMBUS_READ, 0,
				     I2C_SMBUS_BYTE, &dummy);
	else {
2217 2218
		dev_warn(&adap->dev, "No suitable probing method supported for address 0x%02X\n",
			 addr);
2219 2220
		err = -EOPNOTSUPP;
	}
2221 2222 2223 2224

	return err >= 0;
}

J
Jean Delvare 已提交
2225
static int i2c_detect_address(struct i2c_client *temp_client,
2226 2227 2228 2229 2230 2231 2232 2233
			      struct i2c_driver *driver)
{
	struct i2c_board_info info;
	struct i2c_adapter *adapter = temp_client->adapter;
	int addr = temp_client->addr;
	int err;

	/* Make sure the address is valid */
2234
	err = i2c_check_7bit_addr_validity_strict(addr);
2235
	if (err) {
2236 2237
		dev_warn(&adapter->dev, "Invalid probe address 0x%02x\n",
			 addr);
2238
		return err;
2239 2240
	}

2241
	/* Skip if already in use (7 bit, no need to encode flags) */
2242
	if (i2c_check_addr_busy(adapter, addr))
2243 2244
		return 0;

J
Jean Delvare 已提交
2245
	/* Make sure there is something at this address */
2246 2247
	if (!i2c_default_probe(adapter, addr))
		return 0;
2248 2249 2250 2251

	/* Finally call the custom detection function */
	memset(&info, 0, sizeof(struct i2c_board_info));
	info.addr = addr;
2252
	err = driver->detect(temp_client, &info);
2253 2254 2255 2256 2257 2258 2259 2260
	if (err) {
		/* -ENODEV is returned if the detection fails. We catch it
		   here as this isn't an error. */
		return err == -ENODEV ? 0 : err;
	}

	/* Consistency check */
	if (info.type[0] == '\0') {
2261 2262 2263
		dev_err(&adapter->dev,
			"%s detection function provided no name for 0x%x\n",
			driver->driver.name, addr);
2264 2265 2266 2267
	} else {
		struct i2c_client *client;

		/* Detection succeeded, instantiate the device */
2268 2269 2270 2271
		if (adapter->class & I2C_CLASS_DEPRECATED)
			dev_warn(&adapter->dev,
				"This adapter will soon drop class based instantiation of devices. "
				"Please make sure client 0x%02x gets instantiated by other means. "
2272
				"Check 'Documentation/i2c/instantiating-devices.rst' for details.\n",
2273 2274
				info.addr);

2275 2276
		dev_dbg(&adapter->dev, "Creating %s at 0x%02x\n",
			info.type, info.addr);
2277 2278
		client = i2c_new_client_device(adapter, &info);
		if (!IS_ERR(client))
2279 2280 2281 2282 2283 2284 2285 2286 2287 2288
			list_add_tail(&client->detected, &driver->clients);
		else
			dev_err(&adapter->dev, "Failed creating %s at 0x%02x\n",
				info.type, info.addr);
	}
	return 0;
}

static int i2c_detect(struct i2c_adapter *adapter, struct i2c_driver *driver)
{
2289
	const unsigned short *address_list;
2290 2291 2292
	struct i2c_client *temp_client;
	int i, err = 0;

2293 2294
	address_list = driver->address_list;
	if (!driver->detect || !address_list)
2295 2296
		return 0;

2297 2298 2299
	/* Warn that the adapter lost class based instantiation */
	if (adapter->class == I2C_CLASS_DEPRECATED) {
		dev_dbg(&adapter->dev,
2300
			"This adapter dropped support for I2C classes and won't auto-detect %s devices anymore. "
2301
			"If you need it, check 'Documentation/i2c/instantiating-devices.rst' for alternatives.\n",
2302 2303 2304 2305
			driver->driver.name);
		return 0;
	}

J
Jean Delvare 已提交
2306 2307 2308 2309
	/* Stop here if the classes do not match */
	if (!(adapter->class & driver->class))
		return 0;

2310 2311 2312 2313 2314 2315
	/* Set up a temporary client to help detect callback */
	temp_client = kzalloc(sizeof(struct i2c_client), GFP_KERNEL);
	if (!temp_client)
		return -ENOMEM;
	temp_client->adapter = adapter;

2316
	for (i = 0; address_list[i] != I2C_CLIENT_END; i += 1) {
2317 2318
		dev_dbg(&adapter->dev,
			"found normal entry for adapter %d, addr 0x%02x\n",
2319
			i2c_adapter_id(adapter), address_list[i]);
2320
		temp_client->addr = address_list[i];
J
Jean Delvare 已提交
2321
		err = i2c_detect_address(temp_client, driver);
J
Jean Delvare 已提交
2322 2323
		if (unlikely(err))
			break;
2324 2325 2326 2327 2328 2329
	}

	kfree(temp_client);
	return err;
}

2330 2331 2332 2333 2334 2335 2336
int i2c_probe_func_quick_read(struct i2c_adapter *adap, unsigned short addr)
{
	return i2c_smbus_xfer(adap, addr, 0, I2C_SMBUS_READ, 0,
			      I2C_SMBUS_QUICK, NULL) >= 0;
}
EXPORT_SYMBOL_GPL(i2c_probe_func_quick_read);

J
Jean Delvare 已提交
2337
struct i2c_client *
2338 2339 2340 2341
i2c_new_scanned_device(struct i2c_adapter *adap,
		       struct i2c_board_info *info,
		       unsigned short const *addr_list,
		       int (*probe)(struct i2c_adapter *adap, unsigned short addr))
J
Jean Delvare 已提交
2342 2343 2344
{
	int i;

2345
	if (!probe)
2346
		probe = i2c_default_probe;
J
Jean Delvare 已提交
2347 2348 2349

	for (i = 0; addr_list[i] != I2C_CLIENT_END; i++) {
		/* Check address validity */
2350
		if (i2c_check_7bit_addr_validity_strict(addr_list[i]) < 0) {
2351 2352
			dev_warn(&adap->dev, "Invalid 7-bit address 0x%02x\n",
				 addr_list[i]);
J
Jean Delvare 已提交
2353 2354 2355
			continue;
		}

2356
		/* Check address availability (7 bit, no need to encode flags) */
2357
		if (i2c_check_addr_busy(adap, addr_list[i])) {
2358 2359 2360
			dev_dbg(&adap->dev,
				"Address 0x%02x already in use, not probing\n",
				addr_list[i]);
J
Jean Delvare 已提交
2361 2362 2363
			continue;
		}

2364
		/* Test address responsiveness */
2365
		if (probe(adap, addr_list[i]))
2366
			break;
J
Jean Delvare 已提交
2367 2368 2369 2370
	}

	if (addr_list[i] == I2C_CLIENT_END) {
		dev_dbg(&adap->dev, "Probing failed, no device found\n");
2371
		return ERR_PTR(-ENODEV);
J
Jean Delvare 已提交
2372 2373 2374
	}

	info->addr = addr_list[i];
2375 2376 2377 2378
	return i2c_new_client_device(adap, info);
}
EXPORT_SYMBOL_GPL(i2c_new_scanned_device);

2379
struct i2c_adapter *i2c_get_adapter(int nr)
L
Linus Torvalds 已提交
2380 2381
{
	struct i2c_adapter *adapter;
D
David Brownell 已提交
2382

J
Jean Delvare 已提交
2383
	mutex_lock(&core_lock);
2384
	adapter = idr_find(&i2c_adapter_idr, nr);
2385 2386 2387 2388 2389 2390
	if (!adapter)
		goto exit;

	if (try_module_get(adapter->owner))
		get_device(&adapter->dev);
	else
2391 2392
		adapter = NULL;

2393
 exit:
J
Jean Delvare 已提交
2394
	mutex_unlock(&core_lock);
2395
	return adapter;
L
Linus Torvalds 已提交
2396
}
D
David Brownell 已提交
2397
EXPORT_SYMBOL(i2c_get_adapter);
L
Linus Torvalds 已提交
2398 2399 2400

void i2c_put_adapter(struct i2c_adapter *adap)
{
2401 2402 2403 2404 2405
	if (!adap)
		return;

	put_device(&adap->dev);
	module_put(adap->owner);
L
Linus Torvalds 已提交
2406
}
D
David Brownell 已提交
2407
EXPORT_SYMBOL(i2c_put_adapter);
L
Linus Torvalds 已提交
2408

2409 2410 2411
/**
 * i2c_get_dma_safe_msg_buf() - get a DMA safe buffer for the given i2c_msg
 * @msg: the message to be checked
2412 2413
 * @threshold: the minimum number of bytes for which using DMA makes sense.
 *	       Should at least be 1.
2414 2415 2416
 *
 * Return: NULL if a DMA safe buffer was not obtained. Use msg->buf with PIO.
 *	   Or a valid pointer to be used with DMA. After use, release it by
2417
 *	   calling i2c_put_dma_safe_msg_buf().
2418 2419 2420 2421 2422
 *
 * This function must only be called from process context!
 */
u8 *i2c_get_dma_safe_msg_buf(struct i2c_msg *msg, unsigned int threshold)
{
2423 2424 2425 2426 2427
	/* also skip 0-length msgs for bogus thresholds of 0 */
	if (!threshold)
		pr_debug("DMA buffer for addr=0x%02x with length 0 is bogus\n",
			 msg->addr);
	if (msg->len < threshold || msg->len == 0)
2428 2429 2430 2431 2432 2433 2434 2435 2436 2437 2438 2439 2440 2441 2442 2443
		return NULL;

	if (msg->flags & I2C_M_DMA_SAFE)
		return msg->buf;

	pr_debug("using bounce buffer for addr=0x%02x, len=%d\n",
		 msg->addr, msg->len);

	if (msg->flags & I2C_M_RD)
		return kzalloc(msg->len, GFP_KERNEL);
	else
		return kmemdup(msg->buf, msg->len, GFP_KERNEL);
}
EXPORT_SYMBOL_GPL(i2c_get_dma_safe_msg_buf);

/**
2444
 * i2c_put_dma_safe_msg_buf - release DMA safe buffer and sync with i2c_msg
2445
 * @buf: the buffer obtained from i2c_get_dma_safe_msg_buf(). May be NULL.
2446 2447
 * @msg: the message which the buffer corresponds to
 * @xferred: bool saying if the message was transferred
2448
 */
2449
void i2c_put_dma_safe_msg_buf(u8 *buf, struct i2c_msg *msg, bool xferred)
2450 2451 2452 2453
{
	if (!buf || buf == msg->buf)
		return;

2454
	if (xferred && msg->flags & I2C_M_RD)
2455 2456 2457 2458
		memcpy(msg->buf, buf, msg->len);

	kfree(buf);
}
2459
EXPORT_SYMBOL_GPL(i2c_put_dma_safe_msg_buf);
2460

L
Linus Torvalds 已提交
2461 2462 2463
MODULE_AUTHOR("Simon G. Vogl <simon@tk.uni-linz.ac.at>");
MODULE_DESCRIPTION("I2C-Bus main module");
MODULE_LICENSE("GPL");