blob: 06b4b9e1a23eb43a088b8dbf876f9253b755a31f [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) */
Kay Sievers7eff2e72007-08-14 15:15:12 +020070static int i2c_device_uevent(struct device *dev, struct kobj_uevent_env *env)
David Brownell7b4fbc52007-05-01 23:26:30 +020071{
72 struct i2c_client *client = to_i2c_client(dev);
David Brownell7b4fbc52007-05-01 23:26:30 +020073
74 /* by definition, legacy drivers can't hotplug */
75 if (dev->driver || !client->driver_name)
76 return 0;
77
Kay Sievers7eff2e72007-08-14 15:15:12 +020078 if (add_uevent_var(env, "MODALIAS=%s", client->driver_name))
David Brownell7b4fbc52007-05-01 23:26:30 +020079 return -ENOMEM;
David Brownell7b4fbc52007-05-01 23:26:30 +020080 dev_dbg(dev, "uevent\n");
81 return 0;
82}
83
84#else
85#define i2c_device_uevent NULL
86#endif /* CONFIG_HOTPLUG */
87
Linus Torvalds1da177e2005-04-16 15:20:36 -070088static int i2c_device_probe(struct device *dev)
89{
David Brownell7b4fbc52007-05-01 23:26:30 +020090 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);
Linus Torvalds1da177e2005-04-16 15:20:36 -070098}
99
100static int i2c_device_remove(struct device *dev)
101{
David Brownella1d9e6e2007-05-01 23:26:30 +0200102 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;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700120}
121
David Brownellf37dd802007-02-13 22:09:00 +0100122static void i2c_device_shutdown(struct device *dev)
123{
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));
131}
132
133static int i2c_device_suspend(struct device * dev, pm_message_t mesg)
134{
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);
143}
144
145static int i2c_device_resume(struct device * dev)
146{
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));
155}
156
David Brownell7b4fbc52007-05-01 23:26:30 +0200157static void i2c_client_release(struct device *dev)
158{
159 struct i2c_client *client = to_i2c_client(dev);
160 complete(&client->released);
161}
162
David Brownell9c1600e2007-05-01 23:26:31 +0200163static void i2c_client_dev_release(struct device *dev)
164{
165 kfree(to_i2c_client(dev));
166}
167
David Brownell7b4fbc52007-05-01 23:26:30 +0200168static 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
Russell Kingb864c7d2006-01-05 14:37:50 +0000189struct bus_type i2c_bus_type = {
David Brownellf37dd802007-02-13 22:09:00 +0100190 .name = "i2c",
David Brownell7b4fbc52007-05-01 23:26:30 +0200191 .dev_attrs = i2c_dev_attrs,
David Brownellf37dd802007-02-13 22:09:00 +0100192 .match = i2c_device_match,
David Brownell7b4fbc52007-05-01 23:26:30 +0200193 .uevent = i2c_device_uevent,
David Brownellf37dd802007-02-13 22:09:00 +0100194 .probe = i2c_device_probe,
195 .remove = i2c_device_remove,
196 .shutdown = i2c_device_shutdown,
197 .suspend = i2c_device_suspend,
198 .resume = i2c_device_resume,
Russell Kingb864c7d2006-01-05 14:37:50 +0000199};
David Brownellc0564602007-05-01 23:26:31 +0200200EXPORT_SYMBOL_GPL(i2c_bus_type);
Russell Kingb864c7d2006-01-05 14:37:50 +0000201
David Brownell9c1600e2007-05-01 23:26:31 +0200202/**
203 * i2c_new_device - instantiate an i2c device for use with a new style driver
204 * @adap: the adapter managing the device
205 * @info: describes one I2C device; bus_num is ignored
David Brownelld64f73b2007-07-12 14:12:28 +0200206 * Context: can sleep
David Brownell9c1600e2007-05-01 23:26:31 +0200207 *
208 * Create a device to work with a new style i2c driver, where binding is
209 * handled through driver model probe()/remove() methods. This call is not
210 * appropriate for use by mainboad initialization logic, which usually runs
211 * during an arch_initcall() long before any i2c_adapter could exist.
212 *
213 * This returns the new i2c client, which may be saved for later use with
214 * i2c_unregister_device(); or NULL to indicate an error.
215 */
216struct i2c_client *
217i2c_new_device(struct i2c_adapter *adap, struct i2c_board_info const *info)
218{
219 struct i2c_client *client;
220 int status;
221
222 client = kzalloc(sizeof *client, GFP_KERNEL);
223 if (!client)
224 return NULL;
225
226 client->adapter = adap;
227
228 client->dev.platform_data = info->platform_data;
David Brownell3bbb8352007-10-13 23:56:29 +0200229 device_init_wakeup(&client->dev, info->flags & I2C_CLIENT_WAKE);
230
231 client->flags = info->flags & ~I2C_CLIENT_WAKE;
David Brownell9c1600e2007-05-01 23:26:31 +0200232 client->addr = info->addr;
233 client->irq = info->irq;
234
235 strlcpy(client->driver_name, info->driver_name,
236 sizeof(client->driver_name));
237 strlcpy(client->name, info->type, sizeof(client->name));
238
239 /* a new style driver may be bound to this device when we
240 * return from this function, or any later moment (e.g. maybe
241 * hotplugging will load the driver module). and the device
242 * refcount model is the standard driver model one.
243 */
244 status = i2c_attach_client(client);
245 if (status < 0) {
246 kfree(client);
247 client = NULL;
248 }
249 return client;
250}
251EXPORT_SYMBOL_GPL(i2c_new_device);
252
253
254/**
255 * i2c_unregister_device - reverse effect of i2c_new_device()
256 * @client: value returned from i2c_new_device()
David Brownelld64f73b2007-07-12 14:12:28 +0200257 * Context: can sleep
David Brownell9c1600e2007-05-01 23:26:31 +0200258 */
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}
289
David Brownell16ffadf2007-05-01 23:26:28 +0200290static ssize_t
291show_adapter_name(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700292{
David Brownellef2c83212007-05-01 23:26:28 +0200293 struct i2c_adapter *adap = to_i2c_adapter(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700294 return sprintf(buf, "%s\n", adap->name);
295}
David Brownell16ffadf2007-05-01 23:26:28 +0200296
297static struct device_attribute i2c_adapter_attrs[] = {
298 __ATTR(name, S_IRUGO, show_adapter_name, NULL),
299 { },
300};
301
302struct class i2c_adapter_class = {
303 .owner = THIS_MODULE,
304 .name = "i2c-adapter",
305 .dev_attrs = i2c_adapter_attrs,
306};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700307
David Brownell9c1600e2007-05-01 23:26:31 +0200308static void i2c_scan_static_board_info(struct i2c_adapter *adapter)
309{
310 struct i2c_devinfo *devinfo;
311
312 mutex_lock(&__i2c_board_lock);
313 list_for_each_entry(devinfo, &__i2c_board_list, list) {
314 if (devinfo->busnum == adapter->nr
315 && !i2c_new_device(adapter,
316 &devinfo->board_info))
317 printk(KERN_ERR "i2c-core: can't create i2c%d-%04x\n",
318 i2c_adapter_id(adapter),
319 devinfo->board_info.addr);
320 }
321 mutex_unlock(&__i2c_board_lock);
322}
323
David Brownell6e13e642007-05-01 23:26:31 +0200324static int i2c_register_adapter(struct i2c_adapter *adap)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700325{
David Brownell6e13e642007-05-01 23:26:31 +0200326 int res = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700327 struct list_head *item;
328 struct i2c_driver *driver;
329
Ingo Molnar5c085d32006-01-18 23:16:04 +0100330 mutex_init(&adap->bus_lock);
331 mutex_init(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700332 INIT_LIST_HEAD(&adap->clients);
333
David Brownell6e13e642007-05-01 23:26:31 +0200334 mutex_lock(&core_lists);
335 list_add_tail(&adap->list, &adapters);
336
Linus Torvalds1da177e2005-04-16 15:20:36 -0700337 /* Add the adapter to the driver core.
338 * If the parent pointer is not set up,
339 * we add this adapter to the host bus.
340 */
David Brownellb119dc32007-01-04 13:07:04 +0100341 if (adap->dev.parent == NULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700342 adap->dev.parent = &platform_bus;
Jean Delvarefe2c8d52007-02-13 22:09:04 +0100343 pr_debug("I2C adapter driver [%s] forgot to specify "
344 "physical device\n", adap->name);
David Brownellb119dc32007-01-04 13:07:04 +0100345 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700346 sprintf(adap->dev.bus_id, "i2c-%d", adap->nr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700347 adap->dev.release = &i2c_adapter_dev_release;
Jean Delvarefccb56e2007-05-01 23:26:27 +0200348 adap->dev.class = &i2c_adapter_class;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200349 res = device_register(&adap->dev);
350 if (res)
351 goto out_list;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700352
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200353 dev_dbg(&adap->dev, "adapter [%s] registered\n", adap->name);
354
David Brownell6e13e642007-05-01 23:26:31 +0200355 /* create pre-declared device nodes for new-style drivers */
356 if (adap->nr < __i2c_first_dynamic_bus_num)
357 i2c_scan_static_board_info(adap);
358
David Brownell7b4fbc52007-05-01 23:26:30 +0200359 /* let legacy drivers scan this bus for matching devices */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700360 list_for_each(item,&drivers) {
361 driver = list_entry(item, struct i2c_driver, list);
Jean Delvare8a994752005-11-26 20:28:06 +0100362 if (driver->attach_adapter)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363 /* We ignore the return code; if it fails, too bad */
364 driver->attach_adapter(adap);
365 }
366
Linus Torvalds1da177e2005-04-16 15:20:36 -0700367out_unlock:
Arjan van de Venb3585e42006-01-11 10:50:26 +0100368 mutex_unlock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700369 return res;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200370
Jean Delvareb119c6c2006-08-15 18:26:30 +0200371out_list:
372 list_del(&adap->list);
373 idr_remove(&i2c_adapter_idr, adap->nr);
374 goto out_unlock;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700375}
376
David Brownell6e13e642007-05-01 23:26:31 +0200377/**
378 * i2c_add_adapter - declare i2c adapter, use dynamic bus number
379 * @adapter: the adapter to add
David Brownelld64f73b2007-07-12 14:12:28 +0200380 * Context: can sleep
David Brownell6e13e642007-05-01 23:26:31 +0200381 *
382 * This routine is used to declare an I2C adapter when its bus number
383 * doesn't matter. Examples: for I2C adapters dynamically added by
384 * USB links or PCI plugin cards.
385 *
386 * When this returns zero, a new bus number was allocated and stored
387 * in adap->nr, and the specified adapter became available for clients.
388 * Otherwise, a negative errno value is returned.
389 */
390int i2c_add_adapter(struct i2c_adapter *adapter)
391{
392 int id, res = 0;
393
394retry:
395 if (idr_pre_get(&i2c_adapter_idr, GFP_KERNEL) == 0)
396 return -ENOMEM;
397
398 mutex_lock(&core_lists);
399 /* "above" here means "above or equal to", sigh */
400 res = idr_get_new_above(&i2c_adapter_idr, adapter,
401 __i2c_first_dynamic_bus_num, &id);
402 mutex_unlock(&core_lists);
403
404 if (res < 0) {
405 if (res == -EAGAIN)
406 goto retry;
407 return res;
408 }
409
410 adapter->nr = id;
411 return i2c_register_adapter(adapter);
412}
413EXPORT_SYMBOL(i2c_add_adapter);
414
415/**
416 * i2c_add_numbered_adapter - declare i2c adapter, use static bus number
417 * @adap: the adapter to register (with adap->nr initialized)
David Brownelld64f73b2007-07-12 14:12:28 +0200418 * Context: can sleep
David Brownell6e13e642007-05-01 23:26:31 +0200419 *
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
David Brownelld64f73b2007-07-12 14:12:28 +0200466/**
467 * i2c_del_adapter - unregister I2C adapter
468 * @adap: the adapter being unregistered
469 * Context: can sleep
470 *
471 * This unregisters an I2C adapter which was previously registered
472 * by @i2c_add_adapter or @i2c_add_numbered_adapter.
473 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700474int i2c_del_adapter(struct i2c_adapter *adap)
475{
476 struct list_head *item, *_n;
477 struct i2c_adapter *adap_from_list;
478 struct i2c_driver *driver;
479 struct i2c_client *client;
480 int res = 0;
481
Arjan van de Venb3585e42006-01-11 10:50:26 +0100482 mutex_lock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700483
484 /* First make sure that this adapter was ever added */
485 list_for_each_entry(adap_from_list, &adapters, list) {
486 if (adap_from_list == adap)
487 break;
488 }
489 if (adap_from_list != adap) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200490 pr_debug("i2c-core: attempting to delete unregistered "
491 "adapter [%s]\n", adap->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700492 res = -EINVAL;
493 goto out_unlock;
494 }
495
496 list_for_each(item,&drivers) {
497 driver = list_entry(item, struct i2c_driver, list);
498 if (driver->detach_adapter)
499 if ((res = driver->detach_adapter(adap))) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200500 dev_err(&adap->dev, "detach_adapter failed "
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100501 "for driver [%s]\n",
502 driver->driver.name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700503 goto out_unlock;
504 }
505 }
506
507 /* detach any active clients. This must be done first, because
Tobias Klausera551acc2005-05-19 21:40:38 +0200508 * it can fail; in which case we give up. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700509 list_for_each_safe(item, _n, &adap->clients) {
David Brownella1d9e6e2007-05-01 23:26:30 +0200510 struct i2c_driver *driver;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700511
David Brownella1d9e6e2007-05-01 23:26:30 +0200512 client = list_entry(item, struct i2c_client, list);
513 driver = client->driver;
514
515 /* new style, follow standard driver model */
516 if (!driver || is_newstyle_driver(driver)) {
517 i2c_unregister_device(client);
518 continue;
519 }
520
521 /* legacy drivers create and remove clients themselves */
522 if ((res = driver->detach_client(client))) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200523 dev_err(&adap->dev, "detach_client failed for client "
524 "[%s] at address 0x%02x\n", client->name,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700525 client->addr);
526 goto out_unlock;
527 }
528 }
529
530 /* clean up the sysfs representation */
531 init_completion(&adap->dev_released);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700532 device_unregister(&adap->dev);
533 list_del(&adap->list);
534
535 /* wait for sysfs to drop all references */
536 wait_for_completion(&adap->dev_released);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700537
David Brownell6e13e642007-05-01 23:26:31 +0200538 /* free bus id */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700539 idr_remove(&i2c_adapter_idr, adap->nr);
540
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200541 dev_dbg(&adap->dev, "adapter [%s] unregistered\n", adap->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700542
543 out_unlock:
Arjan van de Venb3585e42006-01-11 10:50:26 +0100544 mutex_unlock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700545 return res;
546}
David Brownellc0564602007-05-01 23:26:31 +0200547EXPORT_SYMBOL(i2c_del_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700548
549
David Brownell7b4fbc52007-05-01 23:26:30 +0200550/* ------------------------------------------------------------------------- */
551
552/*
553 * An i2c_driver is used with one or more i2c_client (device) nodes to access
554 * i2c slave chips, on a bus instance associated with some i2c_adapter. There
555 * are two models for binding the driver to its device: "new style" drivers
556 * follow the standard Linux driver model and just respond to probe() calls
557 * issued if the driver core sees they match(); "legacy" drivers create device
558 * nodes themselves.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700559 */
560
Greg Kroah-Hartmande59cf92005-12-06 15:33:15 -0800561int i2c_register_driver(struct module *owner, struct i2c_driver *driver)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700562{
Jean Delvare7eebcb72006-02-05 23:28:21 +0100563 int res;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700564
David Brownell7b4fbc52007-05-01 23:26:30 +0200565 /* new style driver methods can't mix with legacy ones */
David Brownella1d9e6e2007-05-01 23:26:30 +0200566 if (is_newstyle_driver(driver)) {
David Brownell7b4fbc52007-05-01 23:26:30 +0200567 if (driver->attach_adapter || driver->detach_adapter
568 || driver->detach_client) {
569 printk(KERN_WARNING
570 "i2c-core: driver [%s] is confused\n",
571 driver->driver.name);
572 return -EINVAL;
573 }
574 }
575
Linus Torvalds1da177e2005-04-16 15:20:36 -0700576 /* add the driver to the list of i2c drivers in the driver core */
Greg Kroah-Hartmande59cf92005-12-06 15:33:15 -0800577 driver->driver.owner = owner;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700578 driver->driver.bus = &i2c_bus_type;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700579
David Brownell6e13e642007-05-01 23:26:31 +0200580 /* for new style drivers, when registration returns the driver core
581 * will have called probe() for all matching-but-unbound devices.
582 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700583 res = driver_register(&driver->driver);
584 if (res)
Jean Delvare7eebcb72006-02-05 23:28:21 +0100585 return res;
David Brownell438d6c22006-12-10 21:21:31 +0100586
Jean Delvare7eebcb72006-02-05 23:28:21 +0100587 mutex_lock(&core_lists);
588
Linus Torvalds1da177e2005-04-16 15:20:36 -0700589 list_add_tail(&driver->list,&drivers);
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100590 pr_debug("i2c-core: driver [%s] registered\n", driver->driver.name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700591
David Brownell7b4fbc52007-05-01 23:26:30 +0200592 /* legacy drivers scan i2c busses directly */
Jean Delvare8a994752005-11-26 20:28:06 +0100593 if (driver->attach_adapter) {
David Brownell4ad4eac2007-05-01 23:26:28 +0200594 struct i2c_adapter *adapter;
595
596 list_for_each_entry(adapter, &adapters, list) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700597 driver->attach_adapter(adapter);
598 }
599 }
600
Arjan van de Venb3585e42006-01-11 10:50:26 +0100601 mutex_unlock(&core_lists);
Jean Delvare7eebcb72006-02-05 23:28:21 +0100602 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700603}
Greg Kroah-Hartmande59cf92005-12-06 15:33:15 -0800604EXPORT_SYMBOL(i2c_register_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700605
David Brownella1d9e6e2007-05-01 23:26:30 +0200606/**
607 * i2c_del_driver - unregister I2C driver
608 * @driver: the driver being unregistered
David Brownelld64f73b2007-07-12 14:12:28 +0200609 * Context: can sleep
David Brownella1d9e6e2007-05-01 23:26:30 +0200610 */
Jean Delvareb3e82092007-05-01 23:26:32 +0200611void i2c_del_driver(struct i2c_driver *driver)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700612{
613 struct list_head *item1, *item2, *_n;
614 struct i2c_client *client;
615 struct i2c_adapter *adap;
David Brownell438d6c22006-12-10 21:21:31 +0100616
Arjan van de Venb3585e42006-01-11 10:50:26 +0100617 mutex_lock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700618
David Brownella1d9e6e2007-05-01 23:26:30 +0200619 /* new-style driver? */
620 if (is_newstyle_driver(driver))
621 goto unregister;
622
Linus Torvalds1da177e2005-04-16 15:20:36 -0700623 /* Have a look at each adapter, if clients of this driver are still
David Brownell438d6c22006-12-10 21:21:31 +0100624 * attached. If so, detach them to be able to kill the driver
Linus Torvalds1da177e2005-04-16 15:20:36 -0700625 * afterwards.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700626 */
627 list_for_each(item1,&adapters) {
628 adap = list_entry(item1, struct i2c_adapter, list);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700629 if (driver->detach_adapter) {
Jean Delvareb3e82092007-05-01 23:26:32 +0200630 if (driver->detach_adapter(adap)) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200631 dev_err(&adap->dev, "detach_adapter failed "
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100632 "for driver [%s]\n",
633 driver->driver.name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700634 }
635 } else {
636 list_for_each_safe(item2, _n, &adap->clients) {
637 client = list_entry(item2, struct i2c_client, list);
638 if (client->driver != driver)
639 continue;
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200640 dev_dbg(&adap->dev, "detaching client [%s] "
641 "at 0x%02x\n", client->name,
642 client->addr);
Jean Delvareb3e82092007-05-01 23:26:32 +0200643 if (driver->detach_client(client)) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200644 dev_err(&adap->dev, "detach_client "
645 "failed for client [%s] at "
646 "0x%02x\n", client->name,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700647 client->addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700648 }
649 }
650 }
651 }
652
David Brownella1d9e6e2007-05-01 23:26:30 +0200653 unregister:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700654 driver_unregister(&driver->driver);
655 list_del(&driver->list);
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100656 pr_debug("i2c-core: driver [%s] unregistered\n", driver->driver.name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700657
Arjan van de Venb3585e42006-01-11 10:50:26 +0100658 mutex_unlock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700659}
David Brownellc0564602007-05-01 23:26:31 +0200660EXPORT_SYMBOL(i2c_del_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700661
David Brownell7b4fbc52007-05-01 23:26:30 +0200662/* ------------------------------------------------------------------------- */
663
Linus Torvalds1da177e2005-04-16 15:20:36 -0700664static int __i2c_check_addr(struct i2c_adapter *adapter, unsigned int addr)
665{
666 struct list_head *item;
667 struct i2c_client *client;
668
669 list_for_each(item,&adapter->clients) {
670 client = list_entry(item, struct i2c_client, list);
671 if (client->addr == addr)
672 return -EBUSY;
673 }
674 return 0;
675}
676
677int i2c_check_addr(struct i2c_adapter *adapter, int addr)
678{
679 int rval;
680
Ingo Molnar5c085d32006-01-18 23:16:04 +0100681 mutex_lock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700682 rval = __i2c_check_addr(adapter, addr);
Ingo Molnar5c085d32006-01-18 23:16:04 +0100683 mutex_unlock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700684
685 return rval;
686}
David Brownellc0564602007-05-01 23:26:31 +0200687EXPORT_SYMBOL(i2c_check_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700688
689int i2c_attach_client(struct i2c_client *client)
690{
691 struct i2c_adapter *adapter = client->adapter;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200692 int res = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700693
Ingo Molnar5c085d32006-01-18 23:16:04 +0100694 mutex_lock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700695 if (__i2c_check_addr(client->adapter, client->addr)) {
Jean Delvareb119c6c2006-08-15 18:26:30 +0200696 res = -EBUSY;
697 goto out_unlock;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700698 }
699 list_add_tail(&client->list,&adapter->clients);
David Brownell438d6c22006-12-10 21:21:31 +0100700
Jean Delvarecde78592005-11-26 21:00:54 +0100701 client->usage_count = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702
703 client->dev.parent = &client->adapter->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700704 client->dev.bus = &i2c_bus_type;
David Brownell9c1600e2007-05-01 23:26:31 +0200705
706 if (client->driver)
707 client->dev.driver = &client->driver->driver;
708
David Brownellde81d2a2007-05-22 19:49:16 +0200709 if (client->driver && !is_newstyle_driver(client->driver)) {
David Brownell9c1600e2007-05-01 23:26:31 +0200710 client->dev.release = i2c_client_release;
David Brownellde81d2a2007-05-22 19:49:16 +0200711 client->dev.uevent_suppress = 1;
712 } else
David Brownell9c1600e2007-05-01 23:26:31 +0200713 client->dev.release = i2c_client_dev_release;
David Brownell438d6c22006-12-10 21:21:31 +0100714
Linus Torvalds1da177e2005-04-16 15:20:36 -0700715 snprintf(&client->dev.bus_id[0], sizeof(client->dev.bus_id),
716 "%d-%04x", i2c_adapter_id(adapter), client->addr);
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200717 dev_dbg(&adapter->dev, "client [%s] registered with bus id %s\n",
718 client->name, client->dev.bus_id);
Jean Delvareb119c6c2006-08-15 18:26:30 +0200719 res = device_register(&client->dev);
720 if (res)
721 goto out_list;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200722 mutex_unlock(&adapter->clist_lock);
Jean Delvare77ed74d2006-09-30 17:18:59 +0200723
724 if (adapter->client_register) {
725 if (adapter->client_register(client)) {
726 dev_dbg(&adapter->dev, "client_register "
727 "failed for client [%s] at 0x%02x\n",
728 client->name, client->addr);
729 }
730 }
731
732 return 0;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200733
Jean Delvareb119c6c2006-08-15 18:26:30 +0200734out_list:
735 list_del(&client->list);
736 dev_err(&adapter->dev, "Failed to attach i2c client %s at 0x%02x "
737 "(%d)\n", client->name, client->addr, res);
Jean Delvare77ed74d2006-09-30 17:18:59 +0200738out_unlock:
739 mutex_unlock(&adapter->clist_lock);
740 return res;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700741}
David Brownellc0564602007-05-01 23:26:31 +0200742EXPORT_SYMBOL(i2c_attach_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700743
744int i2c_detach_client(struct i2c_client *client)
745{
746 struct i2c_adapter *adapter = client->adapter;
747 int res = 0;
David Brownell438d6c22006-12-10 21:21:31 +0100748
Jean Delvarecde78592005-11-26 21:00:54 +0100749 if (client->usage_count > 0) {
Jean Delvare7bef5592005-07-27 22:14:49 +0200750 dev_warn(&client->dev, "Client [%s] still busy, "
751 "can't detach\n", client->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700752 return -EBUSY;
Jean Delvare7bef5592005-07-27 22:14:49 +0200753 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700754
755 if (adapter->client_unregister) {
756 res = adapter->client_unregister(client);
757 if (res) {
758 dev_err(&client->dev,
Jean Delvare86749e82005-07-29 12:15:29 -0700759 "client_unregister [%s] failed, "
760 "client not detached\n", client->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700761 goto out;
762 }
763 }
764
Ingo Molnar5c085d32006-01-18 23:16:04 +0100765 mutex_lock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700766 list_del(&client->list);
767 init_completion(&client->released);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700768 device_unregister(&client->dev);
Ingo Molnar5c085d32006-01-18 23:16:04 +0100769 mutex_unlock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700770 wait_for_completion(&client->released);
771
772 out:
773 return res;
774}
David Brownellc0564602007-05-01 23:26:31 +0200775EXPORT_SYMBOL(i2c_detach_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700776
777static int i2c_inc_use_client(struct i2c_client *client)
778{
779
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100780 if (!try_module_get(client->driver->driver.owner))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700781 return -ENODEV;
782 if (!try_module_get(client->adapter->owner)) {
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100783 module_put(client->driver->driver.owner);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700784 return -ENODEV;
785 }
786
787 return 0;
788}
789
790static void i2c_dec_use_client(struct i2c_client *client)
791{
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100792 module_put(client->driver->driver.owner);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700793 module_put(client->adapter->owner);
794}
795
796int i2c_use_client(struct i2c_client *client)
797{
798 int ret;
799
800 ret = i2c_inc_use_client(client);
801 if (ret)
802 return ret;
803
Jean Delvarecde78592005-11-26 21:00:54 +0100804 client->usage_count++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700805
806 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700807}
David Brownellc0564602007-05-01 23:26:31 +0200808EXPORT_SYMBOL(i2c_use_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700809
810int i2c_release_client(struct i2c_client *client)
811{
Jean Delvarecde78592005-11-26 21:00:54 +0100812 if (!client->usage_count) {
813 pr_debug("i2c-core: %s used one too many times\n",
814 __FUNCTION__);
815 return -EPERM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700816 }
David Brownell438d6c22006-12-10 21:21:31 +0100817
Jean Delvarecde78592005-11-26 21:00:54 +0100818 client->usage_count--;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700819 i2c_dec_use_client(client);
David Brownell438d6c22006-12-10 21:21:31 +0100820
Linus Torvalds1da177e2005-04-16 15:20:36 -0700821 return 0;
822}
David Brownellc0564602007-05-01 23:26:31 +0200823EXPORT_SYMBOL(i2c_release_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700824
825void i2c_clients_command(struct i2c_adapter *adap, unsigned int cmd, void *arg)
826{
827 struct list_head *item;
828 struct i2c_client *client;
829
Ingo Molnar5c085d32006-01-18 23:16:04 +0100830 mutex_lock(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700831 list_for_each(item,&adap->clients) {
832 client = list_entry(item, struct i2c_client, list);
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100833 if (!try_module_get(client->driver->driver.owner))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700834 continue;
835 if (NULL != client->driver->command) {
Ingo Molnar5c085d32006-01-18 23:16:04 +0100836 mutex_unlock(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700837 client->driver->command(client,cmd,arg);
Ingo Molnar5c085d32006-01-18 23:16:04 +0100838 mutex_lock(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700839 }
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100840 module_put(client->driver->driver.owner);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700841 }
Ingo Molnar5c085d32006-01-18 23:16:04 +0100842 mutex_unlock(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700843}
David Brownellc0564602007-05-01 23:26:31 +0200844EXPORT_SYMBOL(i2c_clients_command);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700845
846static int __init i2c_init(void)
847{
848 int retval;
849
850 retval = bus_register(&i2c_bus_type);
851 if (retval)
852 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700853 return class_register(&i2c_adapter_class);
854}
855
856static void __exit i2c_exit(void)
857{
858 class_unregister(&i2c_adapter_class);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700859 bus_unregister(&i2c_bus_type);
860}
861
862subsys_initcall(i2c_init);
863module_exit(i2c_exit);
864
865/* ----------------------------------------------------
866 * the functional interface to the i2c busses.
867 * ----------------------------------------------------
868 */
869
870int i2c_transfer(struct i2c_adapter * adap, struct i2c_msg *msgs, int num)
871{
872 int ret;
873
874 if (adap->algo->master_xfer) {
875#ifdef DEBUG
876 for (ret = 0; ret < num; ret++) {
877 dev_dbg(&adap->dev, "master_xfer[%d] %c, addr=0x%02x, "
Jean Delvare209d27c2007-05-01 23:26:29 +0200878 "len=%d%s\n", ret, (msgs[ret].flags & I2C_M_RD)
879 ? 'R' : 'W', msgs[ret].addr, msgs[ret].len,
880 (msgs[ret].flags & I2C_M_RECV_LEN) ? "+" : "");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700881 }
882#endif
883
Jiri Kosina6ea23032006-12-10 21:21:30 +0100884 mutex_lock_nested(&adap->bus_lock, adap->level);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700885 ret = adap->algo->master_xfer(adap,msgs,num);
Ingo Molnar5c085d32006-01-18 23:16:04 +0100886 mutex_unlock(&adap->bus_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700887
888 return ret;
889 } else {
890 dev_dbg(&adap->dev, "I2C level transfers not supported\n");
891 return -ENOSYS;
892 }
893}
David Brownellc0564602007-05-01 23:26:31 +0200894EXPORT_SYMBOL(i2c_transfer);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700895
896int i2c_master_send(struct i2c_client *client,const char *buf ,int count)
897{
898 int ret;
899 struct i2c_adapter *adap=client->adapter;
900 struct i2c_msg msg;
901
Jean Delvare815f55f2005-05-07 22:58:46 +0200902 msg.addr = client->addr;
903 msg.flags = client->flags & I2C_M_TEN;
904 msg.len = count;
905 msg.buf = (char *)buf;
David Brownell438d6c22006-12-10 21:21:31 +0100906
Jean Delvare815f55f2005-05-07 22:58:46 +0200907 ret = i2c_transfer(adap, &msg, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700908
Jean Delvare815f55f2005-05-07 22:58:46 +0200909 /* If everything went ok (i.e. 1 msg transmitted), return #bytes
910 transmitted, else error code. */
911 return (ret == 1) ? count : ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700912}
David Brownellc0564602007-05-01 23:26:31 +0200913EXPORT_SYMBOL(i2c_master_send);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700914
915int i2c_master_recv(struct i2c_client *client, char *buf ,int count)
916{
917 struct i2c_adapter *adap=client->adapter;
918 struct i2c_msg msg;
919 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700920
Jean Delvare815f55f2005-05-07 22:58:46 +0200921 msg.addr = client->addr;
922 msg.flags = client->flags & I2C_M_TEN;
923 msg.flags |= I2C_M_RD;
924 msg.len = count;
925 msg.buf = buf;
926
927 ret = i2c_transfer(adap, &msg, 1);
928
929 /* If everything went ok (i.e. 1 msg transmitted), return #bytes
930 transmitted, else error code. */
931 return (ret == 1) ? count : ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700932}
David Brownellc0564602007-05-01 23:26:31 +0200933EXPORT_SYMBOL(i2c_master_recv);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700934
935int i2c_control(struct i2c_client *client,
936 unsigned int cmd, unsigned long arg)
937{
938 int ret = 0;
939 struct i2c_adapter *adap = client->adapter;
940
941 dev_dbg(&client->adapter->dev, "i2c ioctl, cmd: 0x%x, arg: %#lx\n", cmd, arg);
942 switch (cmd) {
943 case I2C_RETRIES:
944 adap->retries = arg;
945 break;
946 case I2C_TIMEOUT:
947 adap->timeout = arg;
948 break;
949 default:
950 if (adap->algo->algo_control!=NULL)
951 ret = adap->algo->algo_control(adap,cmd,arg);
952 }
953 return ret;
954}
David Brownellc0564602007-05-01 23:26:31 +0200955EXPORT_SYMBOL(i2c_control);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700956
957/* ----------------------------------------------------
958 * the i2c address scanning function
959 * Will not work for 10-bit addresses!
960 * ----------------------------------------------------
961 */
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200962static int i2c_probe_address(struct i2c_adapter *adapter, int addr, int kind,
963 int (*found_proc) (struct i2c_adapter *, int, int))
Jean Delvare9fc6adf2005-07-31 21:20:43 +0200964{
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200965 int err;
Jean Delvare9fc6adf2005-07-31 21:20:43 +0200966
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200967 /* Make sure the address is valid */
968 if (addr < 0x03 || addr > 0x77) {
969 dev_warn(&adapter->dev, "Invalid probe address 0x%02x\n",
970 addr);
971 return -EINVAL;
Jean Delvare9fc6adf2005-07-31 21:20:43 +0200972 }
973
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200974 /* Skip if already in use */
975 if (i2c_check_addr(adapter, addr))
976 return 0;
977
978 /* Make sure there is something at this address, unless forced */
Jean Delvare4c9337d2005-08-09 20:28:10 +0200979 if (kind < 0) {
980 if (i2c_smbus_xfer(adapter, addr, 0, 0, 0,
981 I2C_SMBUS_QUICK, NULL) < 0)
982 return 0;
983
984 /* prevent 24RF08 corruption */
985 if ((addr & ~0x0f) == 0x50)
986 i2c_smbus_xfer(adapter, addr, 0, 0, 0,
987 I2C_SMBUS_QUICK, NULL);
988 }
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200989
990 /* Finally call the custom detection function */
991 err = found_proc(adapter, addr, kind);
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200992 /* -ENODEV can be returned if there is a chip at the given address
993 but it isn't supported by this chip driver. We catch it here as
994 this isn't an error. */
Jean Delvare114fd182006-09-03 22:25:04 +0200995 if (err == -ENODEV)
996 err = 0;
997
998 if (err)
999 dev_warn(&adapter->dev, "Client creation failed at 0x%x (%d)\n",
1000 addr, err);
1001 return err;
Jean Delvare9fc6adf2005-07-31 21:20:43 +02001002}
1003
Linus Torvalds1da177e2005-04-16 15:20:36 -07001004int i2c_probe(struct i2c_adapter *adapter,
1005 struct i2c_client_address_data *address_data,
1006 int (*found_proc) (struct i2c_adapter *, int, int))
1007{
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001008 int i, err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001009 int adap_id = i2c_adapter_id(adapter);
1010
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001011 /* Force entries are done first, and are not affected by ignore
1012 entries */
1013 if (address_data->forces) {
1014 unsigned short **forces = address_data->forces;
1015 int kind;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001016
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001017 for (kind = 0; forces[kind]; kind++) {
1018 for (i = 0; forces[kind][i] != I2C_CLIENT_END;
1019 i += 2) {
1020 if (forces[kind][i] == adap_id
1021 || forces[kind][i] == ANY_I2C_BUS) {
1022 dev_dbg(&adapter->dev, "found force "
1023 "parameter for adapter %d, "
1024 "addr 0x%02x, kind %d\n",
1025 adap_id, forces[kind][i + 1],
1026 kind);
1027 err = i2c_probe_address(adapter,
1028 forces[kind][i + 1],
1029 kind, found_proc);
1030 if (err)
1031 return err;
1032 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001033 }
1034 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001035 }
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001036
Jean Delvare4366dc92005-09-25 16:50:06 +02001037 /* Stop here if we can't use SMBUS_QUICK */
1038 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_QUICK)) {
1039 if (address_data->probe[0] == I2C_CLIENT_END
1040 && address_data->normal_i2c[0] == I2C_CLIENT_END)
David Brownell438d6c22006-12-10 21:21:31 +01001041 return 0;
Jean Delvare4366dc92005-09-25 16:50:06 +02001042
1043 dev_warn(&adapter->dev, "SMBus Quick command not supported, "
1044 "can't probe for chips\n");
1045 return -1;
1046 }
1047
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001048 /* Probe entries are done second, and are not affected by ignore
1049 entries either */
1050 for (i = 0; address_data->probe[i] != I2C_CLIENT_END; i += 2) {
1051 if (address_data->probe[i] == adap_id
1052 || address_data->probe[i] == ANY_I2C_BUS) {
1053 dev_dbg(&adapter->dev, "found probe parameter for "
1054 "adapter %d, addr 0x%02x\n", adap_id,
1055 address_data->probe[i + 1]);
1056 err = i2c_probe_address(adapter,
1057 address_data->probe[i + 1],
1058 -1, found_proc);
1059 if (err)
1060 return err;
1061 }
1062 }
1063
1064 /* Normal entries are done last, unless shadowed by an ignore entry */
1065 for (i = 0; address_data->normal_i2c[i] != I2C_CLIENT_END; i += 1) {
1066 int j, ignore;
1067
1068 ignore = 0;
1069 for (j = 0; address_data->ignore[j] != I2C_CLIENT_END;
1070 j += 2) {
1071 if ((address_data->ignore[j] == adap_id ||
1072 address_data->ignore[j] == ANY_I2C_BUS)
1073 && address_data->ignore[j + 1]
1074 == address_data->normal_i2c[i]) {
1075 dev_dbg(&adapter->dev, "found ignore "
1076 "parameter for adapter %d, "
1077 "addr 0x%02x\n", adap_id,
1078 address_data->ignore[j + 1]);
Mark M. Hoffman2369df92006-07-01 17:01:59 +02001079 ignore = 1;
1080 break;
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001081 }
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001082 }
1083 if (ignore)
1084 continue;
1085
1086 dev_dbg(&adapter->dev, "found normal entry for adapter %d, "
1087 "addr 0x%02x\n", adap_id,
1088 address_data->normal_i2c[i]);
1089 err = i2c_probe_address(adapter, address_data->normal_i2c[i],
1090 -1, found_proc);
1091 if (err)
1092 return err;
1093 }
1094
Linus Torvalds1da177e2005-04-16 15:20:36 -07001095 return 0;
1096}
David Brownellc0564602007-05-01 23:26:31 +02001097EXPORT_SYMBOL(i2c_probe);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001098
Jean Delvare12b5053a2007-05-01 23:26:31 +02001099struct i2c_client *
1100i2c_new_probed_device(struct i2c_adapter *adap,
1101 struct i2c_board_info *info,
1102 unsigned short const *addr_list)
1103{
1104 int i;
1105
1106 /* Stop here if the bus doesn't support probing */
1107 if (!i2c_check_functionality(adap, I2C_FUNC_SMBUS_READ_BYTE)) {
1108 dev_err(&adap->dev, "Probing not supported\n");
1109 return NULL;
1110 }
1111
1112 mutex_lock(&adap->clist_lock);
1113 for (i = 0; addr_list[i] != I2C_CLIENT_END; i++) {
1114 /* Check address validity */
1115 if (addr_list[i] < 0x03 || addr_list[i] > 0x77) {
1116 dev_warn(&adap->dev, "Invalid 7-bit address "
1117 "0x%02x\n", addr_list[i]);
1118 continue;
1119 }
1120
1121 /* Check address availability */
1122 if (__i2c_check_addr(adap, addr_list[i])) {
1123 dev_dbg(&adap->dev, "Address 0x%02x already in "
1124 "use, not probing\n", addr_list[i]);
1125 continue;
1126 }
1127
1128 /* Test address responsiveness
1129 The default probe method is a quick write, but it is known
1130 to corrupt the 24RF08 EEPROMs due to a state machine bug,
1131 and could also irreversibly write-protect some EEPROMs, so
1132 for address ranges 0x30-0x37 and 0x50-0x5f, we use a byte
1133 read instead. Also, some bus drivers don't implement
1134 quick write, so we fallback to a byte read it that case
1135 too. */
1136 if ((addr_list[i] & ~0x07) == 0x30
1137 || (addr_list[i] & ~0x0f) == 0x50
1138 || !i2c_check_functionality(adap, I2C_FUNC_SMBUS_QUICK)) {
1139 if (i2c_smbus_xfer(adap, addr_list[i], 0,
1140 I2C_SMBUS_READ, 0,
1141 I2C_SMBUS_BYTE, NULL) >= 0)
1142 break;
1143 } else {
1144 if (i2c_smbus_xfer(adap, addr_list[i], 0,
1145 I2C_SMBUS_WRITE, 0,
1146 I2C_SMBUS_QUICK, NULL) >= 0)
1147 break;
1148 }
1149 }
1150 mutex_unlock(&adap->clist_lock);
1151
1152 if (addr_list[i] == I2C_CLIENT_END) {
1153 dev_dbg(&adap->dev, "Probing failed, no device found\n");
1154 return NULL;
1155 }
1156
1157 info->addr = addr_list[i];
1158 return i2c_new_device(adap, info);
1159}
1160EXPORT_SYMBOL_GPL(i2c_new_probed_device);
1161
Linus Torvalds1da177e2005-04-16 15:20:36 -07001162struct i2c_adapter* i2c_get_adapter(int id)
1163{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001164 struct i2c_adapter *adapter;
David Brownell438d6c22006-12-10 21:21:31 +01001165
Arjan van de Venb3585e42006-01-11 10:50:26 +01001166 mutex_lock(&core_lists);
Mark M. Hoffmana0920e12005-06-28 00:21:30 -04001167 adapter = (struct i2c_adapter *)idr_find(&i2c_adapter_idr, id);
1168 if (adapter && !try_module_get(adapter->owner))
1169 adapter = NULL;
1170
Arjan van de Venb3585e42006-01-11 10:50:26 +01001171 mutex_unlock(&core_lists);
Mark M. Hoffmana0920e12005-06-28 00:21:30 -04001172 return adapter;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001173}
David Brownellc0564602007-05-01 23:26:31 +02001174EXPORT_SYMBOL(i2c_get_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001175
1176void i2c_put_adapter(struct i2c_adapter *adap)
1177{
1178 module_put(adap->owner);
1179}
David Brownellc0564602007-05-01 23:26:31 +02001180EXPORT_SYMBOL(i2c_put_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001181
1182/* The SMBus parts */
1183
David Brownell438d6c22006-12-10 21:21:31 +01001184#define POLY (0x1070U << 3)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001185static u8
1186crc8(u16 data)
1187{
1188 int i;
David Brownell438d6c22006-12-10 21:21:31 +01001189
Linus Torvalds1da177e2005-04-16 15:20:36 -07001190 for(i = 0; i < 8; i++) {
David Brownell438d6c22006-12-10 21:21:31 +01001191 if (data & 0x8000)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001192 data = data ^ POLY;
1193 data = data << 1;
1194 }
1195 return (u8)(data >> 8);
1196}
1197
Jean Delvare421ef472005-10-26 21:28:55 +02001198/* Incremental CRC8 over count bytes in the array pointed to by p */
1199static u8 i2c_smbus_pec(u8 crc, u8 *p, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001200{
1201 int i;
1202
1203 for(i = 0; i < count; i++)
Jean Delvare421ef472005-10-26 21:28:55 +02001204 crc = crc8((crc ^ p[i]) << 8);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001205 return crc;
1206}
1207
Jean Delvare421ef472005-10-26 21:28:55 +02001208/* Assume a 7-bit address, which is reasonable for SMBus */
1209static u8 i2c_smbus_msg_pec(u8 pec, struct i2c_msg *msg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001210{
Jean Delvare421ef472005-10-26 21:28:55 +02001211 /* The address will be sent first */
1212 u8 addr = (msg->addr << 1) | !!(msg->flags & I2C_M_RD);
1213 pec = i2c_smbus_pec(pec, &addr, 1);
1214
1215 /* The data buffer follows */
1216 return i2c_smbus_pec(pec, msg->buf, msg->len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001217}
1218
Jean Delvare421ef472005-10-26 21:28:55 +02001219/* Used for write only transactions */
1220static inline void i2c_smbus_add_pec(struct i2c_msg *msg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001221{
Jean Delvare421ef472005-10-26 21:28:55 +02001222 msg->buf[msg->len] = i2c_smbus_msg_pec(0, msg);
1223 msg->len++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001224}
1225
Jean Delvare421ef472005-10-26 21:28:55 +02001226/* Return <0 on CRC error
1227 If there was a write before this read (most cases) we need to take the
1228 partial CRC from the write part into account.
1229 Note that this function does modify the message (we need to decrease the
1230 message length to hide the CRC byte from the caller). */
1231static int i2c_smbus_check_pec(u8 cpec, struct i2c_msg *msg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001232{
Jean Delvare421ef472005-10-26 21:28:55 +02001233 u8 rpec = msg->buf[--msg->len];
1234 cpec = i2c_smbus_msg_pec(cpec, msg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001235
Linus Torvalds1da177e2005-04-16 15:20:36 -07001236 if (rpec != cpec) {
1237 pr_debug("i2c-core: Bad PEC 0x%02x vs. 0x%02x\n",
1238 rpec, cpec);
1239 return -1;
1240 }
David Brownell438d6c22006-12-10 21:21:31 +01001241 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001242}
1243
1244s32 i2c_smbus_write_quick(struct i2c_client *client, u8 value)
1245{
1246 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
David Brownell438d6c22006-12-10 21:21:31 +01001247 value,0,I2C_SMBUS_QUICK,NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001248}
David Brownellc0564602007-05-01 23:26:31 +02001249EXPORT_SYMBOL(i2c_smbus_write_quick);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001250
1251s32 i2c_smbus_read_byte(struct i2c_client *client)
1252{
1253 union i2c_smbus_data data;
1254 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1255 I2C_SMBUS_READ,0,I2C_SMBUS_BYTE, &data))
1256 return -1;
1257 else
Jean Delvare7eff82c2006-09-03 22:24:00 +02001258 return data.byte;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001259}
David Brownellc0564602007-05-01 23:26:31 +02001260EXPORT_SYMBOL(i2c_smbus_read_byte);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001261
1262s32 i2c_smbus_write_byte(struct i2c_client *client, u8 value)
1263{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001264 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
Jean Delvare421ef472005-10-26 21:28:55 +02001265 I2C_SMBUS_WRITE, value, I2C_SMBUS_BYTE, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001266}
David Brownellc0564602007-05-01 23:26:31 +02001267EXPORT_SYMBOL(i2c_smbus_write_byte);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001268
1269s32 i2c_smbus_read_byte_data(struct i2c_client *client, u8 command)
1270{
1271 union i2c_smbus_data data;
1272 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1273 I2C_SMBUS_READ,command, I2C_SMBUS_BYTE_DATA,&data))
1274 return -1;
1275 else
Jean Delvare7eff82c2006-09-03 22:24:00 +02001276 return data.byte;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001277}
David Brownellc0564602007-05-01 23:26:31 +02001278EXPORT_SYMBOL(i2c_smbus_read_byte_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001279
1280s32 i2c_smbus_write_byte_data(struct i2c_client *client, u8 command, u8 value)
1281{
1282 union i2c_smbus_data data;
1283 data.byte = value;
1284 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1285 I2C_SMBUS_WRITE,command,
1286 I2C_SMBUS_BYTE_DATA,&data);
1287}
David Brownellc0564602007-05-01 23:26:31 +02001288EXPORT_SYMBOL(i2c_smbus_write_byte_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001289
1290s32 i2c_smbus_read_word_data(struct i2c_client *client, u8 command)
1291{
1292 union i2c_smbus_data data;
1293 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1294 I2C_SMBUS_READ,command, I2C_SMBUS_WORD_DATA, &data))
1295 return -1;
1296 else
Jean Delvare7eff82c2006-09-03 22:24:00 +02001297 return data.word;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001298}
David Brownellc0564602007-05-01 23:26:31 +02001299EXPORT_SYMBOL(i2c_smbus_read_word_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001300
1301s32 i2c_smbus_write_word_data(struct i2c_client *client, u8 command, u16 value)
1302{
1303 union i2c_smbus_data data;
1304 data.word = value;
1305 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1306 I2C_SMBUS_WRITE,command,
1307 I2C_SMBUS_WORD_DATA,&data);
1308}
David Brownellc0564602007-05-01 23:26:31 +02001309EXPORT_SYMBOL(i2c_smbus_write_word_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001310
Jean Delvareb86a1bc2007-05-01 23:26:34 +02001311/* Returns the number of read bytes */
1312s32 i2c_smbus_read_block_data(struct i2c_client *client, u8 command,
1313 u8 *values)
1314{
1315 union i2c_smbus_data data;
1316
1317 if (i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1318 I2C_SMBUS_READ, command,
1319 I2C_SMBUS_BLOCK_DATA, &data))
1320 return -1;
1321
1322 memcpy(values, &data.block[1], data.block[0]);
1323 return data.block[0];
1324}
1325EXPORT_SYMBOL(i2c_smbus_read_block_data);
1326
Linus Torvalds1da177e2005-04-16 15:20:36 -07001327s32 i2c_smbus_write_block_data(struct i2c_client *client, u8 command,
Krzysztof Halasa46f5ed72006-06-12 21:42:20 +02001328 u8 length, const u8 *values)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001329{
1330 union i2c_smbus_data data;
Jean Delvare76560322006-01-18 23:14:55 +01001331
Linus Torvalds1da177e2005-04-16 15:20:36 -07001332 if (length > I2C_SMBUS_BLOCK_MAX)
1333 length = I2C_SMBUS_BLOCK_MAX;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001334 data.block[0] = length;
Jean Delvare76560322006-01-18 23:14:55 +01001335 memcpy(&data.block[1], values, length);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001336 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1337 I2C_SMBUS_WRITE,command,
1338 I2C_SMBUS_BLOCK_DATA,&data);
1339}
David Brownellc0564602007-05-01 23:26:31 +02001340EXPORT_SYMBOL(i2c_smbus_write_block_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001341
1342/* Returns the number of read bytes */
Jean Delvare4b2643d2007-07-12 14:12:29 +02001343s32 i2c_smbus_read_i2c_block_data(struct i2c_client *client, u8 command,
1344 u8 length, u8 *values)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001345{
1346 union i2c_smbus_data data;
Jean Delvare76560322006-01-18 23:14:55 +01001347
Jean Delvare4b2643d2007-07-12 14:12:29 +02001348 if (length > I2C_SMBUS_BLOCK_MAX)
1349 length = I2C_SMBUS_BLOCK_MAX;
1350 data.block[0] = length;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001351 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1352 I2C_SMBUS_READ,command,
1353 I2C_SMBUS_I2C_BLOCK_DATA,&data))
1354 return -1;
Jean Delvare76560322006-01-18 23:14:55 +01001355
1356 memcpy(values, &data.block[1], data.block[0]);
1357 return data.block[0];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001358}
David Brownellc0564602007-05-01 23:26:31 +02001359EXPORT_SYMBOL(i2c_smbus_read_i2c_block_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001360
Jean Delvare21bbd692006-01-09 15:19:18 +11001361s32 i2c_smbus_write_i2c_block_data(struct i2c_client *client, u8 command,
Krzysztof Halasa46f5ed72006-06-12 21:42:20 +02001362 u8 length, const u8 *values)
Jean Delvare21bbd692006-01-09 15:19:18 +11001363{
1364 union i2c_smbus_data data;
1365
1366 if (length > I2C_SMBUS_BLOCK_MAX)
1367 length = I2C_SMBUS_BLOCK_MAX;
1368 data.block[0] = length;
1369 memcpy(data.block + 1, values, length);
1370 return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1371 I2C_SMBUS_WRITE, command,
1372 I2C_SMBUS_I2C_BLOCK_DATA, &data);
1373}
David Brownellc0564602007-05-01 23:26:31 +02001374EXPORT_SYMBOL(i2c_smbus_write_i2c_block_data);
Jean Delvare21bbd692006-01-09 15:19:18 +11001375
David Brownell438d6c22006-12-10 21:21:31 +01001376/* Simulate a SMBus command using the i2c protocol
Linus Torvalds1da177e2005-04-16 15:20:36 -07001377 No checking of parameters is done! */
David Brownell438d6c22006-12-10 21:21:31 +01001378static s32 i2c_smbus_xfer_emulated(struct i2c_adapter * adapter, u16 addr,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001379 unsigned short flags,
David Brownell438d6c22006-12-10 21:21:31 +01001380 char read_write, u8 command, int size,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001381 union i2c_smbus_data * data)
1382{
1383 /* So we need to generate a series of msgs. In the case of writing, we
1384 need to use only one message; when reading, we need two. We initialize
1385 most things with sane defaults, to keep the code below somewhat
1386 simpler. */
Hideki Iwamoto5c50d182005-09-25 17:01:11 +02001387 unsigned char msgbuf0[I2C_SMBUS_BLOCK_MAX+3];
1388 unsigned char msgbuf1[I2C_SMBUS_BLOCK_MAX+2];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001389 int num = read_write == I2C_SMBUS_READ?2:1;
David Brownell438d6c22006-12-10 21:21:31 +01001390 struct i2c_msg msg[2] = { { addr, flags, 1, msgbuf0 },
Linus Torvalds1da177e2005-04-16 15:20:36 -07001391 { addr, flags | I2C_M_RD, 0, msgbuf1 }
1392 };
1393 int i;
Jean Delvare421ef472005-10-26 21:28:55 +02001394 u8 partial_pec = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001395
1396 msgbuf0[0] = command;
1397 switch(size) {
1398 case I2C_SMBUS_QUICK:
1399 msg[0].len = 0;
1400 /* Special case: The read/write field is used as data */
1401 msg[0].flags = flags | (read_write==I2C_SMBUS_READ)?I2C_M_RD:0;
1402 num = 1;
1403 break;
1404 case I2C_SMBUS_BYTE:
1405 if (read_write == I2C_SMBUS_READ) {
1406 /* Special case: only a read! */
1407 msg[0].flags = I2C_M_RD | flags;
1408 num = 1;
1409 }
1410 break;
1411 case I2C_SMBUS_BYTE_DATA:
1412 if (read_write == I2C_SMBUS_READ)
1413 msg[1].len = 1;
1414 else {
1415 msg[0].len = 2;
1416 msgbuf0[1] = data->byte;
1417 }
1418 break;
1419 case I2C_SMBUS_WORD_DATA:
1420 if (read_write == I2C_SMBUS_READ)
1421 msg[1].len = 2;
1422 else {
1423 msg[0].len=3;
1424 msgbuf0[1] = data->word & 0xff;
Jean Delvare7eff82c2006-09-03 22:24:00 +02001425 msgbuf0[2] = data->word >> 8;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001426 }
1427 break;
1428 case I2C_SMBUS_PROC_CALL:
1429 num = 2; /* Special case */
1430 read_write = I2C_SMBUS_READ;
1431 msg[0].len = 3;
1432 msg[1].len = 2;
1433 msgbuf0[1] = data->word & 0xff;
Jean Delvare7eff82c2006-09-03 22:24:00 +02001434 msgbuf0[2] = data->word >> 8;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001435 break;
1436 case I2C_SMBUS_BLOCK_DATA:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001437 if (read_write == I2C_SMBUS_READ) {
Jean Delvare209d27c2007-05-01 23:26:29 +02001438 msg[1].flags |= I2C_M_RECV_LEN;
1439 msg[1].len = 1; /* block length will be added by
1440 the underlying bus driver */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001441 } else {
1442 msg[0].len = data->block[0] + 2;
1443 if (msg[0].len > I2C_SMBUS_BLOCK_MAX + 2) {
1444 dev_err(&adapter->dev, "smbus_access called with "
1445 "invalid block write size (%d)\n",
1446 data->block[0]);
1447 return -1;
1448 }
Hideki Iwamoto5c50d182005-09-25 17:01:11 +02001449 for (i = 1; i < msg[0].len; i++)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001450 msgbuf0[i] = data->block[i-1];
1451 }
1452 break;
1453 case I2C_SMBUS_BLOCK_PROC_CALL:
Jean Delvare209d27c2007-05-01 23:26:29 +02001454 num = 2; /* Another special case */
1455 read_write = I2C_SMBUS_READ;
1456 if (data->block[0] > I2C_SMBUS_BLOCK_MAX) {
1457 dev_err(&adapter->dev, "%s called with invalid "
1458 "block proc call size (%d)\n", __FUNCTION__,
1459 data->block[0]);
1460 return -1;
1461 }
1462 msg[0].len = data->block[0] + 2;
1463 for (i = 1; i < msg[0].len; i++)
1464 msgbuf0[i] = data->block[i-1];
1465 msg[1].flags |= I2C_M_RECV_LEN;
1466 msg[1].len = 1; /* block length will be added by
1467 the underlying bus driver */
1468 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001469 case I2C_SMBUS_I2C_BLOCK_DATA:
1470 if (read_write == I2C_SMBUS_READ) {
Jean Delvare4b2643d2007-07-12 14:12:29 +02001471 msg[1].len = data->block[0];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001472 } else {
1473 msg[0].len = data->block[0] + 1;
Jean Delvare30dac742005-10-08 00:15:59 +02001474 if (msg[0].len > I2C_SMBUS_BLOCK_MAX + 1) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001475 dev_err(&adapter->dev, "i2c_smbus_xfer_emulated called with "
1476 "invalid block write size (%d)\n",
1477 data->block[0]);
1478 return -1;
1479 }
1480 for (i = 1; i <= data->block[0]; i++)
1481 msgbuf0[i] = data->block[i];
1482 }
1483 break;
1484 default:
1485 dev_err(&adapter->dev, "smbus_access called with invalid size (%d)\n",
1486 size);
1487 return -1;
1488 }
1489
Jean Delvare421ef472005-10-26 21:28:55 +02001490 i = ((flags & I2C_CLIENT_PEC) && size != I2C_SMBUS_QUICK
1491 && size != I2C_SMBUS_I2C_BLOCK_DATA);
1492 if (i) {
1493 /* Compute PEC if first message is a write */
1494 if (!(msg[0].flags & I2C_M_RD)) {
David Brownell438d6c22006-12-10 21:21:31 +01001495 if (num == 1) /* Write only */
Jean Delvare421ef472005-10-26 21:28:55 +02001496 i2c_smbus_add_pec(&msg[0]);
1497 else /* Write followed by read */
1498 partial_pec = i2c_smbus_msg_pec(0, &msg[0]);
1499 }
1500 /* Ask for PEC if last message is a read */
1501 if (msg[num-1].flags & I2C_M_RD)
David Brownell438d6c22006-12-10 21:21:31 +01001502 msg[num-1].len++;
Jean Delvare421ef472005-10-26 21:28:55 +02001503 }
1504
Linus Torvalds1da177e2005-04-16 15:20:36 -07001505 if (i2c_transfer(adapter, msg, num) < 0)
1506 return -1;
1507
Jean Delvare421ef472005-10-26 21:28:55 +02001508 /* Check PEC if last message is a read */
1509 if (i && (msg[num-1].flags & I2C_M_RD)) {
1510 if (i2c_smbus_check_pec(partial_pec, &msg[num-1]) < 0)
1511 return -1;
1512 }
1513
Linus Torvalds1da177e2005-04-16 15:20:36 -07001514 if (read_write == I2C_SMBUS_READ)
1515 switch(size) {
1516 case I2C_SMBUS_BYTE:
1517 data->byte = msgbuf0[0];
1518 break;
1519 case I2C_SMBUS_BYTE_DATA:
1520 data->byte = msgbuf1[0];
1521 break;
David Brownell438d6c22006-12-10 21:21:31 +01001522 case I2C_SMBUS_WORD_DATA:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001523 case I2C_SMBUS_PROC_CALL:
1524 data->word = msgbuf1[0] | (msgbuf1[1] << 8);
1525 break;
1526 case I2C_SMBUS_I2C_BLOCK_DATA:
Jean Delvare4b2643d2007-07-12 14:12:29 +02001527 for (i = 0; i < data->block[0]; i++)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001528 data->block[i+1] = msgbuf1[i];
1529 break;
Jean Delvare209d27c2007-05-01 23:26:29 +02001530 case I2C_SMBUS_BLOCK_DATA:
1531 case I2C_SMBUS_BLOCK_PROC_CALL:
1532 for (i = 0; i < msgbuf1[0] + 1; i++)
1533 data->block[i] = msgbuf1[i];
1534 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001535 }
1536 return 0;
1537}
1538
1539
1540s32 i2c_smbus_xfer(struct i2c_adapter * adapter, u16 addr, unsigned short flags,
David Brownell438d6c22006-12-10 21:21:31 +01001541 char read_write, u8 command, int size,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001542 union i2c_smbus_data * data)
1543{
1544 s32 res;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001545
1546 flags &= I2C_M_TEN | I2C_CLIENT_PEC;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001547
1548 if (adapter->algo->smbus_xfer) {
Ingo Molnar5c085d32006-01-18 23:16:04 +01001549 mutex_lock(&adapter->bus_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001550 res = adapter->algo->smbus_xfer(adapter,addr,flags,read_write,
1551 command,size,data);
Ingo Molnar5c085d32006-01-18 23:16:04 +01001552 mutex_unlock(&adapter->bus_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001553 } else
1554 res = i2c_smbus_xfer_emulated(adapter,addr,flags,read_write,
1555 command,size,data);
1556
Linus Torvalds1da177e2005-04-16 15:20:36 -07001557 return res;
1558}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001559EXPORT_SYMBOL(i2c_smbus_xfer);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001560
1561MODULE_AUTHOR("Simon G. Vogl <simon@tk.uni-linz.ac.at>");
1562MODULE_DESCRIPTION("I2C-Bus main module");
1563MODULE_LICENSE("GPL");