blob: 64f8e56d300ec7046ab3389ff4c53198d775b12e [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/* 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
20/* With some changes from Kyösti Mälkki <kmalkki@cc.hut.fi>.
21 All SMBus-related things are written by Frodo Looijaard <frodol@dds.nl>
Jean Delvare421ef472005-10-26 21:28:55 +020022 SMBus 2.0 support by Mark Studebaker <mdsxyz123@yahoo.com> and
23 Jean Delvare <khali@linux-fr.org> */
Linus Torvalds1da177e2005-04-16 15:20:36 -070024
Linus Torvalds1da177e2005-04-16 15:20:36 -070025#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>
Russell Kingd052d1b2005-10-29 19:07:23 +010033#include <linux/platform_device.h>
Arjan van de Venb3585e42006-01-11 10:50:26 +010034#include <linux/mutex.h>
Jean Delvareb8d6f452007-02-13 22:09:00 +010035#include <linux/completion.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070036#include <asm/uaccess.h>
37
David Brownell9c1600e2007-05-01 23:26:31 +020038#include "i2c-core.h"
39
Linus Torvalds1da177e2005-04-16 15:20:36 -070040
41static LIST_HEAD(adapters);
42static LIST_HEAD(drivers);
Arjan van de Venb3585e42006-01-11 10:50:26 +010043static DEFINE_MUTEX(core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -070044static DEFINE_IDR(i2c_adapter_idr);
45
David Brownella1d9e6e2007-05-01 23:26:30 +020046#define is_newstyle_driver(d) ((d)->probe || (d)->remove)
David Brownellf37dd802007-02-13 22:09:00 +010047
48/* ------------------------------------------------------------------------- */
49
Linus Torvalds1da177e2005-04-16 15:20:36 -070050static int i2c_device_match(struct device *dev, struct device_driver *drv)
51{
David Brownell7b4fbc52007-05-01 23:26:30 +020052 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 */
David Brownella1d9e6e2007-05-01 23:26:30 +020058 if (!is_newstyle_driver(driver))
David Brownell7b4fbc52007-05-01 23:26:30 +020059 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;
Linus Torvalds1da177e2005-04-16 15:20:36 -070065}
66
David Brownell7b4fbc52007-05-01 23:26:30 +020067#ifdef CONFIG_HOTPLUG
68
69/* uevent helps with hotplug: modprobe -q $(MODALIAS) */
70static int i2c_device_uevent(struct device *dev, char **envp, int num_envp,
71 char *buffer, int buffer_size)
72{
73 struct i2c_client *client = to_i2c_client(dev);
74 int i = 0, length = 0;
75
76 /* by definition, legacy drivers can't hotplug */
77 if (dev->driver || !client->driver_name)
78 return 0;
79
80 if (add_uevent_var(envp, num_envp, &i, buffer, buffer_size, &length,
81 "MODALIAS=%s", client->driver_name))
82 return -ENOMEM;
83 envp[i] = NULL;
84 dev_dbg(dev, "uevent\n");
85 return 0;
86}
87
88#else
89#define i2c_device_uevent NULL
90#endif /* CONFIG_HOTPLUG */
91
Linus Torvalds1da177e2005-04-16 15:20:36 -070092static int i2c_device_probe(struct device *dev)
93{
David Brownell7b4fbc52007-05-01 23:26:30 +020094 struct i2c_client *client = to_i2c_client(dev);
95 struct i2c_driver *driver = to_i2c_driver(dev->driver);
96
97 if (!driver->probe)
98 return -ENODEV;
99 client->driver = driver;
100 dev_dbg(dev, "probe\n");
101 return driver->probe(client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102}
103
104static int i2c_device_remove(struct device *dev)
105{
David Brownella1d9e6e2007-05-01 23:26:30 +0200106 struct i2c_client *client = to_i2c_client(dev);
107 struct i2c_driver *driver;
108 int status;
109
110 if (!dev->driver)
111 return 0;
112
113 driver = to_i2c_driver(dev->driver);
114 if (driver->remove) {
115 dev_dbg(dev, "remove\n");
116 status = driver->remove(client);
117 } else {
118 dev->driver = NULL;
119 status = 0;
120 }
121 if (status == 0)
122 client->driver = NULL;
123 return status;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700124}
125
David Brownellf37dd802007-02-13 22:09:00 +0100126static void i2c_device_shutdown(struct device *dev)
127{
128 struct i2c_driver *driver;
129
130 if (!dev->driver)
131 return;
132 driver = to_i2c_driver(dev->driver);
133 if (driver->shutdown)
134 driver->shutdown(to_i2c_client(dev));
135}
136
137static int i2c_device_suspend(struct device * dev, pm_message_t mesg)
138{
139 struct i2c_driver *driver;
140
141 if (!dev->driver)
142 return 0;
143 driver = to_i2c_driver(dev->driver);
144 if (!driver->suspend)
145 return 0;
146 return driver->suspend(to_i2c_client(dev), mesg);
147}
148
149static int i2c_device_resume(struct device * dev)
150{
151 struct i2c_driver *driver;
152
153 if (!dev->driver)
154 return 0;
155 driver = to_i2c_driver(dev->driver);
156 if (!driver->resume)
157 return 0;
158 return driver->resume(to_i2c_client(dev));
159}
160
David Brownell7b4fbc52007-05-01 23:26:30 +0200161static void i2c_client_release(struct device *dev)
162{
163 struct i2c_client *client = to_i2c_client(dev);
164 complete(&client->released);
165}
166
David Brownell9c1600e2007-05-01 23:26:31 +0200167static void i2c_client_dev_release(struct device *dev)
168{
169 kfree(to_i2c_client(dev));
170}
171
David Brownell7b4fbc52007-05-01 23:26:30 +0200172static ssize_t show_client_name(struct device *dev, struct device_attribute *attr, char *buf)
173{
174 struct i2c_client *client = to_i2c_client(dev);
175 return sprintf(buf, "%s\n", client->name);
176}
177
178static ssize_t show_modalias(struct device *dev, struct device_attribute *attr, char *buf)
179{
180 struct i2c_client *client = to_i2c_client(dev);
181 return client->driver_name
182 ? sprintf(buf, "%s\n", client->driver_name)
183 : 0;
184}
185
186static struct device_attribute i2c_dev_attrs[] = {
187 __ATTR(name, S_IRUGO, show_client_name, NULL),
188 /* modalias helps coldplug: modprobe $(cat .../modalias) */
189 __ATTR(modalias, S_IRUGO, show_modalias, NULL),
190 { },
191};
192
Russell Kingb864c7d2006-01-05 14:37:50 +0000193struct bus_type i2c_bus_type = {
David Brownellf37dd802007-02-13 22:09:00 +0100194 .name = "i2c",
David Brownell7b4fbc52007-05-01 23:26:30 +0200195 .dev_attrs = i2c_dev_attrs,
David Brownellf37dd802007-02-13 22:09:00 +0100196 .match = i2c_device_match,
David Brownell7b4fbc52007-05-01 23:26:30 +0200197 .uevent = i2c_device_uevent,
David Brownellf37dd802007-02-13 22:09:00 +0100198 .probe = i2c_device_probe,
199 .remove = i2c_device_remove,
200 .shutdown = i2c_device_shutdown,
201 .suspend = i2c_device_suspend,
202 .resume = i2c_device_resume,
Russell Kingb864c7d2006-01-05 14:37:50 +0000203};
David Brownellc0564602007-05-01 23:26:31 +0200204EXPORT_SYMBOL_GPL(i2c_bus_type);
Russell Kingb864c7d2006-01-05 14:37:50 +0000205
David Brownell9c1600e2007-05-01 23:26:31 +0200206/**
207 * i2c_new_device - instantiate an i2c device for use with a new style driver
208 * @adap: the adapter managing the device
209 * @info: describes one I2C device; bus_num is ignored
210 *
211 * Create a device to work with a new style i2c driver, where binding is
212 * handled through driver model probe()/remove() methods. This call is not
213 * appropriate for use by mainboad initialization logic, which usually runs
214 * during an arch_initcall() long before any i2c_adapter could exist.
215 *
216 * This returns the new i2c client, which may be saved for later use with
217 * i2c_unregister_device(); or NULL to indicate an error.
218 */
219struct i2c_client *
220i2c_new_device(struct i2c_adapter *adap, struct i2c_board_info const *info)
221{
222 struct i2c_client *client;
223 int status;
224
225 client = kzalloc(sizeof *client, GFP_KERNEL);
226 if (!client)
227 return NULL;
228
229 client->adapter = adap;
230
231 client->dev.platform_data = info->platform_data;
232 client->flags = info->flags;
233 client->addr = info->addr;
234 client->irq = info->irq;
235
236 strlcpy(client->driver_name, info->driver_name,
237 sizeof(client->driver_name));
238 strlcpy(client->name, info->type, sizeof(client->name));
239
240 /* a new style driver may be bound to this device when we
241 * return from this function, or any later moment (e.g. maybe
242 * hotplugging will load the driver module). and the device
243 * refcount model is the standard driver model one.
244 */
245 status = i2c_attach_client(client);
246 if (status < 0) {
247 kfree(client);
248 client = NULL;
249 }
250 return client;
251}
252EXPORT_SYMBOL_GPL(i2c_new_device);
253
254
255/**
256 * i2c_unregister_device - reverse effect of i2c_new_device()
257 * @client: value returned from i2c_new_device()
258 */
259void i2c_unregister_device(struct i2c_client *client)
David Brownella1d9e6e2007-05-01 23:26:30 +0200260{
261 struct i2c_adapter *adapter = client->adapter;
262 struct i2c_driver *driver = client->driver;
263
264 if (driver && !is_newstyle_driver(driver)) {
265 dev_err(&client->dev, "can't unregister devices "
266 "with legacy drivers\n");
267 WARN_ON(1);
268 return;
269 }
270
271 mutex_lock(&adapter->clist_lock);
272 list_del(&client->list);
273 mutex_unlock(&adapter->clist_lock);
274
275 device_unregister(&client->dev);
276}
David Brownell9c1600e2007-05-01 23:26:31 +0200277EXPORT_SYMBOL_GPL(i2c_unregister_device);
David Brownella1d9e6e2007-05-01 23:26:30 +0200278
279
David Brownellf37dd802007-02-13 22:09:00 +0100280/* ------------------------------------------------------------------------- */
281
David Brownell16ffadf2007-05-01 23:26:28 +0200282/* I2C bus adapters -- one roots each I2C or SMBUS segment */
283
Jean Delvareefde7232005-07-20 23:03:50 +0200284void i2c_adapter_dev_release(struct device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700285{
David Brownellef2c83212007-05-01 23:26:28 +0200286 struct i2c_adapter *adap = to_i2c_adapter(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700287 complete(&adap->dev_released);
288}
David Brownellc0564602007-05-01 23:26:31 +0200289EXPORT_SYMBOL_GPL(i2c_adapter_dev_release); /* exported to i2c-isa */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700290
David Brownell16ffadf2007-05-01 23:26:28 +0200291static ssize_t
292show_adapter_name(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700293{
David Brownellef2c83212007-05-01 23:26:28 +0200294 struct i2c_adapter *adap = to_i2c_adapter(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700295 return sprintf(buf, "%s\n", adap->name);
296}
David Brownell16ffadf2007-05-01 23:26:28 +0200297
298static struct device_attribute i2c_adapter_attrs[] = {
299 __ATTR(name, S_IRUGO, show_adapter_name, NULL),
300 { },
301};
302
303struct class i2c_adapter_class = {
304 .owner = THIS_MODULE,
305 .name = "i2c-adapter",
306 .dev_attrs = i2c_adapter_attrs,
307};
David Brownellc0564602007-05-01 23:26:31 +0200308EXPORT_SYMBOL_GPL(i2c_adapter_class); /* exported to i2c-isa */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700309
David Brownell9c1600e2007-05-01 23:26:31 +0200310static void i2c_scan_static_board_info(struct i2c_adapter *adapter)
311{
312 struct i2c_devinfo *devinfo;
313
314 mutex_lock(&__i2c_board_lock);
315 list_for_each_entry(devinfo, &__i2c_board_list, list) {
316 if (devinfo->busnum == adapter->nr
317 && !i2c_new_device(adapter,
318 &devinfo->board_info))
319 printk(KERN_ERR "i2c-core: can't create i2c%d-%04x\n",
320 i2c_adapter_id(adapter),
321 devinfo->board_info.addr);
322 }
323 mutex_unlock(&__i2c_board_lock);
324}
325
David Brownell6e13e642007-05-01 23:26:31 +0200326static int i2c_register_adapter(struct i2c_adapter *adap)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700327{
David Brownell6e13e642007-05-01 23:26:31 +0200328 int res = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700329 struct list_head *item;
330 struct i2c_driver *driver;
331
Ingo Molnar5c085d32006-01-18 23:16:04 +0100332 mutex_init(&adap->bus_lock);
333 mutex_init(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700334 INIT_LIST_HEAD(&adap->clients);
335
David Brownell6e13e642007-05-01 23:26:31 +0200336 mutex_lock(&core_lists);
337 list_add_tail(&adap->list, &adapters);
338
Linus Torvalds1da177e2005-04-16 15:20:36 -0700339 /* Add the adapter to the driver core.
340 * If the parent pointer is not set up,
341 * we add this adapter to the host bus.
342 */
David Brownellb119dc32007-01-04 13:07:04 +0100343 if (adap->dev.parent == NULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700344 adap->dev.parent = &platform_bus;
Jean Delvarefe2c8d52007-02-13 22:09:04 +0100345 pr_debug("I2C adapter driver [%s] forgot to specify "
346 "physical device\n", adap->name);
David Brownellb119dc32007-01-04 13:07:04 +0100347 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700348 sprintf(adap->dev.bus_id, "i2c-%d", adap->nr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700349 adap->dev.release = &i2c_adapter_dev_release;
Jean Delvarefccb56e2007-05-01 23:26:27 +0200350 adap->dev.class = &i2c_adapter_class;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200351 res = device_register(&adap->dev);
352 if (res)
353 goto out_list;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700354
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200355 dev_dbg(&adap->dev, "adapter [%s] registered\n", adap->name);
356
David Brownell6e13e642007-05-01 23:26:31 +0200357 /* create pre-declared device nodes for new-style drivers */
358 if (adap->nr < __i2c_first_dynamic_bus_num)
359 i2c_scan_static_board_info(adap);
360
David Brownell7b4fbc52007-05-01 23:26:30 +0200361 /* let legacy drivers scan this bus for matching devices */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700362 list_for_each(item,&drivers) {
363 driver = list_entry(item, struct i2c_driver, list);
Jean Delvare8a994752005-11-26 20:28:06 +0100364 if (driver->attach_adapter)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700365 /* We ignore the return code; if it fails, too bad */
366 driver->attach_adapter(adap);
367 }
368
Linus Torvalds1da177e2005-04-16 15:20:36 -0700369out_unlock:
Arjan van de Venb3585e42006-01-11 10:50:26 +0100370 mutex_unlock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700371 return res;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200372
Jean Delvareb119c6c2006-08-15 18:26:30 +0200373out_list:
374 list_del(&adap->list);
375 idr_remove(&i2c_adapter_idr, adap->nr);
376 goto out_unlock;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700377}
378
David Brownell6e13e642007-05-01 23:26:31 +0200379/**
380 * i2c_add_adapter - declare i2c adapter, use dynamic bus number
381 * @adapter: the adapter to add
382 *
383 * This routine is used to declare an I2C adapter when its bus number
384 * doesn't matter. Examples: for I2C adapters dynamically added by
385 * USB links or PCI plugin cards.
386 *
387 * When this returns zero, a new bus number was allocated and stored
388 * in adap->nr, and the specified adapter became available for clients.
389 * Otherwise, a negative errno value is returned.
390 */
391int i2c_add_adapter(struct i2c_adapter *adapter)
392{
393 int id, res = 0;
394
395retry:
396 if (idr_pre_get(&i2c_adapter_idr, GFP_KERNEL) == 0)
397 return -ENOMEM;
398
399 mutex_lock(&core_lists);
400 /* "above" here means "above or equal to", sigh */
401 res = idr_get_new_above(&i2c_adapter_idr, adapter,
402 __i2c_first_dynamic_bus_num, &id);
403 mutex_unlock(&core_lists);
404
405 if (res < 0) {
406 if (res == -EAGAIN)
407 goto retry;
408 return res;
409 }
410
411 adapter->nr = id;
412 return i2c_register_adapter(adapter);
413}
414EXPORT_SYMBOL(i2c_add_adapter);
415
416/**
417 * i2c_add_numbered_adapter - declare i2c adapter, use static bus number
418 * @adap: the adapter to register (with adap->nr initialized)
419 *
420 * This routine is used to declare an I2C adapter when its bus number
421 * matters. Example: for I2C adapters from system-on-chip CPUs, or
422 * otherwise built in to the system's mainboard, and where i2c_board_info
423 * is used to properly configure I2C devices.
424 *
425 * If no devices have pre-been declared for this bus, then be sure to
426 * register the adapter before any dynamically allocated ones. Otherwise
427 * the required bus ID may not be available.
428 *
429 * When this returns zero, the specified adapter became available for
430 * clients using the bus number provided in adap->nr. Also, the table
431 * of I2C devices pre-declared using i2c_register_board_info() is scanned,
432 * and the appropriate driver model device nodes are created. Otherwise, a
433 * negative errno value is returned.
434 */
435int i2c_add_numbered_adapter(struct i2c_adapter *adap)
436{
437 int id;
438 int status;
439
440 if (adap->nr & ~MAX_ID_MASK)
441 return -EINVAL;
442
443retry:
444 if (idr_pre_get(&i2c_adapter_idr, GFP_KERNEL) == 0)
445 return -ENOMEM;
446
447 mutex_lock(&core_lists);
448 /* "above" here means "above or equal to", sigh;
449 * we need the "equal to" result to force the result
450 */
451 status = idr_get_new_above(&i2c_adapter_idr, adap, adap->nr, &id);
452 if (status == 0 && id != adap->nr) {
453 status = -EBUSY;
454 idr_remove(&i2c_adapter_idr, id);
455 }
456 mutex_unlock(&core_lists);
457 if (status == -EAGAIN)
458 goto retry;
459
460 if (status == 0)
461 status = i2c_register_adapter(adap);
462 return status;
463}
464EXPORT_SYMBOL_GPL(i2c_add_numbered_adapter);
465
Linus Torvalds1da177e2005-04-16 15:20:36 -0700466int i2c_del_adapter(struct i2c_adapter *adap)
467{
468 struct list_head *item, *_n;
469 struct i2c_adapter *adap_from_list;
470 struct i2c_driver *driver;
471 struct i2c_client *client;
472 int res = 0;
473
Arjan van de Venb3585e42006-01-11 10:50:26 +0100474 mutex_lock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700475
476 /* First make sure that this adapter was ever added */
477 list_for_each_entry(adap_from_list, &adapters, list) {
478 if (adap_from_list == adap)
479 break;
480 }
481 if (adap_from_list != adap) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200482 pr_debug("i2c-core: attempting to delete unregistered "
483 "adapter [%s]\n", adap->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700484 res = -EINVAL;
485 goto out_unlock;
486 }
487
488 list_for_each(item,&drivers) {
489 driver = list_entry(item, struct i2c_driver, list);
490 if (driver->detach_adapter)
491 if ((res = driver->detach_adapter(adap))) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200492 dev_err(&adap->dev, "detach_adapter failed "
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100493 "for driver [%s]\n",
494 driver->driver.name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700495 goto out_unlock;
496 }
497 }
498
499 /* detach any active clients. This must be done first, because
Tobias Klausera551acc2005-05-19 21:40:38 +0200500 * it can fail; in which case we give up. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700501 list_for_each_safe(item, _n, &adap->clients) {
David Brownella1d9e6e2007-05-01 23:26:30 +0200502 struct i2c_driver *driver;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700503
David Brownella1d9e6e2007-05-01 23:26:30 +0200504 client = list_entry(item, struct i2c_client, list);
505 driver = client->driver;
506
507 /* new style, follow standard driver model */
508 if (!driver || is_newstyle_driver(driver)) {
509 i2c_unregister_device(client);
510 continue;
511 }
512
513 /* legacy drivers create and remove clients themselves */
514 if ((res = driver->detach_client(client))) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200515 dev_err(&adap->dev, "detach_client failed for client "
516 "[%s] at address 0x%02x\n", client->name,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700517 client->addr);
518 goto out_unlock;
519 }
520 }
521
522 /* clean up the sysfs representation */
523 init_completion(&adap->dev_released);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700524 device_unregister(&adap->dev);
525 list_del(&adap->list);
526
527 /* wait for sysfs to drop all references */
528 wait_for_completion(&adap->dev_released);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700529
David Brownell6e13e642007-05-01 23:26:31 +0200530 /* free bus id */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700531 idr_remove(&i2c_adapter_idr, adap->nr);
532
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200533 dev_dbg(&adap->dev, "adapter [%s] unregistered\n", adap->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700534
535 out_unlock:
Arjan van de Venb3585e42006-01-11 10:50:26 +0100536 mutex_unlock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700537 return res;
538}
David Brownellc0564602007-05-01 23:26:31 +0200539EXPORT_SYMBOL(i2c_del_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700540
541
David Brownell7b4fbc52007-05-01 23:26:30 +0200542/* ------------------------------------------------------------------------- */
543
544/*
545 * An i2c_driver is used with one or more i2c_client (device) nodes to access
546 * i2c slave chips, on a bus instance associated with some i2c_adapter. There
547 * are two models for binding the driver to its device: "new style" drivers
548 * follow the standard Linux driver model and just respond to probe() calls
549 * issued if the driver core sees they match(); "legacy" drivers create device
550 * nodes themselves.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700551 */
552
Greg Kroah-Hartmande59cf92005-12-06 15:33:15 -0800553int i2c_register_driver(struct module *owner, struct i2c_driver *driver)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700554{
Jean Delvare7eebcb72006-02-05 23:28:21 +0100555 int res;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700556
David Brownell7b4fbc52007-05-01 23:26:30 +0200557 /* new style driver methods can't mix with legacy ones */
David Brownella1d9e6e2007-05-01 23:26:30 +0200558 if (is_newstyle_driver(driver)) {
David Brownell7b4fbc52007-05-01 23:26:30 +0200559 if (driver->attach_adapter || driver->detach_adapter
560 || driver->detach_client) {
561 printk(KERN_WARNING
562 "i2c-core: driver [%s] is confused\n",
563 driver->driver.name);
564 return -EINVAL;
565 }
566 }
567
Linus Torvalds1da177e2005-04-16 15:20:36 -0700568 /* add the driver to the list of i2c drivers in the driver core */
Greg Kroah-Hartmande59cf92005-12-06 15:33:15 -0800569 driver->driver.owner = owner;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700570 driver->driver.bus = &i2c_bus_type;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700571
David Brownell6e13e642007-05-01 23:26:31 +0200572 /* for new style drivers, when registration returns the driver core
573 * will have called probe() for all matching-but-unbound devices.
574 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700575 res = driver_register(&driver->driver);
576 if (res)
Jean Delvare7eebcb72006-02-05 23:28:21 +0100577 return res;
David Brownell438d6c22006-12-10 21:21:31 +0100578
Jean Delvare7eebcb72006-02-05 23:28:21 +0100579 mutex_lock(&core_lists);
580
Linus Torvalds1da177e2005-04-16 15:20:36 -0700581 list_add_tail(&driver->list,&drivers);
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100582 pr_debug("i2c-core: driver [%s] registered\n", driver->driver.name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700583
David Brownell7b4fbc52007-05-01 23:26:30 +0200584 /* legacy drivers scan i2c busses directly */
Jean Delvare8a994752005-11-26 20:28:06 +0100585 if (driver->attach_adapter) {
David Brownell4ad4eac2007-05-01 23:26:28 +0200586 struct i2c_adapter *adapter;
587
588 list_for_each_entry(adapter, &adapters, list) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700589 driver->attach_adapter(adapter);
590 }
591 }
592
Arjan van de Venb3585e42006-01-11 10:50:26 +0100593 mutex_unlock(&core_lists);
Jean Delvare7eebcb72006-02-05 23:28:21 +0100594 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700595}
Greg Kroah-Hartmande59cf92005-12-06 15:33:15 -0800596EXPORT_SYMBOL(i2c_register_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700597
David Brownella1d9e6e2007-05-01 23:26:30 +0200598/**
599 * i2c_del_driver - unregister I2C driver
600 * @driver: the driver being unregistered
601 */
Jean Delvareb3e82092007-05-01 23:26:32 +0200602void i2c_del_driver(struct i2c_driver *driver)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700603{
604 struct list_head *item1, *item2, *_n;
605 struct i2c_client *client;
606 struct i2c_adapter *adap;
David Brownell438d6c22006-12-10 21:21:31 +0100607
Arjan van de Venb3585e42006-01-11 10:50:26 +0100608 mutex_lock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700609
David Brownella1d9e6e2007-05-01 23:26:30 +0200610 /* new-style driver? */
611 if (is_newstyle_driver(driver))
612 goto unregister;
613
Linus Torvalds1da177e2005-04-16 15:20:36 -0700614 /* Have a look at each adapter, if clients of this driver are still
David Brownell438d6c22006-12-10 21:21:31 +0100615 * attached. If so, detach them to be able to kill the driver
Linus Torvalds1da177e2005-04-16 15:20:36 -0700616 * afterwards.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700617 */
618 list_for_each(item1,&adapters) {
619 adap = list_entry(item1, struct i2c_adapter, list);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700620 if (driver->detach_adapter) {
Jean Delvareb3e82092007-05-01 23:26:32 +0200621 if (driver->detach_adapter(adap)) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200622 dev_err(&adap->dev, "detach_adapter failed "
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100623 "for driver [%s]\n",
624 driver->driver.name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700625 }
626 } else {
627 list_for_each_safe(item2, _n, &adap->clients) {
628 client = list_entry(item2, struct i2c_client, list);
629 if (client->driver != driver)
630 continue;
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200631 dev_dbg(&adap->dev, "detaching client [%s] "
632 "at 0x%02x\n", client->name,
633 client->addr);
Jean Delvareb3e82092007-05-01 23:26:32 +0200634 if (driver->detach_client(client)) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200635 dev_err(&adap->dev, "detach_client "
636 "failed for client [%s] at "
637 "0x%02x\n", client->name,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700638 client->addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700639 }
640 }
641 }
642 }
643
David Brownella1d9e6e2007-05-01 23:26:30 +0200644 unregister:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700645 driver_unregister(&driver->driver);
646 list_del(&driver->list);
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100647 pr_debug("i2c-core: driver [%s] unregistered\n", driver->driver.name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700648
Arjan van de Venb3585e42006-01-11 10:50:26 +0100649 mutex_unlock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700650}
David Brownellc0564602007-05-01 23:26:31 +0200651EXPORT_SYMBOL(i2c_del_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700652
David Brownell7b4fbc52007-05-01 23:26:30 +0200653/* ------------------------------------------------------------------------- */
654
Linus Torvalds1da177e2005-04-16 15:20:36 -0700655static int __i2c_check_addr(struct i2c_adapter *adapter, unsigned int addr)
656{
657 struct list_head *item;
658 struct i2c_client *client;
659
660 list_for_each(item,&adapter->clients) {
661 client = list_entry(item, struct i2c_client, list);
662 if (client->addr == addr)
663 return -EBUSY;
664 }
665 return 0;
666}
667
668int i2c_check_addr(struct i2c_adapter *adapter, int addr)
669{
670 int rval;
671
Ingo Molnar5c085d32006-01-18 23:16:04 +0100672 mutex_lock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700673 rval = __i2c_check_addr(adapter, addr);
Ingo Molnar5c085d32006-01-18 23:16:04 +0100674 mutex_unlock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700675
676 return rval;
677}
David Brownellc0564602007-05-01 23:26:31 +0200678EXPORT_SYMBOL(i2c_check_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700679
680int i2c_attach_client(struct i2c_client *client)
681{
682 struct i2c_adapter *adapter = client->adapter;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200683 int res = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700684
Ingo Molnar5c085d32006-01-18 23:16:04 +0100685 mutex_lock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700686 if (__i2c_check_addr(client->adapter, client->addr)) {
Jean Delvareb119c6c2006-08-15 18:26:30 +0200687 res = -EBUSY;
688 goto out_unlock;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700689 }
690 list_add_tail(&client->list,&adapter->clients);
David Brownell438d6c22006-12-10 21:21:31 +0100691
Jean Delvarecde78592005-11-26 21:00:54 +0100692 client->usage_count = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700693
694 client->dev.parent = &client->adapter->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700695 client->dev.bus = &i2c_bus_type;
David Brownell9c1600e2007-05-01 23:26:31 +0200696
697 if (client->driver)
698 client->dev.driver = &client->driver->driver;
699
700 if (client->driver && !is_newstyle_driver(client->driver))
701 client->dev.release = i2c_client_release;
702 else
703 client->dev.release = i2c_client_dev_release;
David Brownell438d6c22006-12-10 21:21:31 +0100704
Linus Torvalds1da177e2005-04-16 15:20:36 -0700705 snprintf(&client->dev.bus_id[0], sizeof(client->dev.bus_id),
706 "%d-%04x", i2c_adapter_id(adapter), client->addr);
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200707 dev_dbg(&adapter->dev, "client [%s] registered with bus id %s\n",
708 client->name, client->dev.bus_id);
Jean Delvareb119c6c2006-08-15 18:26:30 +0200709 res = device_register(&client->dev);
710 if (res)
711 goto out_list;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200712 mutex_unlock(&adapter->clist_lock);
Jean Delvare77ed74d2006-09-30 17:18:59 +0200713
714 if (adapter->client_register) {
715 if (adapter->client_register(client)) {
716 dev_dbg(&adapter->dev, "client_register "
717 "failed for client [%s] at 0x%02x\n",
718 client->name, client->addr);
719 }
720 }
721
722 return 0;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200723
Jean Delvareb119c6c2006-08-15 18:26:30 +0200724out_list:
725 list_del(&client->list);
726 dev_err(&adapter->dev, "Failed to attach i2c client %s at 0x%02x "
727 "(%d)\n", client->name, client->addr, res);
Jean Delvare77ed74d2006-09-30 17:18:59 +0200728out_unlock:
729 mutex_unlock(&adapter->clist_lock);
730 return res;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700731}
David Brownellc0564602007-05-01 23:26:31 +0200732EXPORT_SYMBOL(i2c_attach_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700733
734int i2c_detach_client(struct i2c_client *client)
735{
736 struct i2c_adapter *adapter = client->adapter;
737 int res = 0;
David Brownell438d6c22006-12-10 21:21:31 +0100738
Jean Delvarecde78592005-11-26 21:00:54 +0100739 if (client->usage_count > 0) {
Jean Delvare7bef5592005-07-27 22:14:49 +0200740 dev_warn(&client->dev, "Client [%s] still busy, "
741 "can't detach\n", client->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700742 return -EBUSY;
Jean Delvare7bef5592005-07-27 22:14:49 +0200743 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700744
745 if (adapter->client_unregister) {
746 res = adapter->client_unregister(client);
747 if (res) {
748 dev_err(&client->dev,
Jean Delvare86749e82005-07-29 12:15:29 -0700749 "client_unregister [%s] failed, "
750 "client not detached\n", client->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700751 goto out;
752 }
753 }
754
Ingo Molnar5c085d32006-01-18 23:16:04 +0100755 mutex_lock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700756 list_del(&client->list);
757 init_completion(&client->released);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700758 device_unregister(&client->dev);
Ingo Molnar5c085d32006-01-18 23:16:04 +0100759 mutex_unlock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700760 wait_for_completion(&client->released);
761
762 out:
763 return res;
764}
David Brownellc0564602007-05-01 23:26:31 +0200765EXPORT_SYMBOL(i2c_detach_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700766
767static int i2c_inc_use_client(struct i2c_client *client)
768{
769
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100770 if (!try_module_get(client->driver->driver.owner))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700771 return -ENODEV;
772 if (!try_module_get(client->adapter->owner)) {
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100773 module_put(client->driver->driver.owner);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700774 return -ENODEV;
775 }
776
777 return 0;
778}
779
780static void i2c_dec_use_client(struct i2c_client *client)
781{
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100782 module_put(client->driver->driver.owner);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700783 module_put(client->adapter->owner);
784}
785
786int i2c_use_client(struct i2c_client *client)
787{
788 int ret;
789
790 ret = i2c_inc_use_client(client);
791 if (ret)
792 return ret;
793
Jean Delvarecde78592005-11-26 21:00:54 +0100794 client->usage_count++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700795
796 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700797}
David Brownellc0564602007-05-01 23:26:31 +0200798EXPORT_SYMBOL(i2c_use_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700799
800int i2c_release_client(struct i2c_client *client)
801{
Jean Delvarecde78592005-11-26 21:00:54 +0100802 if (!client->usage_count) {
803 pr_debug("i2c-core: %s used one too many times\n",
804 __FUNCTION__);
805 return -EPERM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700806 }
David Brownell438d6c22006-12-10 21:21:31 +0100807
Jean Delvarecde78592005-11-26 21:00:54 +0100808 client->usage_count--;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700809 i2c_dec_use_client(client);
David Brownell438d6c22006-12-10 21:21:31 +0100810
Linus Torvalds1da177e2005-04-16 15:20:36 -0700811 return 0;
812}
David Brownellc0564602007-05-01 23:26:31 +0200813EXPORT_SYMBOL(i2c_release_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700814
815void i2c_clients_command(struct i2c_adapter *adap, unsigned int cmd, void *arg)
816{
817 struct list_head *item;
818 struct i2c_client *client;
819
Ingo Molnar5c085d32006-01-18 23:16:04 +0100820 mutex_lock(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700821 list_for_each(item,&adap->clients) {
822 client = list_entry(item, struct i2c_client, list);
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100823 if (!try_module_get(client->driver->driver.owner))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700824 continue;
825 if (NULL != client->driver->command) {
Ingo Molnar5c085d32006-01-18 23:16:04 +0100826 mutex_unlock(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700827 client->driver->command(client,cmd,arg);
Ingo Molnar5c085d32006-01-18 23:16:04 +0100828 mutex_lock(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700829 }
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100830 module_put(client->driver->driver.owner);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700831 }
Ingo Molnar5c085d32006-01-18 23:16:04 +0100832 mutex_unlock(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700833}
David Brownellc0564602007-05-01 23:26:31 +0200834EXPORT_SYMBOL(i2c_clients_command);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700835
836static int __init i2c_init(void)
837{
838 int retval;
839
840 retval = bus_register(&i2c_bus_type);
841 if (retval)
842 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700843 return class_register(&i2c_adapter_class);
844}
845
846static void __exit i2c_exit(void)
847{
848 class_unregister(&i2c_adapter_class);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700849 bus_unregister(&i2c_bus_type);
850}
851
852subsys_initcall(i2c_init);
853module_exit(i2c_exit);
854
855/* ----------------------------------------------------
856 * the functional interface to the i2c busses.
857 * ----------------------------------------------------
858 */
859
860int i2c_transfer(struct i2c_adapter * adap, struct i2c_msg *msgs, int num)
861{
862 int ret;
863
864 if (adap->algo->master_xfer) {
865#ifdef DEBUG
866 for (ret = 0; ret < num; ret++) {
867 dev_dbg(&adap->dev, "master_xfer[%d] %c, addr=0x%02x, "
Jean Delvare209d27c2007-05-01 23:26:29 +0200868 "len=%d%s\n", ret, (msgs[ret].flags & I2C_M_RD)
869 ? 'R' : 'W', msgs[ret].addr, msgs[ret].len,
870 (msgs[ret].flags & I2C_M_RECV_LEN) ? "+" : "");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700871 }
872#endif
873
Jiri Kosina6ea23032006-12-10 21:21:30 +0100874 mutex_lock_nested(&adap->bus_lock, adap->level);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700875 ret = adap->algo->master_xfer(adap,msgs,num);
Ingo Molnar5c085d32006-01-18 23:16:04 +0100876 mutex_unlock(&adap->bus_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700877
878 return ret;
879 } else {
880 dev_dbg(&adap->dev, "I2C level transfers not supported\n");
881 return -ENOSYS;
882 }
883}
David Brownellc0564602007-05-01 23:26:31 +0200884EXPORT_SYMBOL(i2c_transfer);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700885
886int i2c_master_send(struct i2c_client *client,const char *buf ,int count)
887{
888 int ret;
889 struct i2c_adapter *adap=client->adapter;
890 struct i2c_msg msg;
891
Jean Delvare815f55f2005-05-07 22:58:46 +0200892 msg.addr = client->addr;
893 msg.flags = client->flags & I2C_M_TEN;
894 msg.len = count;
895 msg.buf = (char *)buf;
David Brownell438d6c22006-12-10 21:21:31 +0100896
Jean Delvare815f55f2005-05-07 22:58:46 +0200897 ret = i2c_transfer(adap, &msg, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700898
Jean Delvare815f55f2005-05-07 22:58:46 +0200899 /* If everything went ok (i.e. 1 msg transmitted), return #bytes
900 transmitted, else error code. */
901 return (ret == 1) ? count : ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700902}
David Brownellc0564602007-05-01 23:26:31 +0200903EXPORT_SYMBOL(i2c_master_send);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700904
905int i2c_master_recv(struct i2c_client *client, char *buf ,int count)
906{
907 struct i2c_adapter *adap=client->adapter;
908 struct i2c_msg msg;
909 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700910
Jean Delvare815f55f2005-05-07 22:58:46 +0200911 msg.addr = client->addr;
912 msg.flags = client->flags & I2C_M_TEN;
913 msg.flags |= I2C_M_RD;
914 msg.len = count;
915 msg.buf = buf;
916
917 ret = i2c_transfer(adap, &msg, 1);
918
919 /* If everything went ok (i.e. 1 msg transmitted), return #bytes
920 transmitted, else error code. */
921 return (ret == 1) ? count : ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700922}
David Brownellc0564602007-05-01 23:26:31 +0200923EXPORT_SYMBOL(i2c_master_recv);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700924
925int i2c_control(struct i2c_client *client,
926 unsigned int cmd, unsigned long arg)
927{
928 int ret = 0;
929 struct i2c_adapter *adap = client->adapter;
930
931 dev_dbg(&client->adapter->dev, "i2c ioctl, cmd: 0x%x, arg: %#lx\n", cmd, arg);
932 switch (cmd) {
933 case I2C_RETRIES:
934 adap->retries = arg;
935 break;
936 case I2C_TIMEOUT:
937 adap->timeout = arg;
938 break;
939 default:
940 if (adap->algo->algo_control!=NULL)
941 ret = adap->algo->algo_control(adap,cmd,arg);
942 }
943 return ret;
944}
David Brownellc0564602007-05-01 23:26:31 +0200945EXPORT_SYMBOL(i2c_control);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700946
947/* ----------------------------------------------------
948 * the i2c address scanning function
949 * Will not work for 10-bit addresses!
950 * ----------------------------------------------------
951 */
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200952static int i2c_probe_address(struct i2c_adapter *adapter, int addr, int kind,
953 int (*found_proc) (struct i2c_adapter *, int, int))
Jean Delvare9fc6adf2005-07-31 21:20:43 +0200954{
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200955 int err;
Jean Delvare9fc6adf2005-07-31 21:20:43 +0200956
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200957 /* Make sure the address is valid */
958 if (addr < 0x03 || addr > 0x77) {
959 dev_warn(&adapter->dev, "Invalid probe address 0x%02x\n",
960 addr);
961 return -EINVAL;
Jean Delvare9fc6adf2005-07-31 21:20:43 +0200962 }
963
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200964 /* Skip if already in use */
965 if (i2c_check_addr(adapter, addr))
966 return 0;
967
968 /* Make sure there is something at this address, unless forced */
Jean Delvare4c9337d2005-08-09 20:28:10 +0200969 if (kind < 0) {
970 if (i2c_smbus_xfer(adapter, addr, 0, 0, 0,
971 I2C_SMBUS_QUICK, NULL) < 0)
972 return 0;
973
974 /* prevent 24RF08 corruption */
975 if ((addr & ~0x0f) == 0x50)
976 i2c_smbus_xfer(adapter, addr, 0, 0, 0,
977 I2C_SMBUS_QUICK, NULL);
978 }
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200979
980 /* Finally call the custom detection function */
981 err = found_proc(adapter, addr, kind);
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200982 /* -ENODEV can be returned if there is a chip at the given address
983 but it isn't supported by this chip driver. We catch it here as
984 this isn't an error. */
Jean Delvare114fd182006-09-03 22:25:04 +0200985 if (err == -ENODEV)
986 err = 0;
987
988 if (err)
989 dev_warn(&adapter->dev, "Client creation failed at 0x%x (%d)\n",
990 addr, err);
991 return err;
Jean Delvare9fc6adf2005-07-31 21:20:43 +0200992}
993
Linus Torvalds1da177e2005-04-16 15:20:36 -0700994int i2c_probe(struct i2c_adapter *adapter,
995 struct i2c_client_address_data *address_data,
996 int (*found_proc) (struct i2c_adapter *, int, int))
997{
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200998 int i, err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700999 int adap_id = i2c_adapter_id(adapter);
1000
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001001 /* Force entries are done first, and are not affected by ignore
1002 entries */
1003 if (address_data->forces) {
1004 unsigned short **forces = address_data->forces;
1005 int kind;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001006
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001007 for (kind = 0; forces[kind]; kind++) {
1008 for (i = 0; forces[kind][i] != I2C_CLIENT_END;
1009 i += 2) {
1010 if (forces[kind][i] == adap_id
1011 || forces[kind][i] == ANY_I2C_BUS) {
1012 dev_dbg(&adapter->dev, "found force "
1013 "parameter for adapter %d, "
1014 "addr 0x%02x, kind %d\n",
1015 adap_id, forces[kind][i + 1],
1016 kind);
1017 err = i2c_probe_address(adapter,
1018 forces[kind][i + 1],
1019 kind, found_proc);
1020 if (err)
1021 return err;
1022 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001023 }
1024 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001025 }
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001026
Jean Delvare4366dc92005-09-25 16:50:06 +02001027 /* Stop here if we can't use SMBUS_QUICK */
1028 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_QUICK)) {
1029 if (address_data->probe[0] == I2C_CLIENT_END
1030 && address_data->normal_i2c[0] == I2C_CLIENT_END)
David Brownell438d6c22006-12-10 21:21:31 +01001031 return 0;
Jean Delvare4366dc92005-09-25 16:50:06 +02001032
1033 dev_warn(&adapter->dev, "SMBus Quick command not supported, "
1034 "can't probe for chips\n");
1035 return -1;
1036 }
1037
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001038 /* Probe entries are done second, and are not affected by ignore
1039 entries either */
1040 for (i = 0; address_data->probe[i] != I2C_CLIENT_END; i += 2) {
1041 if (address_data->probe[i] == adap_id
1042 || address_data->probe[i] == ANY_I2C_BUS) {
1043 dev_dbg(&adapter->dev, "found probe parameter for "
1044 "adapter %d, addr 0x%02x\n", adap_id,
1045 address_data->probe[i + 1]);
1046 err = i2c_probe_address(adapter,
1047 address_data->probe[i + 1],
1048 -1, found_proc);
1049 if (err)
1050 return err;
1051 }
1052 }
1053
1054 /* Normal entries are done last, unless shadowed by an ignore entry */
1055 for (i = 0; address_data->normal_i2c[i] != I2C_CLIENT_END; i += 1) {
1056 int j, ignore;
1057
1058 ignore = 0;
1059 for (j = 0; address_data->ignore[j] != I2C_CLIENT_END;
1060 j += 2) {
1061 if ((address_data->ignore[j] == adap_id ||
1062 address_data->ignore[j] == ANY_I2C_BUS)
1063 && address_data->ignore[j + 1]
1064 == address_data->normal_i2c[i]) {
1065 dev_dbg(&adapter->dev, "found ignore "
1066 "parameter for adapter %d, "
1067 "addr 0x%02x\n", adap_id,
1068 address_data->ignore[j + 1]);
Mark M. Hoffman2369df92006-07-01 17:01:59 +02001069 ignore = 1;
1070 break;
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001071 }
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001072 }
1073 if (ignore)
1074 continue;
1075
1076 dev_dbg(&adapter->dev, "found normal entry for adapter %d, "
1077 "addr 0x%02x\n", adap_id,
1078 address_data->normal_i2c[i]);
1079 err = i2c_probe_address(adapter, address_data->normal_i2c[i],
1080 -1, found_proc);
1081 if (err)
1082 return err;
1083 }
1084
Linus Torvalds1da177e2005-04-16 15:20:36 -07001085 return 0;
1086}
David Brownellc0564602007-05-01 23:26:31 +02001087EXPORT_SYMBOL(i2c_probe);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001088
Jean Delvare12b5053a2007-05-01 23:26:31 +02001089struct i2c_client *
1090i2c_new_probed_device(struct i2c_adapter *adap,
1091 struct i2c_board_info *info,
1092 unsigned short const *addr_list)
1093{
1094 int i;
1095
1096 /* Stop here if the bus doesn't support probing */
1097 if (!i2c_check_functionality(adap, I2C_FUNC_SMBUS_READ_BYTE)) {
1098 dev_err(&adap->dev, "Probing not supported\n");
1099 return NULL;
1100 }
1101
1102 mutex_lock(&adap->clist_lock);
1103 for (i = 0; addr_list[i] != I2C_CLIENT_END; i++) {
1104 /* Check address validity */
1105 if (addr_list[i] < 0x03 || addr_list[i] > 0x77) {
1106 dev_warn(&adap->dev, "Invalid 7-bit address "
1107 "0x%02x\n", addr_list[i]);
1108 continue;
1109 }
1110
1111 /* Check address availability */
1112 if (__i2c_check_addr(adap, addr_list[i])) {
1113 dev_dbg(&adap->dev, "Address 0x%02x already in "
1114 "use, not probing\n", addr_list[i]);
1115 continue;
1116 }
1117
1118 /* Test address responsiveness
1119 The default probe method is a quick write, but it is known
1120 to corrupt the 24RF08 EEPROMs due to a state machine bug,
1121 and could also irreversibly write-protect some EEPROMs, so
1122 for address ranges 0x30-0x37 and 0x50-0x5f, we use a byte
1123 read instead. Also, some bus drivers don't implement
1124 quick write, so we fallback to a byte read it that case
1125 too. */
1126 if ((addr_list[i] & ~0x07) == 0x30
1127 || (addr_list[i] & ~0x0f) == 0x50
1128 || !i2c_check_functionality(adap, I2C_FUNC_SMBUS_QUICK)) {
1129 if (i2c_smbus_xfer(adap, addr_list[i], 0,
1130 I2C_SMBUS_READ, 0,
1131 I2C_SMBUS_BYTE, NULL) >= 0)
1132 break;
1133 } else {
1134 if (i2c_smbus_xfer(adap, addr_list[i], 0,
1135 I2C_SMBUS_WRITE, 0,
1136 I2C_SMBUS_QUICK, NULL) >= 0)
1137 break;
1138 }
1139 }
1140 mutex_unlock(&adap->clist_lock);
1141
1142 if (addr_list[i] == I2C_CLIENT_END) {
1143 dev_dbg(&adap->dev, "Probing failed, no device found\n");
1144 return NULL;
1145 }
1146
1147 info->addr = addr_list[i];
1148 return i2c_new_device(adap, info);
1149}
1150EXPORT_SYMBOL_GPL(i2c_new_probed_device);
1151
Linus Torvalds1da177e2005-04-16 15:20:36 -07001152struct i2c_adapter* i2c_get_adapter(int id)
1153{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001154 struct i2c_adapter *adapter;
David Brownell438d6c22006-12-10 21:21:31 +01001155
Arjan van de Venb3585e42006-01-11 10:50:26 +01001156 mutex_lock(&core_lists);
Mark M. Hoffmana0920e12005-06-28 00:21:30 -04001157 adapter = (struct i2c_adapter *)idr_find(&i2c_adapter_idr, id);
1158 if (adapter && !try_module_get(adapter->owner))
1159 adapter = NULL;
1160
Arjan van de Venb3585e42006-01-11 10:50:26 +01001161 mutex_unlock(&core_lists);
Mark M. Hoffmana0920e12005-06-28 00:21:30 -04001162 return adapter;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001163}
David Brownellc0564602007-05-01 23:26:31 +02001164EXPORT_SYMBOL(i2c_get_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001165
1166void i2c_put_adapter(struct i2c_adapter *adap)
1167{
1168 module_put(adap->owner);
1169}
David Brownellc0564602007-05-01 23:26:31 +02001170EXPORT_SYMBOL(i2c_put_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001171
1172/* The SMBus parts */
1173
David Brownell438d6c22006-12-10 21:21:31 +01001174#define POLY (0x1070U << 3)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001175static u8
1176crc8(u16 data)
1177{
1178 int i;
David Brownell438d6c22006-12-10 21:21:31 +01001179
Linus Torvalds1da177e2005-04-16 15:20:36 -07001180 for(i = 0; i < 8; i++) {
David Brownell438d6c22006-12-10 21:21:31 +01001181 if (data & 0x8000)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001182 data = data ^ POLY;
1183 data = data << 1;
1184 }
1185 return (u8)(data >> 8);
1186}
1187
Jean Delvare421ef472005-10-26 21:28:55 +02001188/* Incremental CRC8 over count bytes in the array pointed to by p */
1189static u8 i2c_smbus_pec(u8 crc, u8 *p, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001190{
1191 int i;
1192
1193 for(i = 0; i < count; i++)
Jean Delvare421ef472005-10-26 21:28:55 +02001194 crc = crc8((crc ^ p[i]) << 8);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001195 return crc;
1196}
1197
Jean Delvare421ef472005-10-26 21:28:55 +02001198/* Assume a 7-bit address, which is reasonable for SMBus */
1199static u8 i2c_smbus_msg_pec(u8 pec, struct i2c_msg *msg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001200{
Jean Delvare421ef472005-10-26 21:28:55 +02001201 /* The address will be sent first */
1202 u8 addr = (msg->addr << 1) | !!(msg->flags & I2C_M_RD);
1203 pec = i2c_smbus_pec(pec, &addr, 1);
1204
1205 /* The data buffer follows */
1206 return i2c_smbus_pec(pec, msg->buf, msg->len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001207}
1208
Jean Delvare421ef472005-10-26 21:28:55 +02001209/* Used for write only transactions */
1210static inline void i2c_smbus_add_pec(struct i2c_msg *msg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001211{
Jean Delvare421ef472005-10-26 21:28:55 +02001212 msg->buf[msg->len] = i2c_smbus_msg_pec(0, msg);
1213 msg->len++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001214}
1215
Jean Delvare421ef472005-10-26 21:28:55 +02001216/* Return <0 on CRC error
1217 If there was a write before this read (most cases) we need to take the
1218 partial CRC from the write part into account.
1219 Note that this function does modify the message (we need to decrease the
1220 message length to hide the CRC byte from the caller). */
1221static int i2c_smbus_check_pec(u8 cpec, struct i2c_msg *msg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001222{
Jean Delvare421ef472005-10-26 21:28:55 +02001223 u8 rpec = msg->buf[--msg->len];
1224 cpec = i2c_smbus_msg_pec(cpec, msg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001225
Linus Torvalds1da177e2005-04-16 15:20:36 -07001226 if (rpec != cpec) {
1227 pr_debug("i2c-core: Bad PEC 0x%02x vs. 0x%02x\n",
1228 rpec, cpec);
1229 return -1;
1230 }
David Brownell438d6c22006-12-10 21:21:31 +01001231 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001232}
1233
1234s32 i2c_smbus_write_quick(struct i2c_client *client, u8 value)
1235{
1236 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
David Brownell438d6c22006-12-10 21:21:31 +01001237 value,0,I2C_SMBUS_QUICK,NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001238}
David Brownellc0564602007-05-01 23:26:31 +02001239EXPORT_SYMBOL(i2c_smbus_write_quick);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001240
1241s32 i2c_smbus_read_byte(struct i2c_client *client)
1242{
1243 union i2c_smbus_data data;
1244 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1245 I2C_SMBUS_READ,0,I2C_SMBUS_BYTE, &data))
1246 return -1;
1247 else
Jean Delvare7eff82c2006-09-03 22:24:00 +02001248 return data.byte;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001249}
David Brownellc0564602007-05-01 23:26:31 +02001250EXPORT_SYMBOL(i2c_smbus_read_byte);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001251
1252s32 i2c_smbus_write_byte(struct i2c_client *client, u8 value)
1253{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001254 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
Jean Delvare421ef472005-10-26 21:28:55 +02001255 I2C_SMBUS_WRITE, value, I2C_SMBUS_BYTE, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001256}
David Brownellc0564602007-05-01 23:26:31 +02001257EXPORT_SYMBOL(i2c_smbus_write_byte);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001258
1259s32 i2c_smbus_read_byte_data(struct i2c_client *client, u8 command)
1260{
1261 union i2c_smbus_data data;
1262 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1263 I2C_SMBUS_READ,command, I2C_SMBUS_BYTE_DATA,&data))
1264 return -1;
1265 else
Jean Delvare7eff82c2006-09-03 22:24:00 +02001266 return data.byte;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001267}
David Brownellc0564602007-05-01 23:26:31 +02001268EXPORT_SYMBOL(i2c_smbus_read_byte_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001269
1270s32 i2c_smbus_write_byte_data(struct i2c_client *client, u8 command, u8 value)
1271{
1272 union i2c_smbus_data data;
1273 data.byte = value;
1274 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1275 I2C_SMBUS_WRITE,command,
1276 I2C_SMBUS_BYTE_DATA,&data);
1277}
David Brownellc0564602007-05-01 23:26:31 +02001278EXPORT_SYMBOL(i2c_smbus_write_byte_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001279
1280s32 i2c_smbus_read_word_data(struct i2c_client *client, u8 command)
1281{
1282 union i2c_smbus_data data;
1283 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1284 I2C_SMBUS_READ,command, I2C_SMBUS_WORD_DATA, &data))
1285 return -1;
1286 else
Jean Delvare7eff82c2006-09-03 22:24:00 +02001287 return data.word;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001288}
David Brownellc0564602007-05-01 23:26:31 +02001289EXPORT_SYMBOL(i2c_smbus_read_word_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001290
1291s32 i2c_smbus_write_word_data(struct i2c_client *client, u8 command, u16 value)
1292{
1293 union i2c_smbus_data data;
1294 data.word = value;
1295 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1296 I2C_SMBUS_WRITE,command,
1297 I2C_SMBUS_WORD_DATA,&data);
1298}
David Brownellc0564602007-05-01 23:26:31 +02001299EXPORT_SYMBOL(i2c_smbus_write_word_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001300
Jean Delvareb86a1bc2007-05-01 23:26:34 +02001301/* Returns the number of read bytes */
1302s32 i2c_smbus_read_block_data(struct i2c_client *client, u8 command,
1303 u8 *values)
1304{
1305 union i2c_smbus_data data;
1306
1307 if (i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1308 I2C_SMBUS_READ, command,
1309 I2C_SMBUS_BLOCK_DATA, &data))
1310 return -1;
1311
1312 memcpy(values, &data.block[1], data.block[0]);
1313 return data.block[0];
1314}
1315EXPORT_SYMBOL(i2c_smbus_read_block_data);
1316
Linus Torvalds1da177e2005-04-16 15:20:36 -07001317s32 i2c_smbus_write_block_data(struct i2c_client *client, u8 command,
Krzysztof Halasa46f5ed72006-06-12 21:42:20 +02001318 u8 length, const u8 *values)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001319{
1320 union i2c_smbus_data data;
Jean Delvare76560322006-01-18 23:14:55 +01001321
Linus Torvalds1da177e2005-04-16 15:20:36 -07001322 if (length > I2C_SMBUS_BLOCK_MAX)
1323 length = I2C_SMBUS_BLOCK_MAX;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001324 data.block[0] = length;
Jean Delvare76560322006-01-18 23:14:55 +01001325 memcpy(&data.block[1], values, length);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001326 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1327 I2C_SMBUS_WRITE,command,
1328 I2C_SMBUS_BLOCK_DATA,&data);
1329}
David Brownellc0564602007-05-01 23:26:31 +02001330EXPORT_SYMBOL(i2c_smbus_write_block_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001331
1332/* Returns the number of read bytes */
1333s32 i2c_smbus_read_i2c_block_data(struct i2c_client *client, u8 command, u8 *values)
1334{
1335 union i2c_smbus_data data;
Jean Delvare76560322006-01-18 23:14:55 +01001336
Linus Torvalds1da177e2005-04-16 15:20:36 -07001337 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1338 I2C_SMBUS_READ,command,
1339 I2C_SMBUS_I2C_BLOCK_DATA,&data))
1340 return -1;
Jean Delvare76560322006-01-18 23:14:55 +01001341
1342 memcpy(values, &data.block[1], data.block[0]);
1343 return data.block[0];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001344}
David Brownellc0564602007-05-01 23:26:31 +02001345EXPORT_SYMBOL(i2c_smbus_read_i2c_block_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001346
Jean Delvare21bbd692006-01-09 15:19:18 +11001347s32 i2c_smbus_write_i2c_block_data(struct i2c_client *client, u8 command,
Krzysztof Halasa46f5ed72006-06-12 21:42:20 +02001348 u8 length, const u8 *values)
Jean Delvare21bbd692006-01-09 15:19:18 +11001349{
1350 union i2c_smbus_data data;
1351
1352 if (length > I2C_SMBUS_BLOCK_MAX)
1353 length = I2C_SMBUS_BLOCK_MAX;
1354 data.block[0] = length;
1355 memcpy(data.block + 1, values, length);
1356 return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1357 I2C_SMBUS_WRITE, command,
1358 I2C_SMBUS_I2C_BLOCK_DATA, &data);
1359}
David Brownellc0564602007-05-01 23:26:31 +02001360EXPORT_SYMBOL(i2c_smbus_write_i2c_block_data);
Jean Delvare21bbd692006-01-09 15:19:18 +11001361
David Brownell438d6c22006-12-10 21:21:31 +01001362/* Simulate a SMBus command using the i2c protocol
Linus Torvalds1da177e2005-04-16 15:20:36 -07001363 No checking of parameters is done! */
David Brownell438d6c22006-12-10 21:21:31 +01001364static s32 i2c_smbus_xfer_emulated(struct i2c_adapter * adapter, u16 addr,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001365 unsigned short flags,
David Brownell438d6c22006-12-10 21:21:31 +01001366 char read_write, u8 command, int size,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001367 union i2c_smbus_data * data)
1368{
1369 /* So we need to generate a series of msgs. In the case of writing, we
1370 need to use only one message; when reading, we need two. We initialize
1371 most things with sane defaults, to keep the code below somewhat
1372 simpler. */
Hideki Iwamoto5c50d182005-09-25 17:01:11 +02001373 unsigned char msgbuf0[I2C_SMBUS_BLOCK_MAX+3];
1374 unsigned char msgbuf1[I2C_SMBUS_BLOCK_MAX+2];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001375 int num = read_write == I2C_SMBUS_READ?2:1;
David Brownell438d6c22006-12-10 21:21:31 +01001376 struct i2c_msg msg[2] = { { addr, flags, 1, msgbuf0 },
Linus Torvalds1da177e2005-04-16 15:20:36 -07001377 { addr, flags | I2C_M_RD, 0, msgbuf1 }
1378 };
1379 int i;
Jean Delvare421ef472005-10-26 21:28:55 +02001380 u8 partial_pec = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001381
1382 msgbuf0[0] = command;
1383 switch(size) {
1384 case I2C_SMBUS_QUICK:
1385 msg[0].len = 0;
1386 /* Special case: The read/write field is used as data */
1387 msg[0].flags = flags | (read_write==I2C_SMBUS_READ)?I2C_M_RD:0;
1388 num = 1;
1389 break;
1390 case I2C_SMBUS_BYTE:
1391 if (read_write == I2C_SMBUS_READ) {
1392 /* Special case: only a read! */
1393 msg[0].flags = I2C_M_RD | flags;
1394 num = 1;
1395 }
1396 break;
1397 case I2C_SMBUS_BYTE_DATA:
1398 if (read_write == I2C_SMBUS_READ)
1399 msg[1].len = 1;
1400 else {
1401 msg[0].len = 2;
1402 msgbuf0[1] = data->byte;
1403 }
1404 break;
1405 case I2C_SMBUS_WORD_DATA:
1406 if (read_write == I2C_SMBUS_READ)
1407 msg[1].len = 2;
1408 else {
1409 msg[0].len=3;
1410 msgbuf0[1] = data->word & 0xff;
Jean Delvare7eff82c2006-09-03 22:24:00 +02001411 msgbuf0[2] = data->word >> 8;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001412 }
1413 break;
1414 case I2C_SMBUS_PROC_CALL:
1415 num = 2; /* Special case */
1416 read_write = I2C_SMBUS_READ;
1417 msg[0].len = 3;
1418 msg[1].len = 2;
1419 msgbuf0[1] = data->word & 0xff;
Jean Delvare7eff82c2006-09-03 22:24:00 +02001420 msgbuf0[2] = data->word >> 8;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001421 break;
1422 case I2C_SMBUS_BLOCK_DATA:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001423 if (read_write == I2C_SMBUS_READ) {
Jean Delvare209d27c2007-05-01 23:26:29 +02001424 msg[1].flags |= I2C_M_RECV_LEN;
1425 msg[1].len = 1; /* block length will be added by
1426 the underlying bus driver */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001427 } else {
1428 msg[0].len = data->block[0] + 2;
1429 if (msg[0].len > I2C_SMBUS_BLOCK_MAX + 2) {
1430 dev_err(&adapter->dev, "smbus_access called with "
1431 "invalid block write size (%d)\n",
1432 data->block[0]);
1433 return -1;
1434 }
Hideki Iwamoto5c50d182005-09-25 17:01:11 +02001435 for (i = 1; i < msg[0].len; i++)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001436 msgbuf0[i] = data->block[i-1];
1437 }
1438 break;
1439 case I2C_SMBUS_BLOCK_PROC_CALL:
Jean Delvare209d27c2007-05-01 23:26:29 +02001440 num = 2; /* Another special case */
1441 read_write = I2C_SMBUS_READ;
1442 if (data->block[0] > I2C_SMBUS_BLOCK_MAX) {
1443 dev_err(&adapter->dev, "%s called with invalid "
1444 "block proc call size (%d)\n", __FUNCTION__,
1445 data->block[0]);
1446 return -1;
1447 }
1448 msg[0].len = data->block[0] + 2;
1449 for (i = 1; i < msg[0].len; i++)
1450 msgbuf0[i] = data->block[i-1];
1451 msg[1].flags |= I2C_M_RECV_LEN;
1452 msg[1].len = 1; /* block length will be added by
1453 the underlying bus driver */
1454 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001455 case I2C_SMBUS_I2C_BLOCK_DATA:
1456 if (read_write == I2C_SMBUS_READ) {
Jean Delvare30dac742005-10-08 00:15:59 +02001457 msg[1].len = I2C_SMBUS_BLOCK_MAX;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001458 } else {
1459 msg[0].len = data->block[0] + 1;
Jean Delvare30dac742005-10-08 00:15:59 +02001460 if (msg[0].len > I2C_SMBUS_BLOCK_MAX + 1) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001461 dev_err(&adapter->dev, "i2c_smbus_xfer_emulated called with "
1462 "invalid block write size (%d)\n",
1463 data->block[0]);
1464 return -1;
1465 }
1466 for (i = 1; i <= data->block[0]; i++)
1467 msgbuf0[i] = data->block[i];
1468 }
1469 break;
1470 default:
1471 dev_err(&adapter->dev, "smbus_access called with invalid size (%d)\n",
1472 size);
1473 return -1;
1474 }
1475
Jean Delvare421ef472005-10-26 21:28:55 +02001476 i = ((flags & I2C_CLIENT_PEC) && size != I2C_SMBUS_QUICK
1477 && size != I2C_SMBUS_I2C_BLOCK_DATA);
1478 if (i) {
1479 /* Compute PEC if first message is a write */
1480 if (!(msg[0].flags & I2C_M_RD)) {
David Brownell438d6c22006-12-10 21:21:31 +01001481 if (num == 1) /* Write only */
Jean Delvare421ef472005-10-26 21:28:55 +02001482 i2c_smbus_add_pec(&msg[0]);
1483 else /* Write followed by read */
1484 partial_pec = i2c_smbus_msg_pec(0, &msg[0]);
1485 }
1486 /* Ask for PEC if last message is a read */
1487 if (msg[num-1].flags & I2C_M_RD)
David Brownell438d6c22006-12-10 21:21:31 +01001488 msg[num-1].len++;
Jean Delvare421ef472005-10-26 21:28:55 +02001489 }
1490
Linus Torvalds1da177e2005-04-16 15:20:36 -07001491 if (i2c_transfer(adapter, msg, num) < 0)
1492 return -1;
1493
Jean Delvare421ef472005-10-26 21:28:55 +02001494 /* Check PEC if last message is a read */
1495 if (i && (msg[num-1].flags & I2C_M_RD)) {
1496 if (i2c_smbus_check_pec(partial_pec, &msg[num-1]) < 0)
1497 return -1;
1498 }
1499
Linus Torvalds1da177e2005-04-16 15:20:36 -07001500 if (read_write == I2C_SMBUS_READ)
1501 switch(size) {
1502 case I2C_SMBUS_BYTE:
1503 data->byte = msgbuf0[0];
1504 break;
1505 case I2C_SMBUS_BYTE_DATA:
1506 data->byte = msgbuf1[0];
1507 break;
David Brownell438d6c22006-12-10 21:21:31 +01001508 case I2C_SMBUS_WORD_DATA:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001509 case I2C_SMBUS_PROC_CALL:
1510 data->word = msgbuf1[0] | (msgbuf1[1] << 8);
1511 break;
1512 case I2C_SMBUS_I2C_BLOCK_DATA:
1513 /* fixed at 32 for now */
Jean Delvare30dac742005-10-08 00:15:59 +02001514 data->block[0] = I2C_SMBUS_BLOCK_MAX;
1515 for (i = 0; i < I2C_SMBUS_BLOCK_MAX; i++)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001516 data->block[i+1] = msgbuf1[i];
1517 break;
Jean Delvare209d27c2007-05-01 23:26:29 +02001518 case I2C_SMBUS_BLOCK_DATA:
1519 case I2C_SMBUS_BLOCK_PROC_CALL:
1520 for (i = 0; i < msgbuf1[0] + 1; i++)
1521 data->block[i] = msgbuf1[i];
1522 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001523 }
1524 return 0;
1525}
1526
1527
1528s32 i2c_smbus_xfer(struct i2c_adapter * adapter, u16 addr, unsigned short flags,
David Brownell438d6c22006-12-10 21:21:31 +01001529 char read_write, u8 command, int size,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001530 union i2c_smbus_data * data)
1531{
1532 s32 res;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001533
1534 flags &= I2C_M_TEN | I2C_CLIENT_PEC;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001535
1536 if (adapter->algo->smbus_xfer) {
Ingo Molnar5c085d32006-01-18 23:16:04 +01001537 mutex_lock(&adapter->bus_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001538 res = adapter->algo->smbus_xfer(adapter,addr,flags,read_write,
1539 command,size,data);
Ingo Molnar5c085d32006-01-18 23:16:04 +01001540 mutex_unlock(&adapter->bus_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001541 } else
1542 res = i2c_smbus_xfer_emulated(adapter,addr,flags,read_write,
1543 command,size,data);
1544
Linus Torvalds1da177e2005-04-16 15:20:36 -07001545 return res;
1546}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001547EXPORT_SYMBOL(i2c_smbus_xfer);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001548
1549MODULE_AUTHOR("Simon G. Vogl <simon@tk.uni-linz.ac.at>");
1550MODULE_DESCRIPTION("I2C-Bus main module");
1551MODULE_LICENSE("GPL");