Convert files to UTF-8 and some cleanups
[deliverable/linux.git] / drivers / i2c / i2c-core.c
CommitLineData
1da177e4
LT
1/* i2c-core.c - a device driver for the iic-bus interface */
2/* ------------------------------------------------------------------------- */
3/* Copyright (C) 1995-99 Simon G. Vogl
4
5 This program is free software; you can redistribute it and/or modify
6 it under the terms of the GNU General Public License as published by
7 the Free Software Foundation; either version 2 of the License, or
8 (at your option) any later version.
9
10 This program is distributed in the hope that it will be useful,
11 but WITHOUT ANY WARRANTY; without even the implied warranty of
12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 GNU General Public License for more details.
14
15 You should have received a copy of the GNU General Public License
16 along with this program; if not, write to the Free Software
17 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */
18/* ------------------------------------------------------------------------- */
19
96de0e25 20/* With some changes from Kyösti Mälkki <kmalkki@cc.hut.fi>.
1da177e4 21 All SMBus-related things are written by Frodo Looijaard <frodol@dds.nl>
421ef47b
JD
22 SMBus 2.0 support by Mark Studebaker <mdsxyz123@yahoo.com> and
23 Jean Delvare <khali@linux-fr.org> */
1da177e4 24
1da177e4
LT
25#include <linux/module.h>
26#include <linux/kernel.h>
27#include <linux/errno.h>
28#include <linux/slab.h>
29#include <linux/i2c.h>
30#include <linux/init.h>
31#include <linux/idr.h>
32#include <linux/seq_file.h>
d052d1be 33#include <linux/platform_device.h>
b3585e4f 34#include <linux/mutex.h>
b8d6f45b 35#include <linux/completion.h>
1da177e4
LT
36#include <asm/uaccess.h>
37
9c1600ed
DB
38#include "i2c-core.h"
39
1da177e4
LT
40
41static LIST_HEAD(adapters);
42static LIST_HEAD(drivers);
b3585e4f 43static DEFINE_MUTEX(core_lists);
1da177e4
LT
44static DEFINE_IDR(i2c_adapter_idr);
45
a1d9e6e4 46#define is_newstyle_driver(d) ((d)->probe || (d)->remove)
f37dd80a
DB
47
48/* ------------------------------------------------------------------------- */
49
1da177e4
LT
50static int i2c_device_match(struct device *dev, struct device_driver *drv)
51{
7b4fbc50
DB
52 struct i2c_client *client = to_i2c_client(dev);
53 struct i2c_driver *driver = to_i2c_driver(drv);
54
55 /* make legacy i2c drivers bypass driver model probing entirely;
56 * such drivers scan each i2c adapter/bus themselves.
57 */
a1d9e6e4 58 if (!is_newstyle_driver(driver))
7b4fbc50
DB
59 return 0;
60
61 /* new style drivers use the same kind of driver matching policy
62 * as platform devices or SPI: compare device and driver IDs.
63 */
64 return strcmp(client->driver_name, drv->name) == 0;
1da177e4
LT
65}
66
7b4fbc50
DB
67#ifdef CONFIG_HOTPLUG
68
69/* uevent helps with hotplug: modprobe -q $(MODALIAS) */
7eff2e7a 70static int i2c_device_uevent(struct device *dev, struct kobj_uevent_env *env)
7b4fbc50
DB
71{
72 struct i2c_client *client = to_i2c_client(dev);
7b4fbc50
DB
73
74 /* by definition, legacy drivers can't hotplug */
75 if (dev->driver || !client->driver_name)
76 return 0;
77
7eff2e7a 78 if (add_uevent_var(env, "MODALIAS=%s", client->driver_name))
7b4fbc50 79 return -ENOMEM;
7b4fbc50
DB
80 dev_dbg(dev, "uevent\n");
81 return 0;
82}
83
84#else
85#define i2c_device_uevent NULL
86#endif /* CONFIG_HOTPLUG */
87
f37dd80a 88static int i2c_device_probe(struct device *dev)
1da177e4 89{
7b4fbc50
DB
90 struct i2c_client *client = to_i2c_client(dev);
91 struct i2c_driver *driver = to_i2c_driver(dev->driver);
92
93 if (!driver->probe)
94 return -ENODEV;
95 client->driver = driver;
96 dev_dbg(dev, "probe\n");
97 return driver->probe(client);
f37dd80a 98}
1da177e4 99
f37dd80a
DB
100static int i2c_device_remove(struct device *dev)
101{
a1d9e6e4
DB
102 struct i2c_client *client = to_i2c_client(dev);
103 struct i2c_driver *driver;
104 int status;
105
106 if (!dev->driver)
107 return 0;
108
109 driver = to_i2c_driver(dev->driver);
110 if (driver->remove) {
111 dev_dbg(dev, "remove\n");
112 status = driver->remove(client);
113 } else {
114 dev->driver = NULL;
115 status = 0;
116 }
117 if (status == 0)
118 client->driver = NULL;
119 return status;
1da177e4
LT
120}
121
f37dd80a 122static void i2c_device_shutdown(struct device *dev)
1da177e4 123{
f37dd80a
DB
124 struct i2c_driver *driver;
125
126 if (!dev->driver)
127 return;
128 driver = to_i2c_driver(dev->driver);
129 if (driver->shutdown)
130 driver->shutdown(to_i2c_client(dev));
1da177e4
LT
131}
132
f37dd80a 133static int i2c_device_suspend(struct device * dev, pm_message_t mesg)
1da177e4 134{
f37dd80a
DB
135 struct i2c_driver *driver;
136
137 if (!dev->driver)
138 return 0;
139 driver = to_i2c_driver(dev->driver);
140 if (!driver->suspend)
141 return 0;
142 return driver->suspend(to_i2c_client(dev), mesg);
1da177e4
LT
143}
144
f37dd80a 145static int i2c_device_resume(struct device * dev)
1da177e4 146{
f37dd80a
DB
147 struct i2c_driver *driver;
148
149 if (!dev->driver)
150 return 0;
151 driver = to_i2c_driver(dev->driver);
152 if (!driver->resume)
153 return 0;
154 return driver->resume(to_i2c_client(dev));
1da177e4
LT
155}
156
7b4fbc50
DB
157static void i2c_client_release(struct device *dev)
158{
159 struct i2c_client *client = to_i2c_client(dev);
160 complete(&client->released);
161}
162
9c1600ed
DB
163static void i2c_client_dev_release(struct device *dev)
164{
165 kfree(to_i2c_client(dev));
166}
167
7b4fbc50
DB
168static ssize_t show_client_name(struct device *dev, struct device_attribute *attr, char *buf)
169{
170 struct i2c_client *client = to_i2c_client(dev);
171 return sprintf(buf, "%s\n", client->name);
172}
173
174static ssize_t show_modalias(struct device *dev, struct device_attribute *attr, char *buf)
175{
176 struct i2c_client *client = to_i2c_client(dev);
177 return client->driver_name
178 ? sprintf(buf, "%s\n", client->driver_name)
179 : 0;
180}
181
182static struct device_attribute i2c_dev_attrs[] = {
183 __ATTR(name, S_IRUGO, show_client_name, NULL),
184 /* modalias helps coldplug: modprobe $(cat .../modalias) */
185 __ATTR(modalias, S_IRUGO, show_modalias, NULL),
186 { },
187};
188
83eaaed0 189static struct bus_type i2c_bus_type = {
f37dd80a 190 .name = "i2c",
7b4fbc50 191 .dev_attrs = i2c_dev_attrs,
f37dd80a 192 .match = i2c_device_match,
7b4fbc50 193 .uevent = i2c_device_uevent,
f37dd80a
DB
194 .probe = i2c_device_probe,
195 .remove = i2c_device_remove,
196 .shutdown = i2c_device_shutdown,
197 .suspend = i2c_device_suspend,
198 .resume = i2c_device_resume,
b864c7d5
RK
199};
200
9c1600ed
DB
201/**
202 * i2c_new_device - instantiate an i2c device for use with a new style driver
203 * @adap: the adapter managing the device
204 * @info: describes one I2C device; bus_num is ignored
d64f73be 205 * Context: can sleep
9c1600ed
DB
206 *
207 * Create a device to work with a new style i2c driver, where binding is
208 * handled through driver model probe()/remove() methods. This call is not
209 * appropriate for use by mainboad initialization logic, which usually runs
210 * during an arch_initcall() long before any i2c_adapter could exist.
211 *
212 * This returns the new i2c client, which may be saved for later use with
213 * i2c_unregister_device(); or NULL to indicate an error.
214 */
215struct i2c_client *
216i2c_new_device(struct i2c_adapter *adap, struct i2c_board_info const *info)
217{
218 struct i2c_client *client;
219 int status;
220
221 client = kzalloc(sizeof *client, GFP_KERNEL);
222 if (!client)
223 return NULL;
224
225 client->adapter = adap;
226
227 client->dev.platform_data = info->platform_data;
3bbb835d
DB
228 device_init_wakeup(&client->dev, info->flags & I2C_CLIENT_WAKE);
229
230 client->flags = info->flags & ~I2C_CLIENT_WAKE;
9c1600ed
DB
231 client->addr = info->addr;
232 client->irq = info->irq;
233
234 strlcpy(client->driver_name, info->driver_name,
235 sizeof(client->driver_name));
236 strlcpy(client->name, info->type, sizeof(client->name));
237
238 /* a new style driver may be bound to this device when we
239 * return from this function, or any later moment (e.g. maybe
240 * hotplugging will load the driver module). and the device
241 * refcount model is the standard driver model one.
242 */
243 status = i2c_attach_client(client);
244 if (status < 0) {
245 kfree(client);
246 client = NULL;
247 }
248 return client;
249}
250EXPORT_SYMBOL_GPL(i2c_new_device);
251
252
253/**
254 * i2c_unregister_device - reverse effect of i2c_new_device()
255 * @client: value returned from i2c_new_device()
d64f73be 256 * Context: can sleep
9c1600ed
DB
257 */
258void i2c_unregister_device(struct i2c_client *client)
a1d9e6e4
DB
259{
260 struct i2c_adapter *adapter = client->adapter;
261 struct i2c_driver *driver = client->driver;
262
263 if (driver && !is_newstyle_driver(driver)) {
264 dev_err(&client->dev, "can't unregister devices "
265 "with legacy drivers\n");
266 WARN_ON(1);
267 return;
268 }
269
270 mutex_lock(&adapter->clist_lock);
271 list_del(&client->list);
272 mutex_unlock(&adapter->clist_lock);
273
274 device_unregister(&client->dev);
275}
9c1600ed 276EXPORT_SYMBOL_GPL(i2c_unregister_device);
a1d9e6e4
DB
277
278
f37dd80a
DB
279/* ------------------------------------------------------------------------- */
280
16ffadfc
DB
281/* I2C bus adapters -- one roots each I2C or SMBUS segment */
282
83eaaed0 283static void i2c_adapter_dev_release(struct device *dev)
1da177e4 284{
ef2c8321 285 struct i2c_adapter *adap = to_i2c_adapter(dev);
1da177e4
LT
286 complete(&adap->dev_released);
287}
288
16ffadfc
DB
289static ssize_t
290show_adapter_name(struct device *dev, struct device_attribute *attr, char *buf)
291{
ef2c8321 292 struct i2c_adapter *adap = to_i2c_adapter(dev);
16ffadfc
DB
293 return sprintf(buf, "%s\n", adap->name);
294}
b119dc3f 295
16ffadfc
DB
296static struct device_attribute i2c_adapter_attrs[] = {
297 __ATTR(name, S_IRUGO, show_adapter_name, NULL),
298 { },
299};
b119dc3f 300
83eaaed0 301static struct class i2c_adapter_class = {
b119dc3f
DB
302 .owner = THIS_MODULE,
303 .name = "i2c-adapter",
16ffadfc 304 .dev_attrs = i2c_adapter_attrs,
1da177e4
LT
305};
306
9c1600ed
DB
307static void i2c_scan_static_board_info(struct i2c_adapter *adapter)
308{
309 struct i2c_devinfo *devinfo;
310
311 mutex_lock(&__i2c_board_lock);
312 list_for_each_entry(devinfo, &__i2c_board_list, list) {
313 if (devinfo->busnum == adapter->nr
314 && !i2c_new_device(adapter,
315 &devinfo->board_info))
316 printk(KERN_ERR "i2c-core: can't create i2c%d-%04x\n",
317 i2c_adapter_id(adapter),
318 devinfo->board_info.addr);
319 }
320 mutex_unlock(&__i2c_board_lock);
321}
322
6e13e641 323static int i2c_register_adapter(struct i2c_adapter *adap)
1da177e4 324{
6e13e641 325 int res = 0;
1da177e4
LT
326 struct list_head *item;
327 struct i2c_driver *driver;
328
5c085d36
IM
329 mutex_init(&adap->bus_lock);
330 mutex_init(&adap->clist_lock);
1da177e4
LT
331 INIT_LIST_HEAD(&adap->clients);
332
6e13e641
DB
333 mutex_lock(&core_lists);
334 list_add_tail(&adap->list, &adapters);
335
1da177e4
LT
336 /* Add the adapter to the driver core.
337 * If the parent pointer is not set up,
338 * we add this adapter to the host bus.
339 */
b119dc3f 340 if (adap->dev.parent == NULL) {
1da177e4 341 adap->dev.parent = &platform_bus;
fe2c8d51
JD
342 pr_debug("I2C adapter driver [%s] forgot to specify "
343 "physical device\n", adap->name);
b119dc3f 344 }
1da177e4 345 sprintf(adap->dev.bus_id, "i2c-%d", adap->nr);
1da177e4 346 adap->dev.release = &i2c_adapter_dev_release;
fccb56e4 347 adap->dev.class = &i2c_adapter_class;
b119c6c9
JD
348 res = device_register(&adap->dev);
349 if (res)
350 goto out_list;
1da177e4 351
b6d7b3d1
JD
352 dev_dbg(&adap->dev, "adapter [%s] registered\n", adap->name);
353
6e13e641
DB
354 /* create pre-declared device nodes for new-style drivers */
355 if (adap->nr < __i2c_first_dynamic_bus_num)
356 i2c_scan_static_board_info(adap);
357
7b4fbc50 358 /* let legacy drivers scan this bus for matching devices */
1da177e4
LT
359 list_for_each(item,&drivers) {
360 driver = list_entry(item, struct i2c_driver, list);
8a994755 361 if (driver->attach_adapter)
1da177e4
LT
362 /* We ignore the return code; if it fails, too bad */
363 driver->attach_adapter(adap);
364 }
365
1da177e4 366out_unlock:
b3585e4f 367 mutex_unlock(&core_lists);
1da177e4 368 return res;
b119c6c9 369
b119c6c9
JD
370out_list:
371 list_del(&adap->list);
372 idr_remove(&i2c_adapter_idr, adap->nr);
373 goto out_unlock;
1da177e4
LT
374}
375
6e13e641
DB
376/**
377 * i2c_add_adapter - declare i2c adapter, use dynamic bus number
378 * @adapter: the adapter to add
d64f73be 379 * Context: can sleep
6e13e641
DB
380 *
381 * This routine is used to declare an I2C adapter when its bus number
382 * doesn't matter. Examples: for I2C adapters dynamically added by
383 * USB links or PCI plugin cards.
384 *
385 * When this returns zero, a new bus number was allocated and stored
386 * in adap->nr, and the specified adapter became available for clients.
387 * Otherwise, a negative errno value is returned.
388 */
389int i2c_add_adapter(struct i2c_adapter *adapter)
390{
391 int id, res = 0;
392
393retry:
394 if (idr_pre_get(&i2c_adapter_idr, GFP_KERNEL) == 0)
395 return -ENOMEM;
396
397 mutex_lock(&core_lists);
398 /* "above" here means "above or equal to", sigh */
399 res = idr_get_new_above(&i2c_adapter_idr, adapter,
400 __i2c_first_dynamic_bus_num, &id);
401 mutex_unlock(&core_lists);
402
403 if (res < 0) {
404 if (res == -EAGAIN)
405 goto retry;
406 return res;
407 }
408
409 adapter->nr = id;
410 return i2c_register_adapter(adapter);
411}
412EXPORT_SYMBOL(i2c_add_adapter);
413
414/**
415 * i2c_add_numbered_adapter - declare i2c adapter, use static bus number
416 * @adap: the adapter to register (with adap->nr initialized)
d64f73be 417 * Context: can sleep
6e13e641
DB
418 *
419 * This routine is used to declare an I2C adapter when its bus number
420 * matters. Example: for I2C adapters from system-on-chip CPUs, or
421 * otherwise built in to the system's mainboard, and where i2c_board_info
422 * is used to properly configure I2C devices.
423 *
424 * If no devices have pre-been declared for this bus, then be sure to
425 * register the adapter before any dynamically allocated ones. Otherwise
426 * the required bus ID may not be available.
427 *
428 * When this returns zero, the specified adapter became available for
429 * clients using the bus number provided in adap->nr. Also, the table
430 * of I2C devices pre-declared using i2c_register_board_info() is scanned,
431 * and the appropriate driver model device nodes are created. Otherwise, a
432 * negative errno value is returned.
433 */
434int i2c_add_numbered_adapter(struct i2c_adapter *adap)
435{
436 int id;
437 int status;
438
439 if (adap->nr & ~MAX_ID_MASK)
440 return -EINVAL;
441
442retry:
443 if (idr_pre_get(&i2c_adapter_idr, GFP_KERNEL) == 0)
444 return -ENOMEM;
445
446 mutex_lock(&core_lists);
447 /* "above" here means "above or equal to", sigh;
448 * we need the "equal to" result to force the result
449 */
450 status = idr_get_new_above(&i2c_adapter_idr, adap, adap->nr, &id);
451 if (status == 0 && id != adap->nr) {
452 status = -EBUSY;
453 idr_remove(&i2c_adapter_idr, id);
454 }
455 mutex_unlock(&core_lists);
456 if (status == -EAGAIN)
457 goto retry;
458
459 if (status == 0)
460 status = i2c_register_adapter(adap);
461 return status;
462}
463EXPORT_SYMBOL_GPL(i2c_add_numbered_adapter);
464
d64f73be
DB
465/**
466 * i2c_del_adapter - unregister I2C adapter
467 * @adap: the adapter being unregistered
468 * Context: can sleep
469 *
470 * This unregisters an I2C adapter which was previously registered
471 * by @i2c_add_adapter or @i2c_add_numbered_adapter.
472 */
1da177e4
LT
473int i2c_del_adapter(struct i2c_adapter *adap)
474{
475 struct list_head *item, *_n;
476 struct i2c_adapter *adap_from_list;
477 struct i2c_driver *driver;
478 struct i2c_client *client;
479 int res = 0;
480
b3585e4f 481 mutex_lock(&core_lists);
1da177e4
LT
482
483 /* First make sure that this adapter was ever added */
484 list_for_each_entry(adap_from_list, &adapters, list) {
485 if (adap_from_list == adap)
486 break;
487 }
488 if (adap_from_list != adap) {
b6d7b3d1
JD
489 pr_debug("i2c-core: attempting to delete unregistered "
490 "adapter [%s]\n", adap->name);
1da177e4
LT
491 res = -EINVAL;
492 goto out_unlock;
493 }
494
495 list_for_each(item,&drivers) {
496 driver = list_entry(item, struct i2c_driver, list);
497 if (driver->detach_adapter)
498 if ((res = driver->detach_adapter(adap))) {
b6d7b3d1 499 dev_err(&adap->dev, "detach_adapter failed "
35d8b2e6
LR
500 "for driver [%s]\n",
501 driver->driver.name);
1da177e4
LT
502 goto out_unlock;
503 }
504 }
505
506 /* detach any active clients. This must be done first, because
a551acc2 507 * it can fail; in which case we give up. */
1da177e4 508 list_for_each_safe(item, _n, &adap->clients) {
a1d9e6e4
DB
509 struct i2c_driver *driver;
510
1da177e4 511 client = list_entry(item, struct i2c_client, list);
a1d9e6e4
DB
512 driver = client->driver;
513
514 /* new style, follow standard driver model */
515 if (!driver || is_newstyle_driver(driver)) {
516 i2c_unregister_device(client);
517 continue;
518 }
1da177e4 519
a1d9e6e4
DB
520 /* legacy drivers create and remove clients themselves */
521 if ((res = driver->detach_client(client))) {
b6d7b3d1
JD
522 dev_err(&adap->dev, "detach_client failed for client "
523 "[%s] at address 0x%02x\n", client->name,
1da177e4
LT
524 client->addr);
525 goto out_unlock;
526 }
527 }
528
529 /* clean up the sysfs representation */
530 init_completion(&adap->dev_released);
1da177e4
LT
531 device_unregister(&adap->dev);
532 list_del(&adap->list);
533
534 /* wait for sysfs to drop all references */
535 wait_for_completion(&adap->dev_released);
1da177e4 536
6e13e641 537 /* free bus id */
1da177e4
LT
538 idr_remove(&i2c_adapter_idr, adap->nr);
539
b6d7b3d1 540 dev_dbg(&adap->dev, "adapter [%s] unregistered\n", adap->name);
1da177e4
LT
541
542 out_unlock:
b3585e4f 543 mutex_unlock(&core_lists);
1da177e4
LT
544 return res;
545}
c0564606 546EXPORT_SYMBOL(i2c_del_adapter);
1da177e4
LT
547
548
7b4fbc50
DB
549/* ------------------------------------------------------------------------- */
550
551/*
552 * An i2c_driver is used with one or more i2c_client (device) nodes to access
553 * i2c slave chips, on a bus instance associated with some i2c_adapter. There
554 * are two models for binding the driver to its device: "new style" drivers
555 * follow the standard Linux driver model and just respond to probe() calls
556 * issued if the driver core sees they match(); "legacy" drivers create device
557 * nodes themselves.
1da177e4
LT
558 */
559
de59cf9e 560int i2c_register_driver(struct module *owner, struct i2c_driver *driver)
1da177e4 561{
7eebcb7c 562 int res;
1da177e4 563
7b4fbc50 564 /* new style driver methods can't mix with legacy ones */
a1d9e6e4 565 if (is_newstyle_driver(driver)) {
7b4fbc50
DB
566 if (driver->attach_adapter || driver->detach_adapter
567 || driver->detach_client) {
568 printk(KERN_WARNING
569 "i2c-core: driver [%s] is confused\n",
570 driver->driver.name);
571 return -EINVAL;
572 }
573 }
574
1da177e4 575 /* add the driver to the list of i2c drivers in the driver core */
de59cf9e 576 driver->driver.owner = owner;
1da177e4 577 driver->driver.bus = &i2c_bus_type;
1da177e4 578
6e13e641
DB
579 /* for new style drivers, when registration returns the driver core
580 * will have called probe() for all matching-but-unbound devices.
581 */
1da177e4
LT
582 res = driver_register(&driver->driver);
583 if (res)
7eebcb7c 584 return res;
438d6c2c 585
7eebcb7c
JD
586 mutex_lock(&core_lists);
587
1da177e4 588 list_add_tail(&driver->list,&drivers);
35d8b2e6 589 pr_debug("i2c-core: driver [%s] registered\n", driver->driver.name);
1da177e4 590
7b4fbc50 591 /* legacy drivers scan i2c busses directly */
8a994755 592 if (driver->attach_adapter) {
4ad4eac6
DB
593 struct i2c_adapter *adapter;
594
595 list_for_each_entry(adapter, &adapters, list) {
1da177e4
LT
596 driver->attach_adapter(adapter);
597 }
598 }
599
b3585e4f 600 mutex_unlock(&core_lists);
7eebcb7c 601 return 0;
1da177e4 602}
de59cf9e 603EXPORT_SYMBOL(i2c_register_driver);
1da177e4 604
a1d9e6e4
DB
605/**
606 * i2c_del_driver - unregister I2C driver
607 * @driver: the driver being unregistered
d64f73be 608 * Context: can sleep
a1d9e6e4 609 */
b3e82096 610void i2c_del_driver(struct i2c_driver *driver)
1da177e4
LT
611{
612 struct list_head *item1, *item2, *_n;
613 struct i2c_client *client;
614 struct i2c_adapter *adap;
438d6c2c 615
b3585e4f 616 mutex_lock(&core_lists);
1da177e4 617
a1d9e6e4
DB
618 /* new-style driver? */
619 if (is_newstyle_driver(driver))
620 goto unregister;
621
1da177e4 622 /* Have a look at each adapter, if clients of this driver are still
438d6c2c 623 * attached. If so, detach them to be able to kill the driver
1da177e4 624 * afterwards.
1da177e4
LT
625 */
626 list_for_each(item1,&adapters) {
627 adap = list_entry(item1, struct i2c_adapter, list);
1da177e4 628 if (driver->detach_adapter) {
b3e82096 629 if (driver->detach_adapter(adap)) {
b6d7b3d1 630 dev_err(&adap->dev, "detach_adapter failed "
35d8b2e6
LR
631 "for driver [%s]\n",
632 driver->driver.name);
1da177e4
LT
633 }
634 } else {
635 list_for_each_safe(item2, _n, &adap->clients) {
636 client = list_entry(item2, struct i2c_client, list);
637 if (client->driver != driver)
638 continue;
b6d7b3d1
JD
639 dev_dbg(&adap->dev, "detaching client [%s] "
640 "at 0x%02x\n", client->name,
641 client->addr);
b3e82096 642 if (driver->detach_client(client)) {
b6d7b3d1
JD
643 dev_err(&adap->dev, "detach_client "
644 "failed for client [%s] at "
645 "0x%02x\n", client->name,
1da177e4 646 client->addr);
1da177e4
LT
647 }
648 }
649 }
650 }
651
a1d9e6e4 652 unregister:
1da177e4
LT
653 driver_unregister(&driver->driver);
654 list_del(&driver->list);
35d8b2e6 655 pr_debug("i2c-core: driver [%s] unregistered\n", driver->driver.name);
1da177e4 656
b3585e4f 657 mutex_unlock(&core_lists);
1da177e4 658}
c0564606 659EXPORT_SYMBOL(i2c_del_driver);
1da177e4 660
7b4fbc50
DB
661/* ------------------------------------------------------------------------- */
662
1da177e4
LT
663static int __i2c_check_addr(struct i2c_adapter *adapter, unsigned int addr)
664{
665 struct list_head *item;
666 struct i2c_client *client;
667
668 list_for_each(item,&adapter->clients) {
669 client = list_entry(item, struct i2c_client, list);
670 if (client->addr == addr)
671 return -EBUSY;
672 }
673 return 0;
674}
675
676int i2c_check_addr(struct i2c_adapter *adapter, int addr)
677{
678 int rval;
679
5c085d36 680 mutex_lock(&adapter->clist_lock);
1da177e4 681 rval = __i2c_check_addr(adapter, addr);
5c085d36 682 mutex_unlock(&adapter->clist_lock);
1da177e4
LT
683
684 return rval;
685}
c0564606 686EXPORT_SYMBOL(i2c_check_addr);
1da177e4
LT
687
688int i2c_attach_client(struct i2c_client *client)
689{
690 struct i2c_adapter *adapter = client->adapter;
b119c6c9 691 int res = 0;
1da177e4 692
5c085d36 693 mutex_lock(&adapter->clist_lock);
1da177e4 694 if (__i2c_check_addr(client->adapter, client->addr)) {
b119c6c9
JD
695 res = -EBUSY;
696 goto out_unlock;
1da177e4
LT
697 }
698 list_add_tail(&client->list,&adapter->clients);
438d6c2c 699
cde7859b 700 client->usage_count = 0;
1da177e4
LT
701
702 client->dev.parent = &client->adapter->dev;
1da177e4 703 client->dev.bus = &i2c_bus_type;
9c1600ed
DB
704
705 if (client->driver)
706 client->dev.driver = &client->driver->driver;
707
de81d2aa 708 if (client->driver && !is_newstyle_driver(client->driver)) {
9c1600ed 709 client->dev.release = i2c_client_release;
de81d2aa
DB
710 client->dev.uevent_suppress = 1;
711 } else
9c1600ed 712 client->dev.release = i2c_client_dev_release;
438d6c2c 713
1da177e4
LT
714 snprintf(&client->dev.bus_id[0], sizeof(client->dev.bus_id),
715 "%d-%04x", i2c_adapter_id(adapter), client->addr);
b6d7b3d1
JD
716 dev_dbg(&adapter->dev, "client [%s] registered with bus id %s\n",
717 client->name, client->dev.bus_id);
b119c6c9
JD
718 res = device_register(&client->dev);
719 if (res)
720 goto out_list;
b119c6c9 721 mutex_unlock(&adapter->clist_lock);
77ed74da
JD
722
723 if (adapter->client_register) {
724 if (adapter->client_register(client)) {
725 dev_dbg(&adapter->dev, "client_register "
726 "failed for client [%s] at 0x%02x\n",
727 client->name, client->addr);
728 }
729 }
730
731 return 0;
b119c6c9 732
b119c6c9
JD
733out_list:
734 list_del(&client->list);
735 dev_err(&adapter->dev, "Failed to attach i2c client %s at 0x%02x "
736 "(%d)\n", client->name, client->addr, res);
77ed74da
JD
737out_unlock:
738 mutex_unlock(&adapter->clist_lock);
739 return res;
1da177e4 740}
c0564606 741EXPORT_SYMBOL(i2c_attach_client);
1da177e4
LT
742
743int i2c_detach_client(struct i2c_client *client)
744{
745 struct i2c_adapter *adapter = client->adapter;
746 int res = 0;
438d6c2c 747
cde7859b 748 if (client->usage_count > 0) {
7bef5594
JD
749 dev_warn(&client->dev, "Client [%s] still busy, "
750 "can't detach\n", client->name);
1da177e4 751 return -EBUSY;
7bef5594 752 }
1da177e4
LT
753
754 if (adapter->client_unregister) {
755 res = adapter->client_unregister(client);
756 if (res) {
757 dev_err(&client->dev,
86749e85
JD
758 "client_unregister [%s] failed, "
759 "client not detached\n", client->name);
1da177e4
LT
760 goto out;
761 }
762 }
763
5c085d36 764 mutex_lock(&adapter->clist_lock);
1da177e4
LT
765 list_del(&client->list);
766 init_completion(&client->released);
1da177e4 767 device_unregister(&client->dev);
5c085d36 768 mutex_unlock(&adapter->clist_lock);
1da177e4
LT
769 wait_for_completion(&client->released);
770
771 out:
772 return res;
773}
c0564606 774EXPORT_SYMBOL(i2c_detach_client);
1da177e4
LT
775
776static int i2c_inc_use_client(struct i2c_client *client)
777{
778
35d8b2e6 779 if (!try_module_get(client->driver->driver.owner))
1da177e4
LT
780 return -ENODEV;
781 if (!try_module_get(client->adapter->owner)) {
35d8b2e6 782 module_put(client->driver->driver.owner);
1da177e4
LT
783 return -ENODEV;
784 }
785
786 return 0;
787}
788
789static void i2c_dec_use_client(struct i2c_client *client)
790{
35d8b2e6 791 module_put(client->driver->driver.owner);
1da177e4
LT
792 module_put(client->adapter->owner);
793}
794
795int i2c_use_client(struct i2c_client *client)
796{
797 int ret;
798
799 ret = i2c_inc_use_client(client);
800 if (ret)
801 return ret;
802
cde7859b 803 client->usage_count++;
1da177e4
LT
804
805 return 0;
1da177e4 806}
c0564606 807EXPORT_SYMBOL(i2c_use_client);
1da177e4
LT
808
809int i2c_release_client(struct i2c_client *client)
810{
cde7859b
JD
811 if (!client->usage_count) {
812 pr_debug("i2c-core: %s used one too many times\n",
813 __FUNCTION__);
814 return -EPERM;
1da177e4 815 }
438d6c2c 816
cde7859b 817 client->usage_count--;
1da177e4 818 i2c_dec_use_client(client);
438d6c2c 819
1da177e4
LT
820 return 0;
821}
c0564606 822EXPORT_SYMBOL(i2c_release_client);
1da177e4
LT
823
824void i2c_clients_command(struct i2c_adapter *adap, unsigned int cmd, void *arg)
825{
826 struct list_head *item;
827 struct i2c_client *client;
828
5c085d36 829 mutex_lock(&adap->clist_lock);
1da177e4
LT
830 list_for_each(item,&adap->clients) {
831 client = list_entry(item, struct i2c_client, list);
35d8b2e6 832 if (!try_module_get(client->driver->driver.owner))
1da177e4
LT
833 continue;
834 if (NULL != client->driver->command) {
5c085d36 835 mutex_unlock(&adap->clist_lock);
1da177e4 836 client->driver->command(client,cmd,arg);
5c085d36 837 mutex_lock(&adap->clist_lock);
1da177e4 838 }
35d8b2e6 839 module_put(client->driver->driver.owner);
1da177e4 840 }
5c085d36 841 mutex_unlock(&adap->clist_lock);
1da177e4 842}
c0564606 843EXPORT_SYMBOL(i2c_clients_command);
1da177e4
LT
844
845static int __init i2c_init(void)
846{
847 int retval;
848
849 retval = bus_register(&i2c_bus_type);
1da177e4
LT
850 if (retval)
851 return retval;
852 return class_register(&i2c_adapter_class);
853}
854
855static void __exit i2c_exit(void)
856{
857 class_unregister(&i2c_adapter_class);
1da177e4
LT
858 bus_unregister(&i2c_bus_type);
859}
860
861subsys_initcall(i2c_init);
862module_exit(i2c_exit);
863
864/* ----------------------------------------------------
865 * the functional interface to the i2c busses.
866 * ----------------------------------------------------
867 */
868
869int i2c_transfer(struct i2c_adapter * adap, struct i2c_msg *msgs, int num)
870{
871 int ret;
872
873 if (adap->algo->master_xfer) {
874#ifdef DEBUG
875 for (ret = 0; ret < num; ret++) {
876 dev_dbg(&adap->dev, "master_xfer[%d] %c, addr=0x%02x, "
209d27c3
JD
877 "len=%d%s\n", ret, (msgs[ret].flags & I2C_M_RD)
878 ? 'R' : 'W', msgs[ret].addr, msgs[ret].len,
879 (msgs[ret].flags & I2C_M_RECV_LEN) ? "+" : "");
1da177e4
LT
880 }
881#endif
882
6ea23039 883 mutex_lock_nested(&adap->bus_lock, adap->level);
1da177e4 884 ret = adap->algo->master_xfer(adap,msgs,num);
5c085d36 885 mutex_unlock(&adap->bus_lock);
1da177e4
LT
886
887 return ret;
888 } else {
889 dev_dbg(&adap->dev, "I2C level transfers not supported\n");
890 return -ENOSYS;
891 }
892}
c0564606 893EXPORT_SYMBOL(i2c_transfer);
1da177e4
LT
894
895int i2c_master_send(struct i2c_client *client,const char *buf ,int count)
896{
897 int ret;
898 struct i2c_adapter *adap=client->adapter;
899 struct i2c_msg msg;
900
815f55f2
JD
901 msg.addr = client->addr;
902 msg.flags = client->flags & I2C_M_TEN;
903 msg.len = count;
904 msg.buf = (char *)buf;
438d6c2c 905
815f55f2 906 ret = i2c_transfer(adap, &msg, 1);
1da177e4 907
815f55f2
JD
908 /* If everything went ok (i.e. 1 msg transmitted), return #bytes
909 transmitted, else error code. */
910 return (ret == 1) ? count : ret;
1da177e4 911}
c0564606 912EXPORT_SYMBOL(i2c_master_send);
1da177e4
LT
913
914int i2c_master_recv(struct i2c_client *client, char *buf ,int count)
915{
916 struct i2c_adapter *adap=client->adapter;
917 struct i2c_msg msg;
918 int ret;
815f55f2
JD
919
920 msg.addr = client->addr;
921 msg.flags = client->flags & I2C_M_TEN;
922 msg.flags |= I2C_M_RD;
923 msg.len = count;
924 msg.buf = buf;
925
926 ret = i2c_transfer(adap, &msg, 1);
927
928 /* If everything went ok (i.e. 1 msg transmitted), return #bytes
929 transmitted, else error code. */
930 return (ret == 1) ? count : ret;
1da177e4 931}
c0564606 932EXPORT_SYMBOL(i2c_master_recv);
1da177e4 933
1da177e4
LT
934/* ----------------------------------------------------
935 * the i2c address scanning function
936 * Will not work for 10-bit addresses!
937 * ----------------------------------------------------
938 */
a89ba0bc
JD
939static int i2c_probe_address(struct i2c_adapter *adapter, int addr, int kind,
940 int (*found_proc) (struct i2c_adapter *, int, int))
941{
942 int err;
943
944 /* Make sure the address is valid */
945 if (addr < 0x03 || addr > 0x77) {
946 dev_warn(&adapter->dev, "Invalid probe address 0x%02x\n",
947 addr);
948 return -EINVAL;
9fc6adfa
JD
949 }
950
a89ba0bc
JD
951 /* Skip if already in use */
952 if (i2c_check_addr(adapter, addr))
953 return 0;
954
955 /* Make sure there is something at this address, unless forced */
4c9337da
JD
956 if (kind < 0) {
957 if (i2c_smbus_xfer(adapter, addr, 0, 0, 0,
958 I2C_SMBUS_QUICK, NULL) < 0)
959 return 0;
960
961 /* prevent 24RF08 corruption */
962 if ((addr & ~0x0f) == 0x50)
963 i2c_smbus_xfer(adapter, addr, 0, 0, 0,
964 I2C_SMBUS_QUICK, NULL);
965 }
a89ba0bc
JD
966
967 /* Finally call the custom detection function */
968 err = found_proc(adapter, addr, kind);
a89ba0bc
JD
969 /* -ENODEV can be returned if there is a chip at the given address
970 but it isn't supported by this chip driver. We catch it here as
971 this isn't an error. */
114fd183
JD
972 if (err == -ENODEV)
973 err = 0;
974
975 if (err)
976 dev_warn(&adapter->dev, "Client creation failed at 0x%x (%d)\n",
977 addr, err);
978 return err;
9fc6adfa
JD
979}
980
1da177e4
LT
981int i2c_probe(struct i2c_adapter *adapter,
982 struct i2c_client_address_data *address_data,
983 int (*found_proc) (struct i2c_adapter *, int, int))
984{
a89ba0bc 985 int i, err;
1da177e4
LT
986 int adap_id = i2c_adapter_id(adapter);
987
a89ba0bc
JD
988 /* Force entries are done first, and are not affected by ignore
989 entries */
990 if (address_data->forces) {
991 unsigned short **forces = address_data->forces;
992 int kind;
993
994 for (kind = 0; forces[kind]; kind++) {
995 for (i = 0; forces[kind][i] != I2C_CLIENT_END;
996 i += 2) {
997 if (forces[kind][i] == adap_id
998 || forces[kind][i] == ANY_I2C_BUS) {
999 dev_dbg(&adapter->dev, "found force "
1000 "parameter for adapter %d, "
1001 "addr 0x%02x, kind %d\n",
1002 adap_id, forces[kind][i + 1],
1003 kind);
1004 err = i2c_probe_address(adapter,
1005 forces[kind][i + 1],
1006 kind, found_proc);
1007 if (err)
1008 return err;
1009 }
1da177e4
LT
1010 }
1011 }
a89ba0bc 1012 }
1da177e4 1013
4366dc94
JD
1014 /* Stop here if we can't use SMBUS_QUICK */
1015 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_QUICK)) {
1016 if (address_data->probe[0] == I2C_CLIENT_END
1017 && address_data->normal_i2c[0] == I2C_CLIENT_END)
438d6c2c 1018 return 0;
4366dc94
JD
1019
1020 dev_warn(&adapter->dev, "SMBus Quick command not supported, "
1021 "can't probe for chips\n");
1022 return -1;
1023 }
1024
a89ba0bc
JD
1025 /* Probe entries are done second, and are not affected by ignore
1026 entries either */
1027 for (i = 0; address_data->probe[i] != I2C_CLIENT_END; i += 2) {
1028 if (address_data->probe[i] == adap_id
1029 || address_data->probe[i] == ANY_I2C_BUS) {
1030 dev_dbg(&adapter->dev, "found probe parameter for "
1031 "adapter %d, addr 0x%02x\n", adap_id,
1032 address_data->probe[i + 1]);
1033 err = i2c_probe_address(adapter,
1034 address_data->probe[i + 1],
1035 -1, found_proc);
1036 if (err)
1037 return err;
1da177e4 1038 }
a89ba0bc 1039 }
1da177e4 1040
a89ba0bc
JD
1041 /* Normal entries are done last, unless shadowed by an ignore entry */
1042 for (i = 0; address_data->normal_i2c[i] != I2C_CLIENT_END; i += 1) {
1043 int j, ignore;
1044
1045 ignore = 0;
1046 for (j = 0; address_data->ignore[j] != I2C_CLIENT_END;
1047 j += 2) {
1048 if ((address_data->ignore[j] == adap_id ||
1049 address_data->ignore[j] == ANY_I2C_BUS)
1050 && address_data->ignore[j + 1]
1051 == address_data->normal_i2c[i]) {
1052 dev_dbg(&adapter->dev, "found ignore "
1053 "parameter for adapter %d, "
1054 "addr 0x%02x\n", adap_id,
1055 address_data->ignore[j + 1]);
2369df93
MH
1056 ignore = 1;
1057 break;
1da177e4
LT
1058 }
1059 }
a89ba0bc 1060 if (ignore)
1da177e4
LT
1061 continue;
1062
a89ba0bc
JD
1063 dev_dbg(&adapter->dev, "found normal entry for adapter %d, "
1064 "addr 0x%02x\n", adap_id,
1065 address_data->normal_i2c[i]);
1066 err = i2c_probe_address(adapter, address_data->normal_i2c[i],
1067 -1, found_proc);
1068 if (err)
1069 return err;
1da177e4 1070 }
a89ba0bc 1071
1da177e4
LT
1072 return 0;
1073}
c0564606 1074EXPORT_SYMBOL(i2c_probe);
1da177e4 1075
12b5053a
JD
1076struct i2c_client *
1077i2c_new_probed_device(struct i2c_adapter *adap,
1078 struct i2c_board_info *info,
1079 unsigned short const *addr_list)
1080{
1081 int i;
1082
1083 /* Stop here if the bus doesn't support probing */
1084 if (!i2c_check_functionality(adap, I2C_FUNC_SMBUS_READ_BYTE)) {
1085 dev_err(&adap->dev, "Probing not supported\n");
1086 return NULL;
1087 }
1088
1089 mutex_lock(&adap->clist_lock);
1090 for (i = 0; addr_list[i] != I2C_CLIENT_END; i++) {
1091 /* Check address validity */
1092 if (addr_list[i] < 0x03 || addr_list[i] > 0x77) {
1093 dev_warn(&adap->dev, "Invalid 7-bit address "
1094 "0x%02x\n", addr_list[i]);
1095 continue;
1096 }
1097
1098 /* Check address availability */
1099 if (__i2c_check_addr(adap, addr_list[i])) {
1100 dev_dbg(&adap->dev, "Address 0x%02x already in "
1101 "use, not probing\n", addr_list[i]);
1102 continue;
1103 }
1104
1105 /* Test address responsiveness
1106 The default probe method is a quick write, but it is known
1107 to corrupt the 24RF08 EEPROMs due to a state machine bug,
1108 and could also irreversibly write-protect some EEPROMs, so
1109 for address ranges 0x30-0x37 and 0x50-0x5f, we use a byte
1110 read instead. Also, some bus drivers don't implement
1111 quick write, so we fallback to a byte read it that case
1112 too. */
1113 if ((addr_list[i] & ~0x07) == 0x30
1114 || (addr_list[i] & ~0x0f) == 0x50
1115 || !i2c_check_functionality(adap, I2C_FUNC_SMBUS_QUICK)) {
1116 if (i2c_smbus_xfer(adap, addr_list[i], 0,
1117 I2C_SMBUS_READ, 0,
1118 I2C_SMBUS_BYTE, NULL) >= 0)
1119 break;
1120 } else {
1121 if (i2c_smbus_xfer(adap, addr_list[i], 0,
1122 I2C_SMBUS_WRITE, 0,
1123 I2C_SMBUS_QUICK, NULL) >= 0)
1124 break;
1125 }
1126 }
1127 mutex_unlock(&adap->clist_lock);
1128
1129 if (addr_list[i] == I2C_CLIENT_END) {
1130 dev_dbg(&adap->dev, "Probing failed, no device found\n");
1131 return NULL;
1132 }
1133
1134 info->addr = addr_list[i];
1135 return i2c_new_device(adap, info);
1136}
1137EXPORT_SYMBOL_GPL(i2c_new_probed_device);
1138
1da177e4
LT
1139struct i2c_adapter* i2c_get_adapter(int id)
1140{
1da177e4 1141 struct i2c_adapter *adapter;
438d6c2c 1142
b3585e4f 1143 mutex_lock(&core_lists);
a0920e10
MH
1144 adapter = (struct i2c_adapter *)idr_find(&i2c_adapter_idr, id);
1145 if (adapter && !try_module_get(adapter->owner))
1146 adapter = NULL;
1147
b3585e4f 1148 mutex_unlock(&core_lists);
a0920e10 1149 return adapter;
1da177e4 1150}
c0564606 1151EXPORT_SYMBOL(i2c_get_adapter);
1da177e4
LT
1152
1153void i2c_put_adapter(struct i2c_adapter *adap)
1154{
1155 module_put(adap->owner);
1156}
c0564606 1157EXPORT_SYMBOL(i2c_put_adapter);
1da177e4
LT
1158
1159/* The SMBus parts */
1160
438d6c2c 1161#define POLY (0x1070U << 3)
1da177e4
LT
1162static u8
1163crc8(u16 data)
1164{
1165 int i;
438d6c2c 1166
1da177e4 1167 for(i = 0; i < 8; i++) {
438d6c2c 1168 if (data & 0x8000)
1da177e4
LT
1169 data = data ^ POLY;
1170 data = data << 1;
1171 }
1172 return (u8)(data >> 8);
1173}
1174
421ef47b
JD
1175/* Incremental CRC8 over count bytes in the array pointed to by p */
1176static u8 i2c_smbus_pec(u8 crc, u8 *p, size_t count)
1da177e4
LT
1177{
1178 int i;
1179
1180 for(i = 0; i < count; i++)
421ef47b 1181 crc = crc8((crc ^ p[i]) << 8);
1da177e4
LT
1182 return crc;
1183}
1184
421ef47b
JD
1185/* Assume a 7-bit address, which is reasonable for SMBus */
1186static u8 i2c_smbus_msg_pec(u8 pec, struct i2c_msg *msg)
1da177e4 1187{
421ef47b
JD
1188 /* The address will be sent first */
1189 u8 addr = (msg->addr << 1) | !!(msg->flags & I2C_M_RD);
1190 pec = i2c_smbus_pec(pec, &addr, 1);
1191
1192 /* The data buffer follows */
1193 return i2c_smbus_pec(pec, msg->buf, msg->len);
1da177e4
LT
1194}
1195
421ef47b
JD
1196/* Used for write only transactions */
1197static inline void i2c_smbus_add_pec(struct i2c_msg *msg)
1da177e4 1198{
421ef47b
JD
1199 msg->buf[msg->len] = i2c_smbus_msg_pec(0, msg);
1200 msg->len++;
1da177e4
LT
1201}
1202
421ef47b
JD
1203/* Return <0 on CRC error
1204 If there was a write before this read (most cases) we need to take the
1205 partial CRC from the write part into account.
1206 Note that this function does modify the message (we need to decrease the
1207 message length to hide the CRC byte from the caller). */
1208static int i2c_smbus_check_pec(u8 cpec, struct i2c_msg *msg)
1da177e4 1209{
421ef47b
JD
1210 u8 rpec = msg->buf[--msg->len];
1211 cpec = i2c_smbus_msg_pec(cpec, msg);
1da177e4 1212
1da177e4
LT
1213 if (rpec != cpec) {
1214 pr_debug("i2c-core: Bad PEC 0x%02x vs. 0x%02x\n",
1215 rpec, cpec);
1216 return -1;
1217 }
438d6c2c 1218 return 0;
1da177e4
LT
1219}
1220
1221s32 i2c_smbus_write_quick(struct i2c_client *client, u8 value)
1222{
1223 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
438d6c2c 1224 value,0,I2C_SMBUS_QUICK,NULL);
1da177e4 1225}
c0564606 1226EXPORT_SYMBOL(i2c_smbus_write_quick);
1da177e4
LT
1227
1228s32 i2c_smbus_read_byte(struct i2c_client *client)
1229{
1230 union i2c_smbus_data data;
1231 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1232 I2C_SMBUS_READ,0,I2C_SMBUS_BYTE, &data))
1233 return -1;
1234 else
7eff82c8 1235 return data.byte;
1da177e4 1236}
c0564606 1237EXPORT_SYMBOL(i2c_smbus_read_byte);
1da177e4
LT
1238
1239s32 i2c_smbus_write_byte(struct i2c_client *client, u8 value)
1240{
1da177e4 1241 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
421ef47b 1242 I2C_SMBUS_WRITE, value, I2C_SMBUS_BYTE, NULL);
1da177e4 1243}
c0564606 1244EXPORT_SYMBOL(i2c_smbus_write_byte);
1da177e4
LT
1245
1246s32 i2c_smbus_read_byte_data(struct i2c_client *client, u8 command)
1247{
1248 union i2c_smbus_data data;
1249 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1250 I2C_SMBUS_READ,command, I2C_SMBUS_BYTE_DATA,&data))
1251 return -1;
1252 else
7eff82c8 1253 return data.byte;
1da177e4 1254}
c0564606 1255EXPORT_SYMBOL(i2c_smbus_read_byte_data);
1da177e4
LT
1256
1257s32 i2c_smbus_write_byte_data(struct i2c_client *client, u8 command, u8 value)
1258{
1259 union i2c_smbus_data data;
1260 data.byte = value;
1261 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1262 I2C_SMBUS_WRITE,command,
1263 I2C_SMBUS_BYTE_DATA,&data);
1264}
c0564606 1265EXPORT_SYMBOL(i2c_smbus_write_byte_data);
1da177e4
LT
1266
1267s32 i2c_smbus_read_word_data(struct i2c_client *client, u8 command)
1268{
1269 union i2c_smbus_data data;
1270 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1271 I2C_SMBUS_READ,command, I2C_SMBUS_WORD_DATA, &data))
1272 return -1;
1273 else
7eff82c8 1274 return data.word;
1da177e4 1275}
c0564606 1276EXPORT_SYMBOL(i2c_smbus_read_word_data);
1da177e4
LT
1277
1278s32 i2c_smbus_write_word_data(struct i2c_client *client, u8 command, u16 value)
1279{
1280 union i2c_smbus_data data;
1281 data.word = value;
1282 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1283 I2C_SMBUS_WRITE,command,
1284 I2C_SMBUS_WORD_DATA,&data);
1285}
c0564606 1286EXPORT_SYMBOL(i2c_smbus_write_word_data);
1da177e4 1287
a64ec07d
DB
1288/**
1289 * i2c_smbus_read_block_data - SMBus block read request
1290 * @client: Handle to slave device
1291 * @command: Command byte issued to let the slave know what data should
1292 * be returned
1293 * @values: Byte array into which data will be read; big enough to hold
1294 * the data returned by the slave. SMBus allows at most 32 bytes.
1295 *
1296 * Returns the number of bytes read in the slave's response, else a
1297 * negative number to indicate some kind of error.
1298 *
1299 * Note that using this function requires that the client's adapter support
1300 * the I2C_FUNC_SMBUS_READ_BLOCK_DATA functionality. Not all adapter drivers
1301 * support this; its emulation through I2C messaging relies on a specific
1302 * mechanism (I2C_M_RECV_LEN) which may not be implemented.
1303 */
b86a1bc8
JD
1304s32 i2c_smbus_read_block_data(struct i2c_client *client, u8 command,
1305 u8 *values)
1306{
1307 union i2c_smbus_data data;
1308
1309 if (i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1310 I2C_SMBUS_READ, command,
1311 I2C_SMBUS_BLOCK_DATA, &data))
1312 return -1;
1313
1314 memcpy(values, &data.block[1], data.block[0]);
1315 return data.block[0];
1316}
1317EXPORT_SYMBOL(i2c_smbus_read_block_data);
1318
1da177e4 1319s32 i2c_smbus_write_block_data(struct i2c_client *client, u8 command,
46f5ed75 1320 u8 length, const u8 *values)
1da177e4
LT
1321{
1322 union i2c_smbus_data data;
7656032b 1323
1da177e4
LT
1324 if (length > I2C_SMBUS_BLOCK_MAX)
1325 length = I2C_SMBUS_BLOCK_MAX;
1da177e4 1326 data.block[0] = length;
7656032b 1327 memcpy(&data.block[1], values, length);
1da177e4
LT
1328 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1329 I2C_SMBUS_WRITE,command,
1330 I2C_SMBUS_BLOCK_DATA,&data);
1331}
c0564606 1332EXPORT_SYMBOL(i2c_smbus_write_block_data);
1da177e4
LT
1333
1334/* Returns the number of read bytes */
4b2643d7
JD
1335s32 i2c_smbus_read_i2c_block_data(struct i2c_client *client, u8 command,
1336 u8 length, u8 *values)
1da177e4
LT
1337{
1338 union i2c_smbus_data data;
7656032b 1339
4b2643d7
JD
1340 if (length > I2C_SMBUS_BLOCK_MAX)
1341 length = I2C_SMBUS_BLOCK_MAX;
1342 data.block[0] = length;
1da177e4
LT
1343 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1344 I2C_SMBUS_READ,command,
1345 I2C_SMBUS_I2C_BLOCK_DATA,&data))
1346 return -1;
7656032b
JD
1347
1348 memcpy(values, &data.block[1], data.block[0]);
1349 return data.block[0];
1da177e4 1350}
c0564606 1351EXPORT_SYMBOL(i2c_smbus_read_i2c_block_data);
1da177e4 1352
21bbd691 1353s32 i2c_smbus_write_i2c_block_data(struct i2c_client *client, u8 command,
46f5ed75 1354 u8 length, const u8 *values)
21bbd691
JD
1355{
1356 union i2c_smbus_data data;
1357
1358 if (length > I2C_SMBUS_BLOCK_MAX)
1359 length = I2C_SMBUS_BLOCK_MAX;
1360 data.block[0] = length;
1361 memcpy(data.block + 1, values, length);
1362 return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1363 I2C_SMBUS_WRITE, command,
1364 I2C_SMBUS_I2C_BLOCK_DATA, &data);
1365}
c0564606 1366EXPORT_SYMBOL(i2c_smbus_write_i2c_block_data);
21bbd691 1367
438d6c2c 1368/* Simulate a SMBus command using the i2c protocol
1da177e4 1369 No checking of parameters is done! */
438d6c2c 1370static s32 i2c_smbus_xfer_emulated(struct i2c_adapter * adapter, u16 addr,
1da177e4 1371 unsigned short flags,
438d6c2c 1372 char read_write, u8 command, int size,
1da177e4
LT
1373 union i2c_smbus_data * data)
1374{
1375 /* So we need to generate a series of msgs. In the case of writing, we
1376 need to use only one message; when reading, we need two. We initialize
1377 most things with sane defaults, to keep the code below somewhat
1378 simpler. */
5c50d188
HI
1379 unsigned char msgbuf0[I2C_SMBUS_BLOCK_MAX+3];
1380 unsigned char msgbuf1[I2C_SMBUS_BLOCK_MAX+2];
1da177e4 1381 int num = read_write == I2C_SMBUS_READ?2:1;
438d6c2c 1382 struct i2c_msg msg[2] = { { addr, flags, 1, msgbuf0 },
1da177e4
LT
1383 { addr, flags | I2C_M_RD, 0, msgbuf1 }
1384 };
1385 int i;
421ef47b 1386 u8 partial_pec = 0;
1da177e4
LT
1387
1388 msgbuf0[0] = command;
1389 switch(size) {
1390 case I2C_SMBUS_QUICK:
1391 msg[0].len = 0;
1392 /* Special case: The read/write field is used as data */
1393 msg[0].flags = flags | (read_write==I2C_SMBUS_READ)?I2C_M_RD:0;
1394 num = 1;
1395 break;
1396 case I2C_SMBUS_BYTE:
1397 if (read_write == I2C_SMBUS_READ) {
1398 /* Special case: only a read! */
1399 msg[0].flags = I2C_M_RD | flags;
1400 num = 1;
1401 }
1402 break;
1403 case I2C_SMBUS_BYTE_DATA:
1404 if (read_write == I2C_SMBUS_READ)
1405 msg[1].len = 1;
1406 else {
1407 msg[0].len = 2;
1408 msgbuf0[1] = data->byte;
1409 }
1410 break;
1411 case I2C_SMBUS_WORD_DATA:
1412 if (read_write == I2C_SMBUS_READ)
1413 msg[1].len = 2;
1414 else {
1415 msg[0].len=3;
1416 msgbuf0[1] = data->word & 0xff;
7eff82c8 1417 msgbuf0[2] = data->word >> 8;
1da177e4
LT
1418 }
1419 break;
1420 case I2C_SMBUS_PROC_CALL:
1421 num = 2; /* Special case */
1422 read_write = I2C_SMBUS_READ;
1423 msg[0].len = 3;
1424 msg[1].len = 2;
1425 msgbuf0[1] = data->word & 0xff;
7eff82c8 1426 msgbuf0[2] = data->word >> 8;
1da177e4
LT
1427 break;
1428 case I2C_SMBUS_BLOCK_DATA:
1da177e4 1429 if (read_write == I2C_SMBUS_READ) {
209d27c3
JD
1430 msg[1].flags |= I2C_M_RECV_LEN;
1431 msg[1].len = 1; /* block length will be added by
1432 the underlying bus driver */
1da177e4
LT
1433 } else {
1434 msg[0].len = data->block[0] + 2;
1435 if (msg[0].len > I2C_SMBUS_BLOCK_MAX + 2) {
1436 dev_err(&adapter->dev, "smbus_access called with "
1437 "invalid block write size (%d)\n",
1438 data->block[0]);
1439 return -1;
1440 }
5c50d188 1441 for (i = 1; i < msg[0].len; i++)
1da177e4
LT
1442 msgbuf0[i] = data->block[i-1];
1443 }
1444 break;
1445 case I2C_SMBUS_BLOCK_PROC_CALL:
209d27c3
JD
1446 num = 2; /* Another special case */
1447 read_write = I2C_SMBUS_READ;
1448 if (data->block[0] > I2C_SMBUS_BLOCK_MAX) {
1449 dev_err(&adapter->dev, "%s called with invalid "
1450 "block proc call size (%d)\n", __FUNCTION__,
1451 data->block[0]);
1452 return -1;
1453 }
1454 msg[0].len = data->block[0] + 2;
1455 for (i = 1; i < msg[0].len; i++)
1456 msgbuf0[i] = data->block[i-1];
1457 msg[1].flags |= I2C_M_RECV_LEN;
1458 msg[1].len = 1; /* block length will be added by
1459 the underlying bus driver */
1460 break;
1da177e4
LT
1461 case I2C_SMBUS_I2C_BLOCK_DATA:
1462 if (read_write == I2C_SMBUS_READ) {
4b2643d7 1463 msg[1].len = data->block[0];
1da177e4
LT
1464 } else {
1465 msg[0].len = data->block[0] + 1;
30dac746 1466 if (msg[0].len > I2C_SMBUS_BLOCK_MAX + 1) {
1da177e4
LT
1467 dev_err(&adapter->dev, "i2c_smbus_xfer_emulated called with "
1468 "invalid block write size (%d)\n",
1469 data->block[0]);
1470 return -1;
1471 }
1472 for (i = 1; i <= data->block[0]; i++)
1473 msgbuf0[i] = data->block[i];
1474 }
1475 break;
1476 default:
1477 dev_err(&adapter->dev, "smbus_access called with invalid size (%d)\n",
1478 size);
1479 return -1;
1480 }
1481
421ef47b
JD
1482 i = ((flags & I2C_CLIENT_PEC) && size != I2C_SMBUS_QUICK
1483 && size != I2C_SMBUS_I2C_BLOCK_DATA);
1484 if (i) {
1485 /* Compute PEC if first message is a write */
1486 if (!(msg[0].flags & I2C_M_RD)) {
438d6c2c 1487 if (num == 1) /* Write only */
421ef47b
JD
1488 i2c_smbus_add_pec(&msg[0]);
1489 else /* Write followed by read */
1490 partial_pec = i2c_smbus_msg_pec(0, &msg[0]);
1491 }
1492 /* Ask for PEC if last message is a read */
1493 if (msg[num-1].flags & I2C_M_RD)
438d6c2c 1494 msg[num-1].len++;
421ef47b
JD
1495 }
1496
1da177e4
LT
1497 if (i2c_transfer(adapter, msg, num) < 0)
1498 return -1;
1499
421ef47b
JD
1500 /* Check PEC if last message is a read */
1501 if (i && (msg[num-1].flags & I2C_M_RD)) {
1502 if (i2c_smbus_check_pec(partial_pec, &msg[num-1]) < 0)
1503 return -1;
1504 }
1505
1da177e4
LT
1506 if (read_write == I2C_SMBUS_READ)
1507 switch(size) {
1508 case I2C_SMBUS_BYTE:
1509 data->byte = msgbuf0[0];
1510 break;
1511 case I2C_SMBUS_BYTE_DATA:
1512 data->byte = msgbuf1[0];
1513 break;
438d6c2c 1514 case I2C_SMBUS_WORD_DATA:
1da177e4
LT
1515 case I2C_SMBUS_PROC_CALL:
1516 data->word = msgbuf1[0] | (msgbuf1[1] << 8);
1517 break;
1518 case I2C_SMBUS_I2C_BLOCK_DATA:
4b2643d7 1519 for (i = 0; i < data->block[0]; i++)
1da177e4
LT
1520 data->block[i+1] = msgbuf1[i];
1521 break;
209d27c3
JD
1522 case I2C_SMBUS_BLOCK_DATA:
1523 case I2C_SMBUS_BLOCK_PROC_CALL:
1524 for (i = 0; i < msgbuf1[0] + 1; i++)
1525 data->block[i] = msgbuf1[i];
1526 break;
1da177e4
LT
1527 }
1528 return 0;
1529}
1530
1531
1532s32 i2c_smbus_xfer(struct i2c_adapter * adapter, u16 addr, unsigned short flags,
438d6c2c 1533 char read_write, u8 command, int size,
1da177e4
LT
1534 union i2c_smbus_data * data)
1535{
1536 s32 res;
1da177e4
LT
1537
1538 flags &= I2C_M_TEN | I2C_CLIENT_PEC;
1da177e4
LT
1539
1540 if (adapter->algo->smbus_xfer) {
5c085d36 1541 mutex_lock(&adapter->bus_lock);
1da177e4
LT
1542 res = adapter->algo->smbus_xfer(adapter,addr,flags,read_write,
1543 command,size,data);
5c085d36 1544 mutex_unlock(&adapter->bus_lock);
1da177e4
LT
1545 } else
1546 res = i2c_smbus_xfer_emulated(adapter,addr,flags,read_write,
1547 command,size,data);
1548
1da177e4
LT
1549 return res;
1550}
1da177e4 1551EXPORT_SYMBOL(i2c_smbus_xfer);
1da177e4
LT
1552
1553MODULE_AUTHOR("Simon G. Vogl <simon@tk.uni-linz.ac.at>");
1554MODULE_DESCRIPTION("I2C-Bus main module");
1555MODULE_LICENSE("GPL");
This page took 0.489447 seconds and 5 git commands to generate.