blob: cccfa8678245dc7310e2dd5162150c1b073cb6b6 [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
David Brownelld64f73b2007-07-12 14:12:28 +0200210 * Context: can sleep
David Brownell9c1600e2007-05-01 23:26:31 +0200211 *
212 * Create a device to work with a new style i2c driver, where binding is
213 * handled through driver model probe()/remove() methods. This call is not
214 * appropriate for use by mainboad initialization logic, which usually runs
215 * during an arch_initcall() long before any i2c_adapter could exist.
216 *
217 * This returns the new i2c client, which may be saved for later use with
218 * i2c_unregister_device(); or NULL to indicate an error.
219 */
220struct i2c_client *
221i2c_new_device(struct i2c_adapter *adap, struct i2c_board_info const *info)
222{
223 struct i2c_client *client;
224 int status;
225
226 client = kzalloc(sizeof *client, GFP_KERNEL);
227 if (!client)
228 return NULL;
229
230 client->adapter = adap;
231
232 client->dev.platform_data = info->platform_data;
233 client->flags = info->flags;
234 client->addr = info->addr;
235 client->irq = info->irq;
236
237 strlcpy(client->driver_name, info->driver_name,
238 sizeof(client->driver_name));
239 strlcpy(client->name, info->type, sizeof(client->name));
240
241 /* a new style driver may be bound to this device when we
242 * return from this function, or any later moment (e.g. maybe
243 * hotplugging will load the driver module). and the device
244 * refcount model is the standard driver model one.
245 */
246 status = i2c_attach_client(client);
247 if (status < 0) {
248 kfree(client);
249 client = NULL;
250 }
251 return client;
252}
253EXPORT_SYMBOL_GPL(i2c_new_device);
254
255
256/**
257 * i2c_unregister_device - reverse effect of i2c_new_device()
258 * @client: value returned from i2c_new_device()
David Brownelld64f73b2007-07-12 14:12:28 +0200259 * Context: can sleep
David Brownell9c1600e2007-05-01 23:26:31 +0200260 */
261void i2c_unregister_device(struct i2c_client *client)
David Brownella1d9e6e2007-05-01 23:26:30 +0200262{
263 struct i2c_adapter *adapter = client->adapter;
264 struct i2c_driver *driver = client->driver;
265
266 if (driver && !is_newstyle_driver(driver)) {
267 dev_err(&client->dev, "can't unregister devices "
268 "with legacy drivers\n");
269 WARN_ON(1);
270 return;
271 }
272
273 mutex_lock(&adapter->clist_lock);
274 list_del(&client->list);
275 mutex_unlock(&adapter->clist_lock);
276
277 device_unregister(&client->dev);
278}
David Brownell9c1600e2007-05-01 23:26:31 +0200279EXPORT_SYMBOL_GPL(i2c_unregister_device);
David Brownella1d9e6e2007-05-01 23:26:30 +0200280
281
David Brownellf37dd802007-02-13 22:09:00 +0100282/* ------------------------------------------------------------------------- */
283
David Brownell16ffadf2007-05-01 23:26:28 +0200284/* I2C bus adapters -- one roots each I2C or SMBUS segment */
285
Jean Delvareefde7232005-07-20 23:03:50 +0200286void i2c_adapter_dev_release(struct device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700287{
David Brownellef2c83212007-05-01 23:26:28 +0200288 struct i2c_adapter *adap = to_i2c_adapter(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700289 complete(&adap->dev_released);
290}
David Brownellc0564602007-05-01 23:26:31 +0200291EXPORT_SYMBOL_GPL(i2c_adapter_dev_release); /* exported to i2c-isa */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700292
David Brownell16ffadf2007-05-01 23:26:28 +0200293static ssize_t
294show_adapter_name(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700295{
David Brownellef2c83212007-05-01 23:26:28 +0200296 struct i2c_adapter *adap = to_i2c_adapter(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700297 return sprintf(buf, "%s\n", adap->name);
298}
David Brownell16ffadf2007-05-01 23:26:28 +0200299
300static struct device_attribute i2c_adapter_attrs[] = {
301 __ATTR(name, S_IRUGO, show_adapter_name, NULL),
302 { },
303};
304
305struct class i2c_adapter_class = {
306 .owner = THIS_MODULE,
307 .name = "i2c-adapter",
308 .dev_attrs = i2c_adapter_attrs,
309};
David Brownellc0564602007-05-01 23:26:31 +0200310EXPORT_SYMBOL_GPL(i2c_adapter_class); /* exported to i2c-isa */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700311
David Brownell9c1600e2007-05-01 23:26:31 +0200312static void i2c_scan_static_board_info(struct i2c_adapter *adapter)
313{
314 struct i2c_devinfo *devinfo;
315
316 mutex_lock(&__i2c_board_lock);
317 list_for_each_entry(devinfo, &__i2c_board_list, list) {
318 if (devinfo->busnum == adapter->nr
319 && !i2c_new_device(adapter,
320 &devinfo->board_info))
321 printk(KERN_ERR "i2c-core: can't create i2c%d-%04x\n",
322 i2c_adapter_id(adapter),
323 devinfo->board_info.addr);
324 }
325 mutex_unlock(&__i2c_board_lock);
326}
327
David Brownell6e13e642007-05-01 23:26:31 +0200328static int i2c_register_adapter(struct i2c_adapter *adap)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700329{
David Brownell6e13e642007-05-01 23:26:31 +0200330 int res = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700331 struct list_head *item;
332 struct i2c_driver *driver;
333
Ingo Molnar5c085d32006-01-18 23:16:04 +0100334 mutex_init(&adap->bus_lock);
335 mutex_init(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700336 INIT_LIST_HEAD(&adap->clients);
337
David Brownell6e13e642007-05-01 23:26:31 +0200338 mutex_lock(&core_lists);
339 list_add_tail(&adap->list, &adapters);
340
Linus Torvalds1da177e2005-04-16 15:20:36 -0700341 /* Add the adapter to the driver core.
342 * If the parent pointer is not set up,
343 * we add this adapter to the host bus.
344 */
David Brownellb119dc32007-01-04 13:07:04 +0100345 if (adap->dev.parent == NULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700346 adap->dev.parent = &platform_bus;
Jean Delvarefe2c8d52007-02-13 22:09:04 +0100347 pr_debug("I2C adapter driver [%s] forgot to specify "
348 "physical device\n", adap->name);
David Brownellb119dc32007-01-04 13:07:04 +0100349 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700350 sprintf(adap->dev.bus_id, "i2c-%d", adap->nr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700351 adap->dev.release = &i2c_adapter_dev_release;
Jean Delvarefccb56e2007-05-01 23:26:27 +0200352 adap->dev.class = &i2c_adapter_class;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200353 res = device_register(&adap->dev);
354 if (res)
355 goto out_list;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700356
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200357 dev_dbg(&adap->dev, "adapter [%s] registered\n", adap->name);
358
David Brownell6e13e642007-05-01 23:26:31 +0200359 /* create pre-declared device nodes for new-style drivers */
360 if (adap->nr < __i2c_first_dynamic_bus_num)
361 i2c_scan_static_board_info(adap);
362
David Brownell7b4fbc52007-05-01 23:26:30 +0200363 /* let legacy drivers scan this bus for matching devices */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700364 list_for_each(item,&drivers) {
365 driver = list_entry(item, struct i2c_driver, list);
Jean Delvare8a994752005-11-26 20:28:06 +0100366 if (driver->attach_adapter)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700367 /* We ignore the return code; if it fails, too bad */
368 driver->attach_adapter(adap);
369 }
370
Linus Torvalds1da177e2005-04-16 15:20:36 -0700371out_unlock:
Arjan van de Venb3585e42006-01-11 10:50:26 +0100372 mutex_unlock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700373 return res;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200374
Jean Delvareb119c6c2006-08-15 18:26:30 +0200375out_list:
376 list_del(&adap->list);
377 idr_remove(&i2c_adapter_idr, adap->nr);
378 goto out_unlock;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700379}
380
David Brownell6e13e642007-05-01 23:26:31 +0200381/**
382 * i2c_add_adapter - declare i2c adapter, use dynamic bus number
383 * @adapter: the adapter to add
David Brownelld64f73b2007-07-12 14:12:28 +0200384 * Context: can sleep
David Brownell6e13e642007-05-01 23:26:31 +0200385 *
386 * This routine is used to declare an I2C adapter when its bus number
387 * doesn't matter. Examples: for I2C adapters dynamically added by
388 * USB links or PCI plugin cards.
389 *
390 * When this returns zero, a new bus number was allocated and stored
391 * in adap->nr, and the specified adapter became available for clients.
392 * Otherwise, a negative errno value is returned.
393 */
394int i2c_add_adapter(struct i2c_adapter *adapter)
395{
396 int id, res = 0;
397
398retry:
399 if (idr_pre_get(&i2c_adapter_idr, GFP_KERNEL) == 0)
400 return -ENOMEM;
401
402 mutex_lock(&core_lists);
403 /* "above" here means "above or equal to", sigh */
404 res = idr_get_new_above(&i2c_adapter_idr, adapter,
405 __i2c_first_dynamic_bus_num, &id);
406 mutex_unlock(&core_lists);
407
408 if (res < 0) {
409 if (res == -EAGAIN)
410 goto retry;
411 return res;
412 }
413
414 adapter->nr = id;
415 return i2c_register_adapter(adapter);
416}
417EXPORT_SYMBOL(i2c_add_adapter);
418
419/**
420 * i2c_add_numbered_adapter - declare i2c adapter, use static bus number
421 * @adap: the adapter to register (with adap->nr initialized)
David Brownelld64f73b2007-07-12 14:12:28 +0200422 * Context: can sleep
David Brownell6e13e642007-05-01 23:26:31 +0200423 *
424 * This routine is used to declare an I2C adapter when its bus number
425 * matters. Example: for I2C adapters from system-on-chip CPUs, or
426 * otherwise built in to the system's mainboard, and where i2c_board_info
427 * is used to properly configure I2C devices.
428 *
429 * If no devices have pre-been declared for this bus, then be sure to
430 * register the adapter before any dynamically allocated ones. Otherwise
431 * the required bus ID may not be available.
432 *
433 * When this returns zero, the specified adapter became available for
434 * clients using the bus number provided in adap->nr. Also, the table
435 * of I2C devices pre-declared using i2c_register_board_info() is scanned,
436 * and the appropriate driver model device nodes are created. Otherwise, a
437 * negative errno value is returned.
438 */
439int i2c_add_numbered_adapter(struct i2c_adapter *adap)
440{
441 int id;
442 int status;
443
444 if (adap->nr & ~MAX_ID_MASK)
445 return -EINVAL;
446
447retry:
448 if (idr_pre_get(&i2c_adapter_idr, GFP_KERNEL) == 0)
449 return -ENOMEM;
450
451 mutex_lock(&core_lists);
452 /* "above" here means "above or equal to", sigh;
453 * we need the "equal to" result to force the result
454 */
455 status = idr_get_new_above(&i2c_adapter_idr, adap, adap->nr, &id);
456 if (status == 0 && id != adap->nr) {
457 status = -EBUSY;
458 idr_remove(&i2c_adapter_idr, id);
459 }
460 mutex_unlock(&core_lists);
461 if (status == -EAGAIN)
462 goto retry;
463
464 if (status == 0)
465 status = i2c_register_adapter(adap);
466 return status;
467}
468EXPORT_SYMBOL_GPL(i2c_add_numbered_adapter);
469
David Brownelld64f73b2007-07-12 14:12:28 +0200470/**
471 * i2c_del_adapter - unregister I2C adapter
472 * @adap: the adapter being unregistered
473 * Context: can sleep
474 *
475 * This unregisters an I2C adapter which was previously registered
476 * by @i2c_add_adapter or @i2c_add_numbered_adapter.
477 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700478int i2c_del_adapter(struct i2c_adapter *adap)
479{
480 struct list_head *item, *_n;
481 struct i2c_adapter *adap_from_list;
482 struct i2c_driver *driver;
483 struct i2c_client *client;
484 int res = 0;
485
Arjan van de Venb3585e42006-01-11 10:50:26 +0100486 mutex_lock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700487
488 /* First make sure that this adapter was ever added */
489 list_for_each_entry(adap_from_list, &adapters, list) {
490 if (adap_from_list == adap)
491 break;
492 }
493 if (adap_from_list != adap) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200494 pr_debug("i2c-core: attempting to delete unregistered "
495 "adapter [%s]\n", adap->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700496 res = -EINVAL;
497 goto out_unlock;
498 }
499
500 list_for_each(item,&drivers) {
501 driver = list_entry(item, struct i2c_driver, list);
502 if (driver->detach_adapter)
503 if ((res = driver->detach_adapter(adap))) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200504 dev_err(&adap->dev, "detach_adapter failed "
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100505 "for driver [%s]\n",
506 driver->driver.name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700507 goto out_unlock;
508 }
509 }
510
511 /* detach any active clients. This must be done first, because
Tobias Klausera551acc2005-05-19 21:40:38 +0200512 * it can fail; in which case we give up. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700513 list_for_each_safe(item, _n, &adap->clients) {
David Brownella1d9e6e2007-05-01 23:26:30 +0200514 struct i2c_driver *driver;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700515
David Brownella1d9e6e2007-05-01 23:26:30 +0200516 client = list_entry(item, struct i2c_client, list);
517 driver = client->driver;
518
519 /* new style, follow standard driver model */
520 if (!driver || is_newstyle_driver(driver)) {
521 i2c_unregister_device(client);
522 continue;
523 }
524
525 /* legacy drivers create and remove clients themselves */
526 if ((res = driver->detach_client(client))) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200527 dev_err(&adap->dev, "detach_client failed for client "
528 "[%s] at address 0x%02x\n", client->name,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700529 client->addr);
530 goto out_unlock;
531 }
532 }
533
534 /* clean up the sysfs representation */
535 init_completion(&adap->dev_released);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700536 device_unregister(&adap->dev);
537 list_del(&adap->list);
538
539 /* wait for sysfs to drop all references */
540 wait_for_completion(&adap->dev_released);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700541
David Brownell6e13e642007-05-01 23:26:31 +0200542 /* free bus id */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700543 idr_remove(&i2c_adapter_idr, adap->nr);
544
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200545 dev_dbg(&adap->dev, "adapter [%s] unregistered\n", adap->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700546
547 out_unlock:
Arjan van de Venb3585e42006-01-11 10:50:26 +0100548 mutex_unlock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700549 return res;
550}
David Brownellc0564602007-05-01 23:26:31 +0200551EXPORT_SYMBOL(i2c_del_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700552
553
David Brownell7b4fbc52007-05-01 23:26:30 +0200554/* ------------------------------------------------------------------------- */
555
556/*
557 * An i2c_driver is used with one or more i2c_client (device) nodes to access
558 * i2c slave chips, on a bus instance associated with some i2c_adapter. There
559 * are two models for binding the driver to its device: "new style" drivers
560 * follow the standard Linux driver model and just respond to probe() calls
561 * issued if the driver core sees they match(); "legacy" drivers create device
562 * nodes themselves.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700563 */
564
Greg Kroah-Hartmande59cf92005-12-06 15:33:15 -0800565int i2c_register_driver(struct module *owner, struct i2c_driver *driver)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700566{
Jean Delvare7eebcb72006-02-05 23:28:21 +0100567 int res;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700568
David Brownell7b4fbc52007-05-01 23:26:30 +0200569 /* new style driver methods can't mix with legacy ones */
David Brownella1d9e6e2007-05-01 23:26:30 +0200570 if (is_newstyle_driver(driver)) {
David Brownell7b4fbc52007-05-01 23:26:30 +0200571 if (driver->attach_adapter || driver->detach_adapter
572 || driver->detach_client) {
573 printk(KERN_WARNING
574 "i2c-core: driver [%s] is confused\n",
575 driver->driver.name);
576 return -EINVAL;
577 }
578 }
579
Linus Torvalds1da177e2005-04-16 15:20:36 -0700580 /* add the driver to the list of i2c drivers in the driver core */
Greg Kroah-Hartmande59cf92005-12-06 15:33:15 -0800581 driver->driver.owner = owner;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700582 driver->driver.bus = &i2c_bus_type;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700583
David Brownell6e13e642007-05-01 23:26:31 +0200584 /* for new style drivers, when registration returns the driver core
585 * will have called probe() for all matching-but-unbound devices.
586 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700587 res = driver_register(&driver->driver);
588 if (res)
Jean Delvare7eebcb72006-02-05 23:28:21 +0100589 return res;
David Brownell438d6c22006-12-10 21:21:31 +0100590
Jean Delvare7eebcb72006-02-05 23:28:21 +0100591 mutex_lock(&core_lists);
592
Linus Torvalds1da177e2005-04-16 15:20:36 -0700593 list_add_tail(&driver->list,&drivers);
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100594 pr_debug("i2c-core: driver [%s] registered\n", driver->driver.name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700595
David Brownell7b4fbc52007-05-01 23:26:30 +0200596 /* legacy drivers scan i2c busses directly */
Jean Delvare8a994752005-11-26 20:28:06 +0100597 if (driver->attach_adapter) {
David Brownell4ad4eac2007-05-01 23:26:28 +0200598 struct i2c_adapter *adapter;
599
600 list_for_each_entry(adapter, &adapters, list) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700601 driver->attach_adapter(adapter);
602 }
603 }
604
Arjan van de Venb3585e42006-01-11 10:50:26 +0100605 mutex_unlock(&core_lists);
Jean Delvare7eebcb72006-02-05 23:28:21 +0100606 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700607}
Greg Kroah-Hartmande59cf92005-12-06 15:33:15 -0800608EXPORT_SYMBOL(i2c_register_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700609
David Brownella1d9e6e2007-05-01 23:26:30 +0200610/**
611 * i2c_del_driver - unregister I2C driver
612 * @driver: the driver being unregistered
David Brownelld64f73b2007-07-12 14:12:28 +0200613 * Context: can sleep
David Brownella1d9e6e2007-05-01 23:26:30 +0200614 */
Jean Delvareb3e82092007-05-01 23:26:32 +0200615void i2c_del_driver(struct i2c_driver *driver)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700616{
617 struct list_head *item1, *item2, *_n;
618 struct i2c_client *client;
619 struct i2c_adapter *adap;
David Brownell438d6c22006-12-10 21:21:31 +0100620
Arjan van de Venb3585e42006-01-11 10:50:26 +0100621 mutex_lock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700622
David Brownella1d9e6e2007-05-01 23:26:30 +0200623 /* new-style driver? */
624 if (is_newstyle_driver(driver))
625 goto unregister;
626
Linus Torvalds1da177e2005-04-16 15:20:36 -0700627 /* Have a look at each adapter, if clients of this driver are still
David Brownell438d6c22006-12-10 21:21:31 +0100628 * attached. If so, detach them to be able to kill the driver
Linus Torvalds1da177e2005-04-16 15:20:36 -0700629 * afterwards.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700630 */
631 list_for_each(item1,&adapters) {
632 adap = list_entry(item1, struct i2c_adapter, list);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700633 if (driver->detach_adapter) {
Jean Delvareb3e82092007-05-01 23:26:32 +0200634 if (driver->detach_adapter(adap)) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200635 dev_err(&adap->dev, "detach_adapter failed "
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100636 "for driver [%s]\n",
637 driver->driver.name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700638 }
639 } else {
640 list_for_each_safe(item2, _n, &adap->clients) {
641 client = list_entry(item2, struct i2c_client, list);
642 if (client->driver != driver)
643 continue;
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200644 dev_dbg(&adap->dev, "detaching client [%s] "
645 "at 0x%02x\n", client->name,
646 client->addr);
Jean Delvareb3e82092007-05-01 23:26:32 +0200647 if (driver->detach_client(client)) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200648 dev_err(&adap->dev, "detach_client "
649 "failed for client [%s] at "
650 "0x%02x\n", client->name,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700651 client->addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700652 }
653 }
654 }
655 }
656
David Brownella1d9e6e2007-05-01 23:26:30 +0200657 unregister:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700658 driver_unregister(&driver->driver);
659 list_del(&driver->list);
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100660 pr_debug("i2c-core: driver [%s] unregistered\n", driver->driver.name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700661
Arjan van de Venb3585e42006-01-11 10:50:26 +0100662 mutex_unlock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700663}
David Brownellc0564602007-05-01 23:26:31 +0200664EXPORT_SYMBOL(i2c_del_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700665
David Brownell7b4fbc52007-05-01 23:26:30 +0200666/* ------------------------------------------------------------------------- */
667
Linus Torvalds1da177e2005-04-16 15:20:36 -0700668static int __i2c_check_addr(struct i2c_adapter *adapter, unsigned int addr)
669{
670 struct list_head *item;
671 struct i2c_client *client;
672
673 list_for_each(item,&adapter->clients) {
674 client = list_entry(item, struct i2c_client, list);
675 if (client->addr == addr)
676 return -EBUSY;
677 }
678 return 0;
679}
680
681int i2c_check_addr(struct i2c_adapter *adapter, int addr)
682{
683 int rval;
684
Ingo Molnar5c085d32006-01-18 23:16:04 +0100685 mutex_lock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700686 rval = __i2c_check_addr(adapter, addr);
Ingo Molnar5c085d32006-01-18 23:16:04 +0100687 mutex_unlock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700688
689 return rval;
690}
David Brownellc0564602007-05-01 23:26:31 +0200691EXPORT_SYMBOL(i2c_check_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700692
693int i2c_attach_client(struct i2c_client *client)
694{
695 struct i2c_adapter *adapter = client->adapter;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200696 int res = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700697
Ingo Molnar5c085d32006-01-18 23:16:04 +0100698 mutex_lock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700699 if (__i2c_check_addr(client->adapter, client->addr)) {
Jean Delvareb119c6c2006-08-15 18:26:30 +0200700 res = -EBUSY;
701 goto out_unlock;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702 }
703 list_add_tail(&client->list,&adapter->clients);
David Brownell438d6c22006-12-10 21:21:31 +0100704
Jean Delvarecde78592005-11-26 21:00:54 +0100705 client->usage_count = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700706
707 client->dev.parent = &client->adapter->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700708 client->dev.bus = &i2c_bus_type;
David Brownell9c1600e2007-05-01 23:26:31 +0200709
710 if (client->driver)
711 client->dev.driver = &client->driver->driver;
712
David Brownellde81d2a2007-05-22 19:49:16 +0200713 if (client->driver && !is_newstyle_driver(client->driver)) {
David Brownell9c1600e2007-05-01 23:26:31 +0200714 client->dev.release = i2c_client_release;
David Brownellde81d2a2007-05-22 19:49:16 +0200715 client->dev.uevent_suppress = 1;
716 } else
David Brownell9c1600e2007-05-01 23:26:31 +0200717 client->dev.release = i2c_client_dev_release;
David Brownell438d6c22006-12-10 21:21:31 +0100718
Linus Torvalds1da177e2005-04-16 15:20:36 -0700719 snprintf(&client->dev.bus_id[0], sizeof(client->dev.bus_id),
720 "%d-%04x", i2c_adapter_id(adapter), client->addr);
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200721 dev_dbg(&adapter->dev, "client [%s] registered with bus id %s\n",
722 client->name, client->dev.bus_id);
Jean Delvareb119c6c2006-08-15 18:26:30 +0200723 res = device_register(&client->dev);
724 if (res)
725 goto out_list;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200726 mutex_unlock(&adapter->clist_lock);
Jean Delvare77ed74d2006-09-30 17:18:59 +0200727
728 if (adapter->client_register) {
729 if (adapter->client_register(client)) {
730 dev_dbg(&adapter->dev, "client_register "
731 "failed for client [%s] at 0x%02x\n",
732 client->name, client->addr);
733 }
734 }
735
736 return 0;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200737
Jean Delvareb119c6c2006-08-15 18:26:30 +0200738out_list:
739 list_del(&client->list);
740 dev_err(&adapter->dev, "Failed to attach i2c client %s at 0x%02x "
741 "(%d)\n", client->name, client->addr, res);
Jean Delvare77ed74d2006-09-30 17:18:59 +0200742out_unlock:
743 mutex_unlock(&adapter->clist_lock);
744 return res;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700745}
David Brownellc0564602007-05-01 23:26:31 +0200746EXPORT_SYMBOL(i2c_attach_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700747
748int i2c_detach_client(struct i2c_client *client)
749{
750 struct i2c_adapter *adapter = client->adapter;
751 int res = 0;
David Brownell438d6c22006-12-10 21:21:31 +0100752
Jean Delvarecde78592005-11-26 21:00:54 +0100753 if (client->usage_count > 0) {
Jean Delvare7bef5592005-07-27 22:14:49 +0200754 dev_warn(&client->dev, "Client [%s] still busy, "
755 "can't detach\n", client->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700756 return -EBUSY;
Jean Delvare7bef5592005-07-27 22:14:49 +0200757 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700758
759 if (adapter->client_unregister) {
760 res = adapter->client_unregister(client);
761 if (res) {
762 dev_err(&client->dev,
Jean Delvare86749e82005-07-29 12:15:29 -0700763 "client_unregister [%s] failed, "
764 "client not detached\n", client->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700765 goto out;
766 }
767 }
768
Ingo Molnar5c085d32006-01-18 23:16:04 +0100769 mutex_lock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700770 list_del(&client->list);
771 init_completion(&client->released);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700772 device_unregister(&client->dev);
Ingo Molnar5c085d32006-01-18 23:16:04 +0100773 mutex_unlock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700774 wait_for_completion(&client->released);
775
776 out:
777 return res;
778}
David Brownellc0564602007-05-01 23:26:31 +0200779EXPORT_SYMBOL(i2c_detach_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700780
781static int i2c_inc_use_client(struct i2c_client *client)
782{
783
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100784 if (!try_module_get(client->driver->driver.owner))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700785 return -ENODEV;
786 if (!try_module_get(client->adapter->owner)) {
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100787 module_put(client->driver->driver.owner);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700788 return -ENODEV;
789 }
790
791 return 0;
792}
793
794static void i2c_dec_use_client(struct i2c_client *client)
795{
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100796 module_put(client->driver->driver.owner);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700797 module_put(client->adapter->owner);
798}
799
800int i2c_use_client(struct i2c_client *client)
801{
802 int ret;
803
804 ret = i2c_inc_use_client(client);
805 if (ret)
806 return ret;
807
Jean Delvarecde78592005-11-26 21:00:54 +0100808 client->usage_count++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700809
810 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700811}
David Brownellc0564602007-05-01 23:26:31 +0200812EXPORT_SYMBOL(i2c_use_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700813
814int i2c_release_client(struct i2c_client *client)
815{
Jean Delvarecde78592005-11-26 21:00:54 +0100816 if (!client->usage_count) {
817 pr_debug("i2c-core: %s used one too many times\n",
818 __FUNCTION__);
819 return -EPERM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700820 }
David Brownell438d6c22006-12-10 21:21:31 +0100821
Jean Delvarecde78592005-11-26 21:00:54 +0100822 client->usage_count--;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700823 i2c_dec_use_client(client);
David Brownell438d6c22006-12-10 21:21:31 +0100824
Linus Torvalds1da177e2005-04-16 15:20:36 -0700825 return 0;
826}
David Brownellc0564602007-05-01 23:26:31 +0200827EXPORT_SYMBOL(i2c_release_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700828
829void i2c_clients_command(struct i2c_adapter *adap, unsigned int cmd, void *arg)
830{
831 struct list_head *item;
832 struct i2c_client *client;
833
Ingo Molnar5c085d32006-01-18 23:16:04 +0100834 mutex_lock(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700835 list_for_each(item,&adap->clients) {
836 client = list_entry(item, struct i2c_client, list);
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100837 if (!try_module_get(client->driver->driver.owner))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700838 continue;
839 if (NULL != client->driver->command) {
Ingo Molnar5c085d32006-01-18 23:16:04 +0100840 mutex_unlock(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700841 client->driver->command(client,cmd,arg);
Ingo Molnar5c085d32006-01-18 23:16:04 +0100842 mutex_lock(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700843 }
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100844 module_put(client->driver->driver.owner);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700845 }
Ingo Molnar5c085d32006-01-18 23:16:04 +0100846 mutex_unlock(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700847}
David Brownellc0564602007-05-01 23:26:31 +0200848EXPORT_SYMBOL(i2c_clients_command);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700849
850static int __init i2c_init(void)
851{
852 int retval;
853
854 retval = bus_register(&i2c_bus_type);
855 if (retval)
856 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700857 return class_register(&i2c_adapter_class);
858}
859
860static void __exit i2c_exit(void)
861{
862 class_unregister(&i2c_adapter_class);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700863 bus_unregister(&i2c_bus_type);
864}
865
866subsys_initcall(i2c_init);
867module_exit(i2c_exit);
868
869/* ----------------------------------------------------
870 * the functional interface to the i2c busses.
871 * ----------------------------------------------------
872 */
873
874int i2c_transfer(struct i2c_adapter * adap, struct i2c_msg *msgs, int num)
875{
876 int ret;
877
878 if (adap->algo->master_xfer) {
879#ifdef DEBUG
880 for (ret = 0; ret < num; ret++) {
881 dev_dbg(&adap->dev, "master_xfer[%d] %c, addr=0x%02x, "
Jean Delvare209d27c2007-05-01 23:26:29 +0200882 "len=%d%s\n", ret, (msgs[ret].flags & I2C_M_RD)
883 ? 'R' : 'W', msgs[ret].addr, msgs[ret].len,
884 (msgs[ret].flags & I2C_M_RECV_LEN) ? "+" : "");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700885 }
886#endif
887
Jiri Kosina6ea23032006-12-10 21:21:30 +0100888 mutex_lock_nested(&adap->bus_lock, adap->level);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700889 ret = adap->algo->master_xfer(adap,msgs,num);
Ingo Molnar5c085d32006-01-18 23:16:04 +0100890 mutex_unlock(&adap->bus_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700891
892 return ret;
893 } else {
894 dev_dbg(&adap->dev, "I2C level transfers not supported\n");
895 return -ENOSYS;
896 }
897}
David Brownellc0564602007-05-01 23:26:31 +0200898EXPORT_SYMBOL(i2c_transfer);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700899
900int i2c_master_send(struct i2c_client *client,const char *buf ,int count)
901{
902 int ret;
903 struct i2c_adapter *adap=client->adapter;
904 struct i2c_msg msg;
905
Jean Delvare815f55f2005-05-07 22:58:46 +0200906 msg.addr = client->addr;
907 msg.flags = client->flags & I2C_M_TEN;
908 msg.len = count;
909 msg.buf = (char *)buf;
David Brownell438d6c22006-12-10 21:21:31 +0100910
Jean Delvare815f55f2005-05-07 22:58:46 +0200911 ret = i2c_transfer(adap, &msg, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700912
Jean Delvare815f55f2005-05-07 22:58:46 +0200913 /* If everything went ok (i.e. 1 msg transmitted), return #bytes
914 transmitted, else error code. */
915 return (ret == 1) ? count : ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700916}
David Brownellc0564602007-05-01 23:26:31 +0200917EXPORT_SYMBOL(i2c_master_send);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700918
919int i2c_master_recv(struct i2c_client *client, char *buf ,int count)
920{
921 struct i2c_adapter *adap=client->adapter;
922 struct i2c_msg msg;
923 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700924
Jean Delvare815f55f2005-05-07 22:58:46 +0200925 msg.addr = client->addr;
926 msg.flags = client->flags & I2C_M_TEN;
927 msg.flags |= I2C_M_RD;
928 msg.len = count;
929 msg.buf = buf;
930
931 ret = i2c_transfer(adap, &msg, 1);
932
933 /* If everything went ok (i.e. 1 msg transmitted), return #bytes
934 transmitted, else error code. */
935 return (ret == 1) ? count : ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700936}
David Brownellc0564602007-05-01 23:26:31 +0200937EXPORT_SYMBOL(i2c_master_recv);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700938
939int i2c_control(struct i2c_client *client,
940 unsigned int cmd, unsigned long arg)
941{
942 int ret = 0;
943 struct i2c_adapter *adap = client->adapter;
944
945 dev_dbg(&client->adapter->dev, "i2c ioctl, cmd: 0x%x, arg: %#lx\n", cmd, arg);
946 switch (cmd) {
947 case I2C_RETRIES:
948 adap->retries = arg;
949 break;
950 case I2C_TIMEOUT:
951 adap->timeout = arg;
952 break;
953 default:
954 if (adap->algo->algo_control!=NULL)
955 ret = adap->algo->algo_control(adap,cmd,arg);
956 }
957 return ret;
958}
David Brownellc0564602007-05-01 23:26:31 +0200959EXPORT_SYMBOL(i2c_control);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700960
961/* ----------------------------------------------------
962 * the i2c address scanning function
963 * Will not work for 10-bit addresses!
964 * ----------------------------------------------------
965 */
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200966static int i2c_probe_address(struct i2c_adapter *adapter, int addr, int kind,
967 int (*found_proc) (struct i2c_adapter *, int, int))
Jean Delvare9fc6adf2005-07-31 21:20:43 +0200968{
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200969 int err;
Jean Delvare9fc6adf2005-07-31 21:20:43 +0200970
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200971 /* Make sure the address is valid */
972 if (addr < 0x03 || addr > 0x77) {
973 dev_warn(&adapter->dev, "Invalid probe address 0x%02x\n",
974 addr);
975 return -EINVAL;
Jean Delvare9fc6adf2005-07-31 21:20:43 +0200976 }
977
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200978 /* Skip if already in use */
979 if (i2c_check_addr(adapter, addr))
980 return 0;
981
982 /* Make sure there is something at this address, unless forced */
Jean Delvare4c9337d2005-08-09 20:28:10 +0200983 if (kind < 0) {
984 if (i2c_smbus_xfer(adapter, addr, 0, 0, 0,
985 I2C_SMBUS_QUICK, NULL) < 0)
986 return 0;
987
988 /* prevent 24RF08 corruption */
989 if ((addr & ~0x0f) == 0x50)
990 i2c_smbus_xfer(adapter, addr, 0, 0, 0,
991 I2C_SMBUS_QUICK, NULL);
992 }
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200993
994 /* Finally call the custom detection function */
995 err = found_proc(adapter, addr, kind);
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200996 /* -ENODEV can be returned if there is a chip at the given address
997 but it isn't supported by this chip driver. We catch it here as
998 this isn't an error. */
Jean Delvare114fd182006-09-03 22:25:04 +0200999 if (err == -ENODEV)
1000 err = 0;
1001
1002 if (err)
1003 dev_warn(&adapter->dev, "Client creation failed at 0x%x (%d)\n",
1004 addr, err);
1005 return err;
Jean Delvare9fc6adf2005-07-31 21:20:43 +02001006}
1007
Linus Torvalds1da177e2005-04-16 15:20:36 -07001008int i2c_probe(struct i2c_adapter *adapter,
1009 struct i2c_client_address_data *address_data,
1010 int (*found_proc) (struct i2c_adapter *, int, int))
1011{
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001012 int i, err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001013 int adap_id = i2c_adapter_id(adapter);
1014
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001015 /* Force entries are done first, and are not affected by ignore
1016 entries */
1017 if (address_data->forces) {
1018 unsigned short **forces = address_data->forces;
1019 int kind;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001020
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001021 for (kind = 0; forces[kind]; kind++) {
1022 for (i = 0; forces[kind][i] != I2C_CLIENT_END;
1023 i += 2) {
1024 if (forces[kind][i] == adap_id
1025 || forces[kind][i] == ANY_I2C_BUS) {
1026 dev_dbg(&adapter->dev, "found force "
1027 "parameter for adapter %d, "
1028 "addr 0x%02x, kind %d\n",
1029 adap_id, forces[kind][i + 1],
1030 kind);
1031 err = i2c_probe_address(adapter,
1032 forces[kind][i + 1],
1033 kind, found_proc);
1034 if (err)
1035 return err;
1036 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001037 }
1038 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001039 }
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001040
Jean Delvare4366dc92005-09-25 16:50:06 +02001041 /* Stop here if we can't use SMBUS_QUICK */
1042 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_QUICK)) {
1043 if (address_data->probe[0] == I2C_CLIENT_END
1044 && address_data->normal_i2c[0] == I2C_CLIENT_END)
David Brownell438d6c22006-12-10 21:21:31 +01001045 return 0;
Jean Delvare4366dc92005-09-25 16:50:06 +02001046
1047 dev_warn(&adapter->dev, "SMBus Quick command not supported, "
1048 "can't probe for chips\n");
1049 return -1;
1050 }
1051
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001052 /* Probe entries are done second, and are not affected by ignore
1053 entries either */
1054 for (i = 0; address_data->probe[i] != I2C_CLIENT_END; i += 2) {
1055 if (address_data->probe[i] == adap_id
1056 || address_data->probe[i] == ANY_I2C_BUS) {
1057 dev_dbg(&adapter->dev, "found probe parameter for "
1058 "adapter %d, addr 0x%02x\n", adap_id,
1059 address_data->probe[i + 1]);
1060 err = i2c_probe_address(adapter,
1061 address_data->probe[i + 1],
1062 -1, found_proc);
1063 if (err)
1064 return err;
1065 }
1066 }
1067
1068 /* Normal entries are done last, unless shadowed by an ignore entry */
1069 for (i = 0; address_data->normal_i2c[i] != I2C_CLIENT_END; i += 1) {
1070 int j, ignore;
1071
1072 ignore = 0;
1073 for (j = 0; address_data->ignore[j] != I2C_CLIENT_END;
1074 j += 2) {
1075 if ((address_data->ignore[j] == adap_id ||
1076 address_data->ignore[j] == ANY_I2C_BUS)
1077 && address_data->ignore[j + 1]
1078 == address_data->normal_i2c[i]) {
1079 dev_dbg(&adapter->dev, "found ignore "
1080 "parameter for adapter %d, "
1081 "addr 0x%02x\n", adap_id,
1082 address_data->ignore[j + 1]);
Mark M. Hoffman2369df92006-07-01 17:01:59 +02001083 ignore = 1;
1084 break;
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001085 }
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001086 }
1087 if (ignore)
1088 continue;
1089
1090 dev_dbg(&adapter->dev, "found normal entry for adapter %d, "
1091 "addr 0x%02x\n", adap_id,
1092 address_data->normal_i2c[i]);
1093 err = i2c_probe_address(adapter, address_data->normal_i2c[i],
1094 -1, found_proc);
1095 if (err)
1096 return err;
1097 }
1098
Linus Torvalds1da177e2005-04-16 15:20:36 -07001099 return 0;
1100}
David Brownellc0564602007-05-01 23:26:31 +02001101EXPORT_SYMBOL(i2c_probe);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001102
Jean Delvare12b5053a2007-05-01 23:26:31 +02001103struct i2c_client *
1104i2c_new_probed_device(struct i2c_adapter *adap,
1105 struct i2c_board_info *info,
1106 unsigned short const *addr_list)
1107{
1108 int i;
1109
1110 /* Stop here if the bus doesn't support probing */
1111 if (!i2c_check_functionality(adap, I2C_FUNC_SMBUS_READ_BYTE)) {
1112 dev_err(&adap->dev, "Probing not supported\n");
1113 return NULL;
1114 }
1115
1116 mutex_lock(&adap->clist_lock);
1117 for (i = 0; addr_list[i] != I2C_CLIENT_END; i++) {
1118 /* Check address validity */
1119 if (addr_list[i] < 0x03 || addr_list[i] > 0x77) {
1120 dev_warn(&adap->dev, "Invalid 7-bit address "
1121 "0x%02x\n", addr_list[i]);
1122 continue;
1123 }
1124
1125 /* Check address availability */
1126 if (__i2c_check_addr(adap, addr_list[i])) {
1127 dev_dbg(&adap->dev, "Address 0x%02x already in "
1128 "use, not probing\n", addr_list[i]);
1129 continue;
1130 }
1131
1132 /* Test address responsiveness
1133 The default probe method is a quick write, but it is known
1134 to corrupt the 24RF08 EEPROMs due to a state machine bug,
1135 and could also irreversibly write-protect some EEPROMs, so
1136 for address ranges 0x30-0x37 and 0x50-0x5f, we use a byte
1137 read instead. Also, some bus drivers don't implement
1138 quick write, so we fallback to a byte read it that case
1139 too. */
1140 if ((addr_list[i] & ~0x07) == 0x30
1141 || (addr_list[i] & ~0x0f) == 0x50
1142 || !i2c_check_functionality(adap, I2C_FUNC_SMBUS_QUICK)) {
1143 if (i2c_smbus_xfer(adap, addr_list[i], 0,
1144 I2C_SMBUS_READ, 0,
1145 I2C_SMBUS_BYTE, NULL) >= 0)
1146 break;
1147 } else {
1148 if (i2c_smbus_xfer(adap, addr_list[i], 0,
1149 I2C_SMBUS_WRITE, 0,
1150 I2C_SMBUS_QUICK, NULL) >= 0)
1151 break;
1152 }
1153 }
1154 mutex_unlock(&adap->clist_lock);
1155
1156 if (addr_list[i] == I2C_CLIENT_END) {
1157 dev_dbg(&adap->dev, "Probing failed, no device found\n");
1158 return NULL;
1159 }
1160
1161 info->addr = addr_list[i];
1162 return i2c_new_device(adap, info);
1163}
1164EXPORT_SYMBOL_GPL(i2c_new_probed_device);
1165
Linus Torvalds1da177e2005-04-16 15:20:36 -07001166struct i2c_adapter* i2c_get_adapter(int id)
1167{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001168 struct i2c_adapter *adapter;
David Brownell438d6c22006-12-10 21:21:31 +01001169
Arjan van de Venb3585e42006-01-11 10:50:26 +01001170 mutex_lock(&core_lists);
Mark M. Hoffmana0920e12005-06-28 00:21:30 -04001171 adapter = (struct i2c_adapter *)idr_find(&i2c_adapter_idr, id);
1172 if (adapter && !try_module_get(adapter->owner))
1173 adapter = NULL;
1174
Arjan van de Venb3585e42006-01-11 10:50:26 +01001175 mutex_unlock(&core_lists);
Mark M. Hoffmana0920e12005-06-28 00:21:30 -04001176 return adapter;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001177}
David Brownellc0564602007-05-01 23:26:31 +02001178EXPORT_SYMBOL(i2c_get_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001179
1180void i2c_put_adapter(struct i2c_adapter *adap)
1181{
1182 module_put(adap->owner);
1183}
David Brownellc0564602007-05-01 23:26:31 +02001184EXPORT_SYMBOL(i2c_put_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001185
1186/* The SMBus parts */
1187
David Brownell438d6c22006-12-10 21:21:31 +01001188#define POLY (0x1070U << 3)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001189static u8
1190crc8(u16 data)
1191{
1192 int i;
David Brownell438d6c22006-12-10 21:21:31 +01001193
Linus Torvalds1da177e2005-04-16 15:20:36 -07001194 for(i = 0; i < 8; i++) {
David Brownell438d6c22006-12-10 21:21:31 +01001195 if (data & 0x8000)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001196 data = data ^ POLY;
1197 data = data << 1;
1198 }
1199 return (u8)(data >> 8);
1200}
1201
Jean Delvare421ef472005-10-26 21:28:55 +02001202/* Incremental CRC8 over count bytes in the array pointed to by p */
1203static u8 i2c_smbus_pec(u8 crc, u8 *p, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001204{
1205 int i;
1206
1207 for(i = 0; i < count; i++)
Jean Delvare421ef472005-10-26 21:28:55 +02001208 crc = crc8((crc ^ p[i]) << 8);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001209 return crc;
1210}
1211
Jean Delvare421ef472005-10-26 21:28:55 +02001212/* Assume a 7-bit address, which is reasonable for SMBus */
1213static u8 i2c_smbus_msg_pec(u8 pec, struct i2c_msg *msg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001214{
Jean Delvare421ef472005-10-26 21:28:55 +02001215 /* The address will be sent first */
1216 u8 addr = (msg->addr << 1) | !!(msg->flags & I2C_M_RD);
1217 pec = i2c_smbus_pec(pec, &addr, 1);
1218
1219 /* The data buffer follows */
1220 return i2c_smbus_pec(pec, msg->buf, msg->len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001221}
1222
Jean Delvare421ef472005-10-26 21:28:55 +02001223/* Used for write only transactions */
1224static inline void i2c_smbus_add_pec(struct i2c_msg *msg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001225{
Jean Delvare421ef472005-10-26 21:28:55 +02001226 msg->buf[msg->len] = i2c_smbus_msg_pec(0, msg);
1227 msg->len++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001228}
1229
Jean Delvare421ef472005-10-26 21:28:55 +02001230/* Return <0 on CRC error
1231 If there was a write before this read (most cases) we need to take the
1232 partial CRC from the write part into account.
1233 Note that this function does modify the message (we need to decrease the
1234 message length to hide the CRC byte from the caller). */
1235static int i2c_smbus_check_pec(u8 cpec, struct i2c_msg *msg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001236{
Jean Delvare421ef472005-10-26 21:28:55 +02001237 u8 rpec = msg->buf[--msg->len];
1238 cpec = i2c_smbus_msg_pec(cpec, msg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001239
Linus Torvalds1da177e2005-04-16 15:20:36 -07001240 if (rpec != cpec) {
1241 pr_debug("i2c-core: Bad PEC 0x%02x vs. 0x%02x\n",
1242 rpec, cpec);
1243 return -1;
1244 }
David Brownell438d6c22006-12-10 21:21:31 +01001245 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001246}
1247
1248s32 i2c_smbus_write_quick(struct i2c_client *client, u8 value)
1249{
1250 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
David Brownell438d6c22006-12-10 21:21:31 +01001251 value,0,I2C_SMBUS_QUICK,NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001252}
David Brownellc0564602007-05-01 23:26:31 +02001253EXPORT_SYMBOL(i2c_smbus_write_quick);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001254
1255s32 i2c_smbus_read_byte(struct i2c_client *client)
1256{
1257 union i2c_smbus_data data;
1258 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1259 I2C_SMBUS_READ,0,I2C_SMBUS_BYTE, &data))
1260 return -1;
1261 else
Jean Delvare7eff82c2006-09-03 22:24:00 +02001262 return data.byte;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001263}
David Brownellc0564602007-05-01 23:26:31 +02001264EXPORT_SYMBOL(i2c_smbus_read_byte);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001265
1266s32 i2c_smbus_write_byte(struct i2c_client *client, u8 value)
1267{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001268 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
Jean Delvare421ef472005-10-26 21:28:55 +02001269 I2C_SMBUS_WRITE, value, I2C_SMBUS_BYTE, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001270}
David Brownellc0564602007-05-01 23:26:31 +02001271EXPORT_SYMBOL(i2c_smbus_write_byte);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001272
1273s32 i2c_smbus_read_byte_data(struct i2c_client *client, u8 command)
1274{
1275 union i2c_smbus_data data;
1276 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1277 I2C_SMBUS_READ,command, I2C_SMBUS_BYTE_DATA,&data))
1278 return -1;
1279 else
Jean Delvare7eff82c2006-09-03 22:24:00 +02001280 return data.byte;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001281}
David Brownellc0564602007-05-01 23:26:31 +02001282EXPORT_SYMBOL(i2c_smbus_read_byte_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001283
1284s32 i2c_smbus_write_byte_data(struct i2c_client *client, u8 command, u8 value)
1285{
1286 union i2c_smbus_data data;
1287 data.byte = value;
1288 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1289 I2C_SMBUS_WRITE,command,
1290 I2C_SMBUS_BYTE_DATA,&data);
1291}
David Brownellc0564602007-05-01 23:26:31 +02001292EXPORT_SYMBOL(i2c_smbus_write_byte_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001293
1294s32 i2c_smbus_read_word_data(struct i2c_client *client, u8 command)
1295{
1296 union i2c_smbus_data data;
1297 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1298 I2C_SMBUS_READ,command, I2C_SMBUS_WORD_DATA, &data))
1299 return -1;
1300 else
Jean Delvare7eff82c2006-09-03 22:24:00 +02001301 return data.word;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001302}
David Brownellc0564602007-05-01 23:26:31 +02001303EXPORT_SYMBOL(i2c_smbus_read_word_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001304
1305s32 i2c_smbus_write_word_data(struct i2c_client *client, u8 command, u16 value)
1306{
1307 union i2c_smbus_data data;
1308 data.word = value;
1309 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1310 I2C_SMBUS_WRITE,command,
1311 I2C_SMBUS_WORD_DATA,&data);
1312}
David Brownellc0564602007-05-01 23:26:31 +02001313EXPORT_SYMBOL(i2c_smbus_write_word_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001314
Jean Delvareb86a1bc2007-05-01 23:26:34 +02001315/* Returns the number of read bytes */
1316s32 i2c_smbus_read_block_data(struct i2c_client *client, u8 command,
1317 u8 *values)
1318{
1319 union i2c_smbus_data data;
1320
1321 if (i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1322 I2C_SMBUS_READ, command,
1323 I2C_SMBUS_BLOCK_DATA, &data))
1324 return -1;
1325
1326 memcpy(values, &data.block[1], data.block[0]);
1327 return data.block[0];
1328}
1329EXPORT_SYMBOL(i2c_smbus_read_block_data);
1330
Linus Torvalds1da177e2005-04-16 15:20:36 -07001331s32 i2c_smbus_write_block_data(struct i2c_client *client, u8 command,
Krzysztof Halasa46f5ed72006-06-12 21:42:20 +02001332 u8 length, const u8 *values)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001333{
1334 union i2c_smbus_data data;
Jean Delvare76560322006-01-18 23:14:55 +01001335
Linus Torvalds1da177e2005-04-16 15:20:36 -07001336 if (length > I2C_SMBUS_BLOCK_MAX)
1337 length = I2C_SMBUS_BLOCK_MAX;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001338 data.block[0] = length;
Jean Delvare76560322006-01-18 23:14:55 +01001339 memcpy(&data.block[1], values, length);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001340 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1341 I2C_SMBUS_WRITE,command,
1342 I2C_SMBUS_BLOCK_DATA,&data);
1343}
David Brownellc0564602007-05-01 23:26:31 +02001344EXPORT_SYMBOL(i2c_smbus_write_block_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001345
1346/* Returns the number of read bytes */
1347s32 i2c_smbus_read_i2c_block_data(struct i2c_client *client, u8 command, u8 *values)
1348{
1349 union i2c_smbus_data data;
Jean Delvare76560322006-01-18 23:14:55 +01001350
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 Delvare30dac742005-10-08 00:15:59 +02001471 msg[1].len = I2C_SMBUS_BLOCK_MAX;
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:
1527 /* fixed at 32 for now */
Jean Delvare30dac742005-10-08 00:15:59 +02001528 data->block[0] = I2C_SMBUS_BLOCK_MAX;
1529 for (i = 0; i < I2C_SMBUS_BLOCK_MAX; i++)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001530 data->block[i+1] = msgbuf1[i];
1531 break;
Jean Delvare209d27c2007-05-01 23:26:29 +02001532 case I2C_SMBUS_BLOCK_DATA:
1533 case I2C_SMBUS_BLOCK_PROC_CALL:
1534 for (i = 0; i < msgbuf1[0] + 1; i++)
1535 data->block[i] = msgbuf1[i];
1536 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001537 }
1538 return 0;
1539}
1540
1541
1542s32 i2c_smbus_xfer(struct i2c_adapter * adapter, u16 addr, unsigned short flags,
David Brownell438d6c22006-12-10 21:21:31 +01001543 char read_write, u8 command, int size,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001544 union i2c_smbus_data * data)
1545{
1546 s32 res;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001547
1548 flags &= I2C_M_TEN | I2C_CLIENT_PEC;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001549
1550 if (adapter->algo->smbus_xfer) {
Ingo Molnar5c085d32006-01-18 23:16:04 +01001551 mutex_lock(&adapter->bus_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001552 res = adapter->algo->smbus_xfer(adapter,addr,flags,read_write,
1553 command,size,data);
Ingo Molnar5c085d32006-01-18 23:16:04 +01001554 mutex_unlock(&adapter->bus_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001555 } else
1556 res = i2c_smbus_xfer_emulated(adapter,addr,flags,read_write,
1557 command,size,data);
1558
Linus Torvalds1da177e2005-04-16 15:20:36 -07001559 return res;
1560}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001561EXPORT_SYMBOL(i2c_smbus_xfer);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001562
1563MODULE_AUTHOR("Simon G. Vogl <simon@tk.uni-linz.ac.at>");
1564MODULE_DESCRIPTION("I2C-Bus main module");
1565MODULE_LICENSE("GPL");