blob: 910a62de190d4e00e5320fcfaa5a8b1c2d26c9a6 [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;
229 client->flags = info->flags;
230 client->addr = info->addr;
231 client->irq = info->irq;
232
233 strlcpy(client->driver_name, info->driver_name,
234 sizeof(client->driver_name));
235 strlcpy(client->name, info->type, sizeof(client->name));
236
237 /* a new style driver may be bound to this device when we
238 * return from this function, or any later moment (e.g. maybe
239 * hotplugging will load the driver module). and the device
240 * refcount model is the standard driver model one.
241 */
242 status = i2c_attach_client(client);
243 if (status < 0) {
244 kfree(client);
245 client = NULL;
246 }
247 return client;
248}
249EXPORT_SYMBOL_GPL(i2c_new_device);
250
251
252/**
253 * i2c_unregister_device - reverse effect of i2c_new_device()
254 * @client: value returned from i2c_new_device()
David Brownelld64f73b2007-07-12 14:12:28 +0200255 * Context: can sleep
David Brownell9c1600e2007-05-01 23:26:31 +0200256 */
257void i2c_unregister_device(struct i2c_client *client)
David Brownella1d9e6e2007-05-01 23:26:30 +0200258{
259 struct i2c_adapter *adapter = client->adapter;
260 struct i2c_driver *driver = client->driver;
261
262 if (driver && !is_newstyle_driver(driver)) {
263 dev_err(&client->dev, "can't unregister devices "
264 "with legacy drivers\n");
265 WARN_ON(1);
266 return;
267 }
268
269 mutex_lock(&adapter->clist_lock);
270 list_del(&client->list);
271 mutex_unlock(&adapter->clist_lock);
272
273 device_unregister(&client->dev);
274}
David Brownell9c1600e2007-05-01 23:26:31 +0200275EXPORT_SYMBOL_GPL(i2c_unregister_device);
David Brownella1d9e6e2007-05-01 23:26:30 +0200276
277
David Brownellf37dd802007-02-13 22:09:00 +0100278/* ------------------------------------------------------------------------- */
279
David Brownell16ffadf2007-05-01 23:26:28 +0200280/* I2C bus adapters -- one roots each I2C or SMBUS segment */
281
Jean Delvareefde7232005-07-20 23:03:50 +0200282void i2c_adapter_dev_release(struct device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700283{
David Brownellef2c83212007-05-01 23:26:28 +0200284 struct i2c_adapter *adap = to_i2c_adapter(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700285 complete(&adap->dev_released);
286}
287
David Brownell16ffadf2007-05-01 23:26:28 +0200288static ssize_t
289show_adapter_name(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700290{
David Brownellef2c83212007-05-01 23:26:28 +0200291 struct i2c_adapter *adap = to_i2c_adapter(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700292 return sprintf(buf, "%s\n", adap->name);
293}
David Brownell16ffadf2007-05-01 23:26:28 +0200294
295static struct device_attribute i2c_adapter_attrs[] = {
296 __ATTR(name, S_IRUGO, show_adapter_name, NULL),
297 { },
298};
299
300struct class i2c_adapter_class = {
301 .owner = THIS_MODULE,
302 .name = "i2c-adapter",
303 .dev_attrs = i2c_adapter_attrs,
304};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700305
David Brownell9c1600e2007-05-01 23:26:31 +0200306static void i2c_scan_static_board_info(struct i2c_adapter *adapter)
307{
308 struct i2c_devinfo *devinfo;
309
310 mutex_lock(&__i2c_board_lock);
311 list_for_each_entry(devinfo, &__i2c_board_list, list) {
312 if (devinfo->busnum == adapter->nr
313 && !i2c_new_device(adapter,
314 &devinfo->board_info))
315 printk(KERN_ERR "i2c-core: can't create i2c%d-%04x\n",
316 i2c_adapter_id(adapter),
317 devinfo->board_info.addr);
318 }
319 mutex_unlock(&__i2c_board_lock);
320}
321
David Brownell6e13e642007-05-01 23:26:31 +0200322static int i2c_register_adapter(struct i2c_adapter *adap)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700323{
David Brownell6e13e642007-05-01 23:26:31 +0200324 int res = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700325 struct list_head *item;
326 struct i2c_driver *driver;
327
Ingo Molnar5c085d32006-01-18 23:16:04 +0100328 mutex_init(&adap->bus_lock);
329 mutex_init(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700330 INIT_LIST_HEAD(&adap->clients);
331
David Brownell6e13e642007-05-01 23:26:31 +0200332 mutex_lock(&core_lists);
333 list_add_tail(&adap->list, &adapters);
334
Linus Torvalds1da177e2005-04-16 15:20:36 -0700335 /* Add the adapter to the driver core.
336 * If the parent pointer is not set up,
337 * we add this adapter to the host bus.
338 */
David Brownellb119dc32007-01-04 13:07:04 +0100339 if (adap->dev.parent == NULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700340 adap->dev.parent = &platform_bus;
Jean Delvarefe2c8d52007-02-13 22:09:04 +0100341 pr_debug("I2C adapter driver [%s] forgot to specify "
342 "physical device\n", adap->name);
David Brownellb119dc32007-01-04 13:07:04 +0100343 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700344 sprintf(adap->dev.bus_id, "i2c-%d", adap->nr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700345 adap->dev.release = &i2c_adapter_dev_release;
Jean Delvarefccb56e2007-05-01 23:26:27 +0200346 adap->dev.class = &i2c_adapter_class;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200347 res = device_register(&adap->dev);
348 if (res)
349 goto out_list;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700350
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200351 dev_dbg(&adap->dev, "adapter [%s] registered\n", adap->name);
352
David Brownell6e13e642007-05-01 23:26:31 +0200353 /* create pre-declared device nodes for new-style drivers */
354 if (adap->nr < __i2c_first_dynamic_bus_num)
355 i2c_scan_static_board_info(adap);
356
David Brownell7b4fbc52007-05-01 23:26:30 +0200357 /* let legacy drivers scan this bus for matching devices */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700358 list_for_each(item,&drivers) {
359 driver = list_entry(item, struct i2c_driver, list);
Jean Delvare8a994752005-11-26 20:28:06 +0100360 if (driver->attach_adapter)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700361 /* We ignore the return code; if it fails, too bad */
362 driver->attach_adapter(adap);
363 }
364
Linus Torvalds1da177e2005-04-16 15:20:36 -0700365out_unlock:
Arjan van de Venb3585e42006-01-11 10:50:26 +0100366 mutex_unlock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700367 return res;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200368
Jean Delvareb119c6c2006-08-15 18:26:30 +0200369out_list:
370 list_del(&adap->list);
371 idr_remove(&i2c_adapter_idr, adap->nr);
372 goto out_unlock;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700373}
374
David Brownell6e13e642007-05-01 23:26:31 +0200375/**
376 * i2c_add_adapter - declare i2c adapter, use dynamic bus number
377 * @adapter: the adapter to add
David Brownelld64f73b2007-07-12 14:12:28 +0200378 * Context: can sleep
David Brownell6e13e642007-05-01 23:26:31 +0200379 *
380 * This routine is used to declare an I2C adapter when its bus number
381 * doesn't matter. Examples: for I2C adapters dynamically added by
382 * USB links or PCI plugin cards.
383 *
384 * When this returns zero, a new bus number was allocated and stored
385 * in adap->nr, and the specified adapter became available for clients.
386 * Otherwise, a negative errno value is returned.
387 */
388int i2c_add_adapter(struct i2c_adapter *adapter)
389{
390 int id, res = 0;
391
392retry:
393 if (idr_pre_get(&i2c_adapter_idr, GFP_KERNEL) == 0)
394 return -ENOMEM;
395
396 mutex_lock(&core_lists);
397 /* "above" here means "above or equal to", sigh */
398 res = idr_get_new_above(&i2c_adapter_idr, adapter,
399 __i2c_first_dynamic_bus_num, &id);
400 mutex_unlock(&core_lists);
401
402 if (res < 0) {
403 if (res == -EAGAIN)
404 goto retry;
405 return res;
406 }
407
408 adapter->nr = id;
409 return i2c_register_adapter(adapter);
410}
411EXPORT_SYMBOL(i2c_add_adapter);
412
413/**
414 * i2c_add_numbered_adapter - declare i2c adapter, use static bus number
415 * @adap: the adapter to register (with adap->nr initialized)
David Brownelld64f73b2007-07-12 14:12:28 +0200416 * Context: can sleep
David Brownell6e13e642007-05-01 23:26:31 +0200417 *
418 * This routine is used to declare an I2C adapter when its bus number
419 * matters. Example: for I2C adapters from system-on-chip CPUs, or
420 * otherwise built in to the system's mainboard, and where i2c_board_info
421 * is used to properly configure I2C devices.
422 *
423 * If no devices have pre-been declared for this bus, then be sure to
424 * register the adapter before any dynamically allocated ones. Otherwise
425 * the required bus ID may not be available.
426 *
427 * When this returns zero, the specified adapter became available for
428 * clients using the bus number provided in adap->nr. Also, the table
429 * of I2C devices pre-declared using i2c_register_board_info() is scanned,
430 * and the appropriate driver model device nodes are created. Otherwise, a
431 * negative errno value is returned.
432 */
433int i2c_add_numbered_adapter(struct i2c_adapter *adap)
434{
435 int id;
436 int status;
437
438 if (adap->nr & ~MAX_ID_MASK)
439 return -EINVAL;
440
441retry:
442 if (idr_pre_get(&i2c_adapter_idr, GFP_KERNEL) == 0)
443 return -ENOMEM;
444
445 mutex_lock(&core_lists);
446 /* "above" here means "above or equal to", sigh;
447 * we need the "equal to" result to force the result
448 */
449 status = idr_get_new_above(&i2c_adapter_idr, adap, adap->nr, &id);
450 if (status == 0 && id != adap->nr) {
451 status = -EBUSY;
452 idr_remove(&i2c_adapter_idr, id);
453 }
454 mutex_unlock(&core_lists);
455 if (status == -EAGAIN)
456 goto retry;
457
458 if (status == 0)
459 status = i2c_register_adapter(adap);
460 return status;
461}
462EXPORT_SYMBOL_GPL(i2c_add_numbered_adapter);
463
David Brownelld64f73b2007-07-12 14:12:28 +0200464/**
465 * i2c_del_adapter - unregister I2C adapter
466 * @adap: the adapter being unregistered
467 * Context: can sleep
468 *
469 * This unregisters an I2C adapter which was previously registered
470 * by @i2c_add_adapter or @i2c_add_numbered_adapter.
471 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700472int i2c_del_adapter(struct i2c_adapter *adap)
473{
474 struct list_head *item, *_n;
475 struct i2c_adapter *adap_from_list;
476 struct i2c_driver *driver;
477 struct i2c_client *client;
478 int res = 0;
479
Arjan van de Venb3585e42006-01-11 10:50:26 +0100480 mutex_lock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700481
482 /* First make sure that this adapter was ever added */
483 list_for_each_entry(adap_from_list, &adapters, list) {
484 if (adap_from_list == adap)
485 break;
486 }
487 if (adap_from_list != adap) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200488 pr_debug("i2c-core: attempting to delete unregistered "
489 "adapter [%s]\n", adap->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700490 res = -EINVAL;
491 goto out_unlock;
492 }
493
494 list_for_each(item,&drivers) {
495 driver = list_entry(item, struct i2c_driver, list);
496 if (driver->detach_adapter)
497 if ((res = driver->detach_adapter(adap))) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200498 dev_err(&adap->dev, "detach_adapter failed "
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100499 "for driver [%s]\n",
500 driver->driver.name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700501 goto out_unlock;
502 }
503 }
504
505 /* detach any active clients. This must be done first, because
Tobias Klausera551acc2005-05-19 21:40:38 +0200506 * it can fail; in which case we give up. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700507 list_for_each_safe(item, _n, &adap->clients) {
David Brownella1d9e6e2007-05-01 23:26:30 +0200508 struct i2c_driver *driver;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700509
David Brownella1d9e6e2007-05-01 23:26:30 +0200510 client = list_entry(item, struct i2c_client, list);
511 driver = client->driver;
512
513 /* new style, follow standard driver model */
514 if (!driver || is_newstyle_driver(driver)) {
515 i2c_unregister_device(client);
516 continue;
517 }
518
519 /* legacy drivers create and remove clients themselves */
520 if ((res = driver->detach_client(client))) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200521 dev_err(&adap->dev, "detach_client failed for client "
522 "[%s] at address 0x%02x\n", client->name,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700523 client->addr);
524 goto out_unlock;
525 }
526 }
527
528 /* clean up the sysfs representation */
529 init_completion(&adap->dev_released);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700530 device_unregister(&adap->dev);
531 list_del(&adap->list);
532
533 /* wait for sysfs to drop all references */
534 wait_for_completion(&adap->dev_released);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535
David Brownell6e13e642007-05-01 23:26:31 +0200536 /* free bus id */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700537 idr_remove(&i2c_adapter_idr, adap->nr);
538
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200539 dev_dbg(&adap->dev, "adapter [%s] unregistered\n", adap->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700540
541 out_unlock:
Arjan van de Venb3585e42006-01-11 10:50:26 +0100542 mutex_unlock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700543 return res;
544}
David Brownellc0564602007-05-01 23:26:31 +0200545EXPORT_SYMBOL(i2c_del_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700546
547
David Brownell7b4fbc52007-05-01 23:26:30 +0200548/* ------------------------------------------------------------------------- */
549
550/*
551 * An i2c_driver is used with one or more i2c_client (device) nodes to access
552 * i2c slave chips, on a bus instance associated with some i2c_adapter. There
553 * are two models for binding the driver to its device: "new style" drivers
554 * follow the standard Linux driver model and just respond to probe() calls
555 * issued if the driver core sees they match(); "legacy" drivers create device
556 * nodes themselves.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700557 */
558
Greg Kroah-Hartmande59cf92005-12-06 15:33:15 -0800559int i2c_register_driver(struct module *owner, struct i2c_driver *driver)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700560{
Jean Delvare7eebcb72006-02-05 23:28:21 +0100561 int res;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700562
David Brownell7b4fbc52007-05-01 23:26:30 +0200563 /* new style driver methods can't mix with legacy ones */
David Brownella1d9e6e2007-05-01 23:26:30 +0200564 if (is_newstyle_driver(driver)) {
David Brownell7b4fbc52007-05-01 23:26:30 +0200565 if (driver->attach_adapter || driver->detach_adapter
566 || driver->detach_client) {
567 printk(KERN_WARNING
568 "i2c-core: driver [%s] is confused\n",
569 driver->driver.name);
570 return -EINVAL;
571 }
572 }
573
Linus Torvalds1da177e2005-04-16 15:20:36 -0700574 /* add the driver to the list of i2c drivers in the driver core */
Greg Kroah-Hartmande59cf92005-12-06 15:33:15 -0800575 driver->driver.owner = owner;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700576 driver->driver.bus = &i2c_bus_type;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700577
David Brownell6e13e642007-05-01 23:26:31 +0200578 /* for new style drivers, when registration returns the driver core
579 * will have called probe() for all matching-but-unbound devices.
580 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700581 res = driver_register(&driver->driver);
582 if (res)
Jean Delvare7eebcb72006-02-05 23:28:21 +0100583 return res;
David Brownell438d6c22006-12-10 21:21:31 +0100584
Jean Delvare7eebcb72006-02-05 23:28:21 +0100585 mutex_lock(&core_lists);
586
Linus Torvalds1da177e2005-04-16 15:20:36 -0700587 list_add_tail(&driver->list,&drivers);
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100588 pr_debug("i2c-core: driver [%s] registered\n", driver->driver.name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700589
David Brownell7b4fbc52007-05-01 23:26:30 +0200590 /* legacy drivers scan i2c busses directly */
Jean Delvare8a994752005-11-26 20:28:06 +0100591 if (driver->attach_adapter) {
David Brownell4ad4eac2007-05-01 23:26:28 +0200592 struct i2c_adapter *adapter;
593
594 list_for_each_entry(adapter, &adapters, list) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700595 driver->attach_adapter(adapter);
596 }
597 }
598
Arjan van de Venb3585e42006-01-11 10:50:26 +0100599 mutex_unlock(&core_lists);
Jean Delvare7eebcb72006-02-05 23:28:21 +0100600 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700601}
Greg Kroah-Hartmande59cf92005-12-06 15:33:15 -0800602EXPORT_SYMBOL(i2c_register_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700603
David Brownella1d9e6e2007-05-01 23:26:30 +0200604/**
605 * i2c_del_driver - unregister I2C driver
606 * @driver: the driver being unregistered
David Brownelld64f73b2007-07-12 14:12:28 +0200607 * Context: can sleep
David Brownella1d9e6e2007-05-01 23:26:30 +0200608 */
Jean Delvareb3e82092007-05-01 23:26:32 +0200609void i2c_del_driver(struct i2c_driver *driver)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700610{
611 struct list_head *item1, *item2, *_n;
612 struct i2c_client *client;
613 struct i2c_adapter *adap;
David Brownell438d6c22006-12-10 21:21:31 +0100614
Arjan van de Venb3585e42006-01-11 10:50:26 +0100615 mutex_lock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700616
David Brownella1d9e6e2007-05-01 23:26:30 +0200617 /* new-style driver? */
618 if (is_newstyle_driver(driver))
619 goto unregister;
620
Linus Torvalds1da177e2005-04-16 15:20:36 -0700621 /* Have a look at each adapter, if clients of this driver are still
David Brownell438d6c22006-12-10 21:21:31 +0100622 * attached. If so, detach them to be able to kill the driver
Linus Torvalds1da177e2005-04-16 15:20:36 -0700623 * afterwards.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700624 */
625 list_for_each(item1,&adapters) {
626 adap = list_entry(item1, struct i2c_adapter, list);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700627 if (driver->detach_adapter) {
Jean Delvareb3e82092007-05-01 23:26:32 +0200628 if (driver->detach_adapter(adap)) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200629 dev_err(&adap->dev, "detach_adapter failed "
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100630 "for driver [%s]\n",
631 driver->driver.name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700632 }
633 } else {
634 list_for_each_safe(item2, _n, &adap->clients) {
635 client = list_entry(item2, struct i2c_client, list);
636 if (client->driver != driver)
637 continue;
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200638 dev_dbg(&adap->dev, "detaching client [%s] "
639 "at 0x%02x\n", client->name,
640 client->addr);
Jean Delvareb3e82092007-05-01 23:26:32 +0200641 if (driver->detach_client(client)) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200642 dev_err(&adap->dev, "detach_client "
643 "failed for client [%s] at "
644 "0x%02x\n", client->name,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700645 client->addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700646 }
647 }
648 }
649 }
650
David Brownella1d9e6e2007-05-01 23:26:30 +0200651 unregister:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700652 driver_unregister(&driver->driver);
653 list_del(&driver->list);
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100654 pr_debug("i2c-core: driver [%s] unregistered\n", driver->driver.name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700655
Arjan van de Venb3585e42006-01-11 10:50:26 +0100656 mutex_unlock(&core_lists);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700657}
David Brownellc0564602007-05-01 23:26:31 +0200658EXPORT_SYMBOL(i2c_del_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700659
David Brownell7b4fbc52007-05-01 23:26:30 +0200660/* ------------------------------------------------------------------------- */
661
Linus Torvalds1da177e2005-04-16 15:20:36 -0700662static int __i2c_check_addr(struct i2c_adapter *adapter, unsigned int addr)
663{
664 struct list_head *item;
665 struct i2c_client *client;
666
667 list_for_each(item,&adapter->clients) {
668 client = list_entry(item, struct i2c_client, list);
669 if (client->addr == addr)
670 return -EBUSY;
671 }
672 return 0;
673}
674
675int i2c_check_addr(struct i2c_adapter *adapter, int addr)
676{
677 int rval;
678
Ingo Molnar5c085d32006-01-18 23:16:04 +0100679 mutex_lock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700680 rval = __i2c_check_addr(adapter, addr);
Ingo Molnar5c085d32006-01-18 23:16:04 +0100681 mutex_unlock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700682
683 return rval;
684}
David Brownellc0564602007-05-01 23:26:31 +0200685EXPORT_SYMBOL(i2c_check_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700686
687int i2c_attach_client(struct i2c_client *client)
688{
689 struct i2c_adapter *adapter = client->adapter;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200690 int res = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700691
Ingo Molnar5c085d32006-01-18 23:16:04 +0100692 mutex_lock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700693 if (__i2c_check_addr(client->adapter, client->addr)) {
Jean Delvareb119c6c2006-08-15 18:26:30 +0200694 res = -EBUSY;
695 goto out_unlock;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700696 }
697 list_add_tail(&client->list,&adapter->clients);
David Brownell438d6c22006-12-10 21:21:31 +0100698
Jean Delvarecde78592005-11-26 21:00:54 +0100699 client->usage_count = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700700
701 client->dev.parent = &client->adapter->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702 client->dev.bus = &i2c_bus_type;
David Brownell9c1600e2007-05-01 23:26:31 +0200703
704 if (client->driver)
705 client->dev.driver = &client->driver->driver;
706
David Brownellde81d2a2007-05-22 19:49:16 +0200707 if (client->driver && !is_newstyle_driver(client->driver)) {
David Brownell9c1600e2007-05-01 23:26:31 +0200708 client->dev.release = i2c_client_release;
David Brownellde81d2a2007-05-22 19:49:16 +0200709 client->dev.uevent_suppress = 1;
710 } else
David Brownell9c1600e2007-05-01 23:26:31 +0200711 client->dev.release = i2c_client_dev_release;
David Brownell438d6c22006-12-10 21:21:31 +0100712
Linus Torvalds1da177e2005-04-16 15:20:36 -0700713 snprintf(&client->dev.bus_id[0], sizeof(client->dev.bus_id),
714 "%d-%04x", i2c_adapter_id(adapter), client->addr);
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200715 dev_dbg(&adapter->dev, "client [%s] registered with bus id %s\n",
716 client->name, client->dev.bus_id);
Jean Delvareb119c6c2006-08-15 18:26:30 +0200717 res = device_register(&client->dev);
718 if (res)
719 goto out_list;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200720 mutex_unlock(&adapter->clist_lock);
Jean Delvare77ed74d2006-09-30 17:18:59 +0200721
722 if (adapter->client_register) {
723 if (adapter->client_register(client)) {
724 dev_dbg(&adapter->dev, "client_register "
725 "failed for client [%s] at 0x%02x\n",
726 client->name, client->addr);
727 }
728 }
729
730 return 0;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200731
Jean Delvareb119c6c2006-08-15 18:26:30 +0200732out_list:
733 list_del(&client->list);
734 dev_err(&adapter->dev, "Failed to attach i2c client %s at 0x%02x "
735 "(%d)\n", client->name, client->addr, res);
Jean Delvare77ed74d2006-09-30 17:18:59 +0200736out_unlock:
737 mutex_unlock(&adapter->clist_lock);
738 return res;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700739}
David Brownellc0564602007-05-01 23:26:31 +0200740EXPORT_SYMBOL(i2c_attach_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700741
742int i2c_detach_client(struct i2c_client *client)
743{
744 struct i2c_adapter *adapter = client->adapter;
745 int res = 0;
David Brownell438d6c22006-12-10 21:21:31 +0100746
Jean Delvarecde78592005-11-26 21:00:54 +0100747 if (client->usage_count > 0) {
Jean Delvare7bef5592005-07-27 22:14:49 +0200748 dev_warn(&client->dev, "Client [%s] still busy, "
749 "can't detach\n", client->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700750 return -EBUSY;
Jean Delvare7bef5592005-07-27 22:14:49 +0200751 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700752
753 if (adapter->client_unregister) {
754 res = adapter->client_unregister(client);
755 if (res) {
756 dev_err(&client->dev,
Jean Delvare86749e82005-07-29 12:15:29 -0700757 "client_unregister [%s] failed, "
758 "client not detached\n", client->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700759 goto out;
760 }
761 }
762
Ingo Molnar5c085d32006-01-18 23:16:04 +0100763 mutex_lock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700764 list_del(&client->list);
765 init_completion(&client->released);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700766 device_unregister(&client->dev);
Ingo Molnar5c085d32006-01-18 23:16:04 +0100767 mutex_unlock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700768 wait_for_completion(&client->released);
769
770 out:
771 return res;
772}
David Brownellc0564602007-05-01 23:26:31 +0200773EXPORT_SYMBOL(i2c_detach_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700774
775static int i2c_inc_use_client(struct i2c_client *client)
776{
777
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100778 if (!try_module_get(client->driver->driver.owner))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700779 return -ENODEV;
780 if (!try_module_get(client->adapter->owner)) {
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100781 module_put(client->driver->driver.owner);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700782 return -ENODEV;
783 }
784
785 return 0;
786}
787
788static void i2c_dec_use_client(struct i2c_client *client)
789{
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100790 module_put(client->driver->driver.owner);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700791 module_put(client->adapter->owner);
792}
793
794int i2c_use_client(struct i2c_client *client)
795{
796 int ret;
797
798 ret = i2c_inc_use_client(client);
799 if (ret)
800 return ret;
801
Jean Delvarecde78592005-11-26 21:00:54 +0100802 client->usage_count++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700803
804 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700805}
David Brownellc0564602007-05-01 23:26:31 +0200806EXPORT_SYMBOL(i2c_use_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700807
808int i2c_release_client(struct i2c_client *client)
809{
Jean Delvarecde78592005-11-26 21:00:54 +0100810 if (!client->usage_count) {
811 pr_debug("i2c-core: %s used one too many times\n",
812 __FUNCTION__);
813 return -EPERM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700814 }
David Brownell438d6c22006-12-10 21:21:31 +0100815
Jean Delvarecde78592005-11-26 21:00:54 +0100816 client->usage_count--;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700817 i2c_dec_use_client(client);
David Brownell438d6c22006-12-10 21:21:31 +0100818
Linus Torvalds1da177e2005-04-16 15:20:36 -0700819 return 0;
820}
David Brownellc0564602007-05-01 23:26:31 +0200821EXPORT_SYMBOL(i2c_release_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700822
823void i2c_clients_command(struct i2c_adapter *adap, unsigned int cmd, void *arg)
824{
825 struct list_head *item;
826 struct i2c_client *client;
827
Ingo Molnar5c085d32006-01-18 23:16:04 +0100828 mutex_lock(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700829 list_for_each(item,&adap->clients) {
830 client = list_entry(item, struct i2c_client, list);
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100831 if (!try_module_get(client->driver->driver.owner))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700832 continue;
833 if (NULL != client->driver->command) {
Ingo Molnar5c085d32006-01-18 23:16:04 +0100834 mutex_unlock(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700835 client->driver->command(client,cmd,arg);
Ingo Molnar5c085d32006-01-18 23:16:04 +0100836 mutex_lock(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700837 }
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100838 module_put(client->driver->driver.owner);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700839 }
Ingo Molnar5c085d32006-01-18 23:16:04 +0100840 mutex_unlock(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700841}
David Brownellc0564602007-05-01 23:26:31 +0200842EXPORT_SYMBOL(i2c_clients_command);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700843
844static int __init i2c_init(void)
845{
846 int retval;
847
848 retval = bus_register(&i2c_bus_type);
849 if (retval)
850 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700851 return class_register(&i2c_adapter_class);
852}
853
854static void __exit i2c_exit(void)
855{
856 class_unregister(&i2c_adapter_class);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700857 bus_unregister(&i2c_bus_type);
858}
859
860subsys_initcall(i2c_init);
861module_exit(i2c_exit);
862
863/* ----------------------------------------------------
864 * the functional interface to the i2c busses.
865 * ----------------------------------------------------
866 */
867
868int i2c_transfer(struct i2c_adapter * adap, struct i2c_msg *msgs, int num)
869{
870 int ret;
871
872 if (adap->algo->master_xfer) {
873#ifdef DEBUG
874 for (ret = 0; ret < num; ret++) {
875 dev_dbg(&adap->dev, "master_xfer[%d] %c, addr=0x%02x, "
Jean Delvare209d27c2007-05-01 23:26:29 +0200876 "len=%d%s\n", ret, (msgs[ret].flags & I2C_M_RD)
877 ? 'R' : 'W', msgs[ret].addr, msgs[ret].len,
878 (msgs[ret].flags & I2C_M_RECV_LEN) ? "+" : "");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700879 }
880#endif
881
Jiri Kosina6ea23032006-12-10 21:21:30 +0100882 mutex_lock_nested(&adap->bus_lock, adap->level);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700883 ret = adap->algo->master_xfer(adap,msgs,num);
Ingo Molnar5c085d32006-01-18 23:16:04 +0100884 mutex_unlock(&adap->bus_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700885
886 return ret;
887 } else {
888 dev_dbg(&adap->dev, "I2C level transfers not supported\n");
889 return -ENOSYS;
890 }
891}
David Brownellc0564602007-05-01 23:26:31 +0200892EXPORT_SYMBOL(i2c_transfer);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700893
894int i2c_master_send(struct i2c_client *client,const char *buf ,int count)
895{
896 int ret;
897 struct i2c_adapter *adap=client->adapter;
898 struct i2c_msg msg;
899
Jean Delvare815f55f2005-05-07 22:58:46 +0200900 msg.addr = client->addr;
901 msg.flags = client->flags & I2C_M_TEN;
902 msg.len = count;
903 msg.buf = (char *)buf;
David Brownell438d6c22006-12-10 21:21:31 +0100904
Jean Delvare815f55f2005-05-07 22:58:46 +0200905 ret = i2c_transfer(adap, &msg, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700906
Jean Delvare815f55f2005-05-07 22:58:46 +0200907 /* If everything went ok (i.e. 1 msg transmitted), return #bytes
908 transmitted, else error code. */
909 return (ret == 1) ? count : ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700910}
David Brownellc0564602007-05-01 23:26:31 +0200911EXPORT_SYMBOL(i2c_master_send);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700912
913int i2c_master_recv(struct i2c_client *client, char *buf ,int count)
914{
915 struct i2c_adapter *adap=client->adapter;
916 struct i2c_msg msg;
917 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700918
Jean Delvare815f55f2005-05-07 22:58:46 +0200919 msg.addr = client->addr;
920 msg.flags = client->flags & I2C_M_TEN;
921 msg.flags |= I2C_M_RD;
922 msg.len = count;
923 msg.buf = buf;
924
925 ret = i2c_transfer(adap, &msg, 1);
926
927 /* If everything went ok (i.e. 1 msg transmitted), return #bytes
928 transmitted, else error code. */
929 return (ret == 1) ? count : ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700930}
David Brownellc0564602007-05-01 23:26:31 +0200931EXPORT_SYMBOL(i2c_master_recv);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700932
933int i2c_control(struct i2c_client *client,
934 unsigned int cmd, unsigned long arg)
935{
936 int ret = 0;
937 struct i2c_adapter *adap = client->adapter;
938
939 dev_dbg(&client->adapter->dev, "i2c ioctl, cmd: 0x%x, arg: %#lx\n", cmd, arg);
940 switch (cmd) {
941 case I2C_RETRIES:
942 adap->retries = arg;
943 break;
944 case I2C_TIMEOUT:
945 adap->timeout = arg;
946 break;
947 default:
948 if (adap->algo->algo_control!=NULL)
949 ret = adap->algo->algo_control(adap,cmd,arg);
950 }
951 return ret;
952}
David Brownellc0564602007-05-01 23:26:31 +0200953EXPORT_SYMBOL(i2c_control);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700954
955/* ----------------------------------------------------
956 * the i2c address scanning function
957 * Will not work for 10-bit addresses!
958 * ----------------------------------------------------
959 */
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200960static int i2c_probe_address(struct i2c_adapter *adapter, int addr, int kind,
961 int (*found_proc) (struct i2c_adapter *, int, int))
Jean Delvare9fc6adf2005-07-31 21:20:43 +0200962{
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200963 int err;
Jean Delvare9fc6adf2005-07-31 21:20:43 +0200964
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200965 /* Make sure the address is valid */
966 if (addr < 0x03 || addr > 0x77) {
967 dev_warn(&adapter->dev, "Invalid probe address 0x%02x\n",
968 addr);
969 return -EINVAL;
Jean Delvare9fc6adf2005-07-31 21:20:43 +0200970 }
971
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200972 /* Skip if already in use */
973 if (i2c_check_addr(adapter, addr))
974 return 0;
975
976 /* Make sure there is something at this address, unless forced */
Jean Delvare4c9337d2005-08-09 20:28:10 +0200977 if (kind < 0) {
978 if (i2c_smbus_xfer(adapter, addr, 0, 0, 0,
979 I2C_SMBUS_QUICK, NULL) < 0)
980 return 0;
981
982 /* prevent 24RF08 corruption */
983 if ((addr & ~0x0f) == 0x50)
984 i2c_smbus_xfer(adapter, addr, 0, 0, 0,
985 I2C_SMBUS_QUICK, NULL);
986 }
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200987
988 /* Finally call the custom detection function */
989 err = found_proc(adapter, addr, kind);
Jean Delvarea89ba0b2005-08-09 20:17:55 +0200990 /* -ENODEV can be returned if there is a chip at the given address
991 but it isn't supported by this chip driver. We catch it here as
992 this isn't an error. */
Jean Delvare114fd182006-09-03 22:25:04 +0200993 if (err == -ENODEV)
994 err = 0;
995
996 if (err)
997 dev_warn(&adapter->dev, "Client creation failed at 0x%x (%d)\n",
998 addr, err);
999 return err;
Jean Delvare9fc6adf2005-07-31 21:20:43 +02001000}
1001
Linus Torvalds1da177e2005-04-16 15:20:36 -07001002int i2c_probe(struct i2c_adapter *adapter,
1003 struct i2c_client_address_data *address_data,
1004 int (*found_proc) (struct i2c_adapter *, int, int))
1005{
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001006 int i, err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001007 int adap_id = i2c_adapter_id(adapter);
1008
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001009 /* Force entries are done first, and are not affected by ignore
1010 entries */
1011 if (address_data->forces) {
1012 unsigned short **forces = address_data->forces;
1013 int kind;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001014
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001015 for (kind = 0; forces[kind]; kind++) {
1016 for (i = 0; forces[kind][i] != I2C_CLIENT_END;
1017 i += 2) {
1018 if (forces[kind][i] == adap_id
1019 || forces[kind][i] == ANY_I2C_BUS) {
1020 dev_dbg(&adapter->dev, "found force "
1021 "parameter for adapter %d, "
1022 "addr 0x%02x, kind %d\n",
1023 adap_id, forces[kind][i + 1],
1024 kind);
1025 err = i2c_probe_address(adapter,
1026 forces[kind][i + 1],
1027 kind, found_proc);
1028 if (err)
1029 return err;
1030 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001031 }
1032 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001033 }
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001034
Jean Delvare4366dc92005-09-25 16:50:06 +02001035 /* Stop here if we can't use SMBUS_QUICK */
1036 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_QUICK)) {
1037 if (address_data->probe[0] == I2C_CLIENT_END
1038 && address_data->normal_i2c[0] == I2C_CLIENT_END)
David Brownell438d6c22006-12-10 21:21:31 +01001039 return 0;
Jean Delvare4366dc92005-09-25 16:50:06 +02001040
1041 dev_warn(&adapter->dev, "SMBus Quick command not supported, "
1042 "can't probe for chips\n");
1043 return -1;
1044 }
1045
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001046 /* Probe entries are done second, and are not affected by ignore
1047 entries either */
1048 for (i = 0; address_data->probe[i] != I2C_CLIENT_END; i += 2) {
1049 if (address_data->probe[i] == adap_id
1050 || address_data->probe[i] == ANY_I2C_BUS) {
1051 dev_dbg(&adapter->dev, "found probe parameter for "
1052 "adapter %d, addr 0x%02x\n", adap_id,
1053 address_data->probe[i + 1]);
1054 err = i2c_probe_address(adapter,
1055 address_data->probe[i + 1],
1056 -1, found_proc);
1057 if (err)
1058 return err;
1059 }
1060 }
1061
1062 /* Normal entries are done last, unless shadowed by an ignore entry */
1063 for (i = 0; address_data->normal_i2c[i] != I2C_CLIENT_END; i += 1) {
1064 int j, ignore;
1065
1066 ignore = 0;
1067 for (j = 0; address_data->ignore[j] != I2C_CLIENT_END;
1068 j += 2) {
1069 if ((address_data->ignore[j] == adap_id ||
1070 address_data->ignore[j] == ANY_I2C_BUS)
1071 && address_data->ignore[j + 1]
1072 == address_data->normal_i2c[i]) {
1073 dev_dbg(&adapter->dev, "found ignore "
1074 "parameter for adapter %d, "
1075 "addr 0x%02x\n", adap_id,
1076 address_data->ignore[j + 1]);
Mark M. Hoffman2369df92006-07-01 17:01:59 +02001077 ignore = 1;
1078 break;
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001079 }
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001080 }
1081 if (ignore)
1082 continue;
1083
1084 dev_dbg(&adapter->dev, "found normal entry for adapter %d, "
1085 "addr 0x%02x\n", adap_id,
1086 address_data->normal_i2c[i]);
1087 err = i2c_probe_address(adapter, address_data->normal_i2c[i],
1088 -1, found_proc);
1089 if (err)
1090 return err;
1091 }
1092
Linus Torvalds1da177e2005-04-16 15:20:36 -07001093 return 0;
1094}
David Brownellc0564602007-05-01 23:26:31 +02001095EXPORT_SYMBOL(i2c_probe);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001096
Jean Delvare12b5053a2007-05-01 23:26:31 +02001097struct i2c_client *
1098i2c_new_probed_device(struct i2c_adapter *adap,
1099 struct i2c_board_info *info,
1100 unsigned short const *addr_list)
1101{
1102 int i;
1103
1104 /* Stop here if the bus doesn't support probing */
1105 if (!i2c_check_functionality(adap, I2C_FUNC_SMBUS_READ_BYTE)) {
1106 dev_err(&adap->dev, "Probing not supported\n");
1107 return NULL;
1108 }
1109
1110 mutex_lock(&adap->clist_lock);
1111 for (i = 0; addr_list[i] != I2C_CLIENT_END; i++) {
1112 /* Check address validity */
1113 if (addr_list[i] < 0x03 || addr_list[i] > 0x77) {
1114 dev_warn(&adap->dev, "Invalid 7-bit address "
1115 "0x%02x\n", addr_list[i]);
1116 continue;
1117 }
1118
1119 /* Check address availability */
1120 if (__i2c_check_addr(adap, addr_list[i])) {
1121 dev_dbg(&adap->dev, "Address 0x%02x already in "
1122 "use, not probing\n", addr_list[i]);
1123 continue;
1124 }
1125
1126 /* Test address responsiveness
1127 The default probe method is a quick write, but it is known
1128 to corrupt the 24RF08 EEPROMs due to a state machine bug,
1129 and could also irreversibly write-protect some EEPROMs, so
1130 for address ranges 0x30-0x37 and 0x50-0x5f, we use a byte
1131 read instead. Also, some bus drivers don't implement
1132 quick write, so we fallback to a byte read it that case
1133 too. */
1134 if ((addr_list[i] & ~0x07) == 0x30
1135 || (addr_list[i] & ~0x0f) == 0x50
1136 || !i2c_check_functionality(adap, I2C_FUNC_SMBUS_QUICK)) {
1137 if (i2c_smbus_xfer(adap, addr_list[i], 0,
1138 I2C_SMBUS_READ, 0,
1139 I2C_SMBUS_BYTE, NULL) >= 0)
1140 break;
1141 } else {
1142 if (i2c_smbus_xfer(adap, addr_list[i], 0,
1143 I2C_SMBUS_WRITE, 0,
1144 I2C_SMBUS_QUICK, NULL) >= 0)
1145 break;
1146 }
1147 }
1148 mutex_unlock(&adap->clist_lock);
1149
1150 if (addr_list[i] == I2C_CLIENT_END) {
1151 dev_dbg(&adap->dev, "Probing failed, no device found\n");
1152 return NULL;
1153 }
1154
1155 info->addr = addr_list[i];
1156 return i2c_new_device(adap, info);
1157}
1158EXPORT_SYMBOL_GPL(i2c_new_probed_device);
1159
Linus Torvalds1da177e2005-04-16 15:20:36 -07001160struct i2c_adapter* i2c_get_adapter(int id)
1161{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001162 struct i2c_adapter *adapter;
David Brownell438d6c22006-12-10 21:21:31 +01001163
Arjan van de Venb3585e42006-01-11 10:50:26 +01001164 mutex_lock(&core_lists);
Mark M. Hoffmana0920e102005-06-28 00:21:30 -04001165 adapter = (struct i2c_adapter *)idr_find(&i2c_adapter_idr, id);
1166 if (adapter && !try_module_get(adapter->owner))
1167 adapter = NULL;
1168
Arjan van de Venb3585e42006-01-11 10:50:26 +01001169 mutex_unlock(&core_lists);
Mark M. Hoffmana0920e102005-06-28 00:21:30 -04001170 return adapter;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001171}
David Brownellc0564602007-05-01 23:26:31 +02001172EXPORT_SYMBOL(i2c_get_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001173
1174void i2c_put_adapter(struct i2c_adapter *adap)
1175{
1176 module_put(adap->owner);
1177}
David Brownellc0564602007-05-01 23:26:31 +02001178EXPORT_SYMBOL(i2c_put_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001179
1180/* The SMBus parts */
1181
David Brownell438d6c22006-12-10 21:21:31 +01001182#define POLY (0x1070U << 3)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001183static u8
1184crc8(u16 data)
1185{
1186 int i;
David Brownell438d6c22006-12-10 21:21:31 +01001187
Linus Torvalds1da177e2005-04-16 15:20:36 -07001188 for(i = 0; i < 8; i++) {
David Brownell438d6c22006-12-10 21:21:31 +01001189 if (data & 0x8000)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001190 data = data ^ POLY;
1191 data = data << 1;
1192 }
1193 return (u8)(data >> 8);
1194}
1195
Jean Delvare421ef472005-10-26 21:28:55 +02001196/* Incremental CRC8 over count bytes in the array pointed to by p */
1197static u8 i2c_smbus_pec(u8 crc, u8 *p, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001198{
1199 int i;
1200
1201 for(i = 0; i < count; i++)
Jean Delvare421ef472005-10-26 21:28:55 +02001202 crc = crc8((crc ^ p[i]) << 8);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001203 return crc;
1204}
1205
Jean Delvare421ef472005-10-26 21:28:55 +02001206/* Assume a 7-bit address, which is reasonable for SMBus */
1207static u8 i2c_smbus_msg_pec(u8 pec, struct i2c_msg *msg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001208{
Jean Delvare421ef472005-10-26 21:28:55 +02001209 /* The address will be sent first */
1210 u8 addr = (msg->addr << 1) | !!(msg->flags & I2C_M_RD);
1211 pec = i2c_smbus_pec(pec, &addr, 1);
1212
1213 /* The data buffer follows */
1214 return i2c_smbus_pec(pec, msg->buf, msg->len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001215}
1216
Jean Delvare421ef472005-10-26 21:28:55 +02001217/* Used for write only transactions */
1218static inline void i2c_smbus_add_pec(struct i2c_msg *msg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001219{
Jean Delvare421ef472005-10-26 21:28:55 +02001220 msg->buf[msg->len] = i2c_smbus_msg_pec(0, msg);
1221 msg->len++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001222}
1223
Jean Delvare421ef472005-10-26 21:28:55 +02001224/* Return <0 on CRC error
1225 If there was a write before this read (most cases) we need to take the
1226 partial CRC from the write part into account.
1227 Note that this function does modify the message (we need to decrease the
1228 message length to hide the CRC byte from the caller). */
1229static int i2c_smbus_check_pec(u8 cpec, struct i2c_msg *msg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001230{
Jean Delvare421ef472005-10-26 21:28:55 +02001231 u8 rpec = msg->buf[--msg->len];
1232 cpec = i2c_smbus_msg_pec(cpec, msg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001233
Linus Torvalds1da177e2005-04-16 15:20:36 -07001234 if (rpec != cpec) {
1235 pr_debug("i2c-core: Bad PEC 0x%02x vs. 0x%02x\n",
1236 rpec, cpec);
1237 return -1;
1238 }
David Brownell438d6c22006-12-10 21:21:31 +01001239 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001240}
1241
1242s32 i2c_smbus_write_quick(struct i2c_client *client, u8 value)
1243{
1244 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
David Brownell438d6c22006-12-10 21:21:31 +01001245 value,0,I2C_SMBUS_QUICK,NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001246}
David Brownellc0564602007-05-01 23:26:31 +02001247EXPORT_SYMBOL(i2c_smbus_write_quick);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001248
1249s32 i2c_smbus_read_byte(struct i2c_client *client)
1250{
1251 union i2c_smbus_data data;
1252 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1253 I2C_SMBUS_READ,0,I2C_SMBUS_BYTE, &data))
1254 return -1;
1255 else
Jean Delvare7eff82c2006-09-03 22:24:00 +02001256 return data.byte;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001257}
David Brownellc0564602007-05-01 23:26:31 +02001258EXPORT_SYMBOL(i2c_smbus_read_byte);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001259
1260s32 i2c_smbus_write_byte(struct i2c_client *client, u8 value)
1261{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001262 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
Jean Delvare421ef472005-10-26 21:28:55 +02001263 I2C_SMBUS_WRITE, value, I2C_SMBUS_BYTE, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001264}
David Brownellc0564602007-05-01 23:26:31 +02001265EXPORT_SYMBOL(i2c_smbus_write_byte);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001266
1267s32 i2c_smbus_read_byte_data(struct i2c_client *client, u8 command)
1268{
1269 union i2c_smbus_data data;
1270 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1271 I2C_SMBUS_READ,command, I2C_SMBUS_BYTE_DATA,&data))
1272 return -1;
1273 else
Jean Delvare7eff82c2006-09-03 22:24:00 +02001274 return data.byte;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001275}
David Brownellc0564602007-05-01 23:26:31 +02001276EXPORT_SYMBOL(i2c_smbus_read_byte_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001277
1278s32 i2c_smbus_write_byte_data(struct i2c_client *client, u8 command, u8 value)
1279{
1280 union i2c_smbus_data data;
1281 data.byte = value;
1282 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1283 I2C_SMBUS_WRITE,command,
1284 I2C_SMBUS_BYTE_DATA,&data);
1285}
David Brownellc0564602007-05-01 23:26:31 +02001286EXPORT_SYMBOL(i2c_smbus_write_byte_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001287
1288s32 i2c_smbus_read_word_data(struct i2c_client *client, u8 command)
1289{
1290 union i2c_smbus_data data;
1291 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1292 I2C_SMBUS_READ,command, I2C_SMBUS_WORD_DATA, &data))
1293 return -1;
1294 else
Jean Delvare7eff82c2006-09-03 22:24:00 +02001295 return data.word;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001296}
David Brownellc0564602007-05-01 23:26:31 +02001297EXPORT_SYMBOL(i2c_smbus_read_word_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001298
1299s32 i2c_smbus_write_word_data(struct i2c_client *client, u8 command, u16 value)
1300{
1301 union i2c_smbus_data data;
1302 data.word = value;
1303 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1304 I2C_SMBUS_WRITE,command,
1305 I2C_SMBUS_WORD_DATA,&data);
1306}
David Brownellc0564602007-05-01 23:26:31 +02001307EXPORT_SYMBOL(i2c_smbus_write_word_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001308
Jean Delvareb86a1bc2007-05-01 23:26:34 +02001309/* Returns the number of read bytes */
1310s32 i2c_smbus_read_block_data(struct i2c_client *client, u8 command,
1311 u8 *values)
1312{
1313 union i2c_smbus_data data;
1314
1315 if (i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1316 I2C_SMBUS_READ, command,
1317 I2C_SMBUS_BLOCK_DATA, &data))
1318 return -1;
1319
1320 memcpy(values, &data.block[1], data.block[0]);
1321 return data.block[0];
1322}
1323EXPORT_SYMBOL(i2c_smbus_read_block_data);
1324
Linus Torvalds1da177e2005-04-16 15:20:36 -07001325s32 i2c_smbus_write_block_data(struct i2c_client *client, u8 command,
Krzysztof Halasa46f5ed72006-06-12 21:42:20 +02001326 u8 length, const u8 *values)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001327{
1328 union i2c_smbus_data data;
Jean Delvare76560322006-01-18 23:14:55 +01001329
Linus Torvalds1da177e2005-04-16 15:20:36 -07001330 if (length > I2C_SMBUS_BLOCK_MAX)
1331 length = I2C_SMBUS_BLOCK_MAX;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001332 data.block[0] = length;
Jean Delvare76560322006-01-18 23:14:55 +01001333 memcpy(&data.block[1], values, length);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001334 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1335 I2C_SMBUS_WRITE,command,
1336 I2C_SMBUS_BLOCK_DATA,&data);
1337}
David Brownellc0564602007-05-01 23:26:31 +02001338EXPORT_SYMBOL(i2c_smbus_write_block_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001339
1340/* Returns the number of read bytes */
Jean Delvare4b2643d2007-07-12 14:12:29 +02001341s32 i2c_smbus_read_i2c_block_data(struct i2c_client *client, u8 command,
1342 u8 length, u8 *values)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001343{
1344 union i2c_smbus_data data;
Jean Delvare76560322006-01-18 23:14:55 +01001345
Jean Delvare4b2643d2007-07-12 14:12:29 +02001346 if (length > I2C_SMBUS_BLOCK_MAX)
1347 length = I2C_SMBUS_BLOCK_MAX;
1348 data.block[0] = length;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001349 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1350 I2C_SMBUS_READ,command,
1351 I2C_SMBUS_I2C_BLOCK_DATA,&data))
1352 return -1;
Jean Delvare76560322006-01-18 23:14:55 +01001353
1354 memcpy(values, &data.block[1], data.block[0]);
1355 return data.block[0];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001356}
David Brownellc0564602007-05-01 23:26:31 +02001357EXPORT_SYMBOL(i2c_smbus_read_i2c_block_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001358
Jean Delvare21bbd692006-01-09 15:19:18 +11001359s32 i2c_smbus_write_i2c_block_data(struct i2c_client *client, u8 command,
Krzysztof Halasa46f5ed72006-06-12 21:42:20 +02001360 u8 length, const u8 *values)
Jean Delvare21bbd692006-01-09 15:19:18 +11001361{
1362 union i2c_smbus_data data;
1363
1364 if (length > I2C_SMBUS_BLOCK_MAX)
1365 length = I2C_SMBUS_BLOCK_MAX;
1366 data.block[0] = length;
1367 memcpy(data.block + 1, values, length);
1368 return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1369 I2C_SMBUS_WRITE, command,
1370 I2C_SMBUS_I2C_BLOCK_DATA, &data);
1371}
David Brownellc0564602007-05-01 23:26:31 +02001372EXPORT_SYMBOL(i2c_smbus_write_i2c_block_data);
Jean Delvare21bbd692006-01-09 15:19:18 +11001373
David Brownell438d6c22006-12-10 21:21:31 +01001374/* Simulate a SMBus command using the i2c protocol
Linus Torvalds1da177e2005-04-16 15:20:36 -07001375 No checking of parameters is done! */
David Brownell438d6c22006-12-10 21:21:31 +01001376static s32 i2c_smbus_xfer_emulated(struct i2c_adapter * adapter, u16 addr,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001377 unsigned short flags,
David Brownell438d6c22006-12-10 21:21:31 +01001378 char read_write, u8 command, int size,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001379 union i2c_smbus_data * data)
1380{
1381 /* So we need to generate a series of msgs. In the case of writing, we
1382 need to use only one message; when reading, we need two. We initialize
1383 most things with sane defaults, to keep the code below somewhat
1384 simpler. */
Hideki Iwamoto5c50d182005-09-25 17:01:11 +02001385 unsigned char msgbuf0[I2C_SMBUS_BLOCK_MAX+3];
1386 unsigned char msgbuf1[I2C_SMBUS_BLOCK_MAX+2];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001387 int num = read_write == I2C_SMBUS_READ?2:1;
David Brownell438d6c22006-12-10 21:21:31 +01001388 struct i2c_msg msg[2] = { { addr, flags, 1, msgbuf0 },
Linus Torvalds1da177e2005-04-16 15:20:36 -07001389 { addr, flags | I2C_M_RD, 0, msgbuf1 }
1390 };
1391 int i;
Jean Delvare421ef472005-10-26 21:28:55 +02001392 u8 partial_pec = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001393
1394 msgbuf0[0] = command;
1395 switch(size) {
1396 case I2C_SMBUS_QUICK:
1397 msg[0].len = 0;
1398 /* Special case: The read/write field is used as data */
1399 msg[0].flags = flags | (read_write==I2C_SMBUS_READ)?I2C_M_RD:0;
1400 num = 1;
1401 break;
1402 case I2C_SMBUS_BYTE:
1403 if (read_write == I2C_SMBUS_READ) {
1404 /* Special case: only a read! */
1405 msg[0].flags = I2C_M_RD | flags;
1406 num = 1;
1407 }
1408 break;
1409 case I2C_SMBUS_BYTE_DATA:
1410 if (read_write == I2C_SMBUS_READ)
1411 msg[1].len = 1;
1412 else {
1413 msg[0].len = 2;
1414 msgbuf0[1] = data->byte;
1415 }
1416 break;
1417 case I2C_SMBUS_WORD_DATA:
1418 if (read_write == I2C_SMBUS_READ)
1419 msg[1].len = 2;
1420 else {
1421 msg[0].len=3;
1422 msgbuf0[1] = data->word & 0xff;
Jean Delvare7eff82c2006-09-03 22:24:00 +02001423 msgbuf0[2] = data->word >> 8;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001424 }
1425 break;
1426 case I2C_SMBUS_PROC_CALL:
1427 num = 2; /* Special case */
1428 read_write = I2C_SMBUS_READ;
1429 msg[0].len = 3;
1430 msg[1].len = 2;
1431 msgbuf0[1] = data->word & 0xff;
Jean Delvare7eff82c2006-09-03 22:24:00 +02001432 msgbuf0[2] = data->word >> 8;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001433 break;
1434 case I2C_SMBUS_BLOCK_DATA:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001435 if (read_write == I2C_SMBUS_READ) {
Jean Delvare209d27c2007-05-01 23:26:29 +02001436 msg[1].flags |= I2C_M_RECV_LEN;
1437 msg[1].len = 1; /* block length will be added by
1438 the underlying bus driver */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001439 } else {
1440 msg[0].len = data->block[0] + 2;
1441 if (msg[0].len > I2C_SMBUS_BLOCK_MAX + 2) {
1442 dev_err(&adapter->dev, "smbus_access called with "
1443 "invalid block write size (%d)\n",
1444 data->block[0]);
1445 return -1;
1446 }
Hideki Iwamoto5c50d182005-09-25 17:01:11 +02001447 for (i = 1; i < msg[0].len; i++)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001448 msgbuf0[i] = data->block[i-1];
1449 }
1450 break;
1451 case I2C_SMBUS_BLOCK_PROC_CALL:
Jean Delvare209d27c2007-05-01 23:26:29 +02001452 num = 2; /* Another special case */
1453 read_write = I2C_SMBUS_READ;
1454 if (data->block[0] > I2C_SMBUS_BLOCK_MAX) {
1455 dev_err(&adapter->dev, "%s called with invalid "
1456 "block proc call size (%d)\n", __FUNCTION__,
1457 data->block[0]);
1458 return -1;
1459 }
1460 msg[0].len = data->block[0] + 2;
1461 for (i = 1; i < msg[0].len; i++)
1462 msgbuf0[i] = data->block[i-1];
1463 msg[1].flags |= I2C_M_RECV_LEN;
1464 msg[1].len = 1; /* block length will be added by
1465 the underlying bus driver */
1466 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001467 case I2C_SMBUS_I2C_BLOCK_DATA:
1468 if (read_write == I2C_SMBUS_READ) {
Jean Delvare4b2643d2007-07-12 14:12:29 +02001469 msg[1].len = data->block[0];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001470 } else {
1471 msg[0].len = data->block[0] + 1;
Jean Delvare30dac742005-10-08 00:15:59 +02001472 if (msg[0].len > I2C_SMBUS_BLOCK_MAX + 1) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001473 dev_err(&adapter->dev, "i2c_smbus_xfer_emulated called with "
1474 "invalid block write size (%d)\n",
1475 data->block[0]);
1476 return -1;
1477 }
1478 for (i = 1; i <= data->block[0]; i++)
1479 msgbuf0[i] = data->block[i];
1480 }
1481 break;
1482 default:
1483 dev_err(&adapter->dev, "smbus_access called with invalid size (%d)\n",
1484 size);
1485 return -1;
1486 }
1487
Jean Delvare421ef472005-10-26 21:28:55 +02001488 i = ((flags & I2C_CLIENT_PEC) && size != I2C_SMBUS_QUICK
1489 && size != I2C_SMBUS_I2C_BLOCK_DATA);
1490 if (i) {
1491 /* Compute PEC if first message is a write */
1492 if (!(msg[0].flags & I2C_M_RD)) {
David Brownell438d6c22006-12-10 21:21:31 +01001493 if (num == 1) /* Write only */
Jean Delvare421ef472005-10-26 21:28:55 +02001494 i2c_smbus_add_pec(&msg[0]);
1495 else /* Write followed by read */
1496 partial_pec = i2c_smbus_msg_pec(0, &msg[0]);
1497 }
1498 /* Ask for PEC if last message is a read */
1499 if (msg[num-1].flags & I2C_M_RD)
David Brownell438d6c22006-12-10 21:21:31 +01001500 msg[num-1].len++;
Jean Delvare421ef472005-10-26 21:28:55 +02001501 }
1502
Linus Torvalds1da177e2005-04-16 15:20:36 -07001503 if (i2c_transfer(adapter, msg, num) < 0)
1504 return -1;
1505
Jean Delvare421ef472005-10-26 21:28:55 +02001506 /* Check PEC if last message is a read */
1507 if (i && (msg[num-1].flags & I2C_M_RD)) {
1508 if (i2c_smbus_check_pec(partial_pec, &msg[num-1]) < 0)
1509 return -1;
1510 }
1511
Linus Torvalds1da177e2005-04-16 15:20:36 -07001512 if (read_write == I2C_SMBUS_READ)
1513 switch(size) {
1514 case I2C_SMBUS_BYTE:
1515 data->byte = msgbuf0[0];
1516 break;
1517 case I2C_SMBUS_BYTE_DATA:
1518 data->byte = msgbuf1[0];
1519 break;
David Brownell438d6c22006-12-10 21:21:31 +01001520 case I2C_SMBUS_WORD_DATA:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001521 case I2C_SMBUS_PROC_CALL:
1522 data->word = msgbuf1[0] | (msgbuf1[1] << 8);
1523 break;
1524 case I2C_SMBUS_I2C_BLOCK_DATA:
Jean Delvare4b2643d2007-07-12 14:12:29 +02001525 for (i = 0; i < data->block[0]; i++)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001526 data->block[i+1] = msgbuf1[i];
1527 break;
Jean Delvare209d27c2007-05-01 23:26:29 +02001528 case I2C_SMBUS_BLOCK_DATA:
1529 case I2C_SMBUS_BLOCK_PROC_CALL:
1530 for (i = 0; i < msgbuf1[0] + 1; i++)
1531 data->block[i] = msgbuf1[i];
1532 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001533 }
1534 return 0;
1535}
1536
1537
1538s32 i2c_smbus_xfer(struct i2c_adapter * adapter, u16 addr, unsigned short flags,
David Brownell438d6c22006-12-10 21:21:31 +01001539 char read_write, u8 command, int size,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001540 union i2c_smbus_data * data)
1541{
1542 s32 res;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001543
1544 flags &= I2C_M_TEN | I2C_CLIENT_PEC;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001545
1546 if (adapter->algo->smbus_xfer) {
Ingo Molnar5c085d32006-01-18 23:16:04 +01001547 mutex_lock(&adapter->bus_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001548 res = adapter->algo->smbus_xfer(adapter,addr,flags,read_write,
1549 command,size,data);
Ingo Molnar5c085d32006-01-18 23:16:04 +01001550 mutex_unlock(&adapter->bus_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001551 } else
1552 res = i2c_smbus_xfer_emulated(adapter,addr,flags,read_write,
1553 command,size,data);
1554
Linus Torvalds1da177e2005-04-16 15:20:36 -07001555 return res;
1556}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001557EXPORT_SYMBOL(i2c_smbus_xfer);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001558
1559MODULE_AUTHOR("Simon G. Vogl <simon@tk.uni-linz.ac.at>");
1560MODULE_DESCRIPTION("I2C-Bus main module");
1561MODULE_LICENSE("GPL");