blob: bb5c215a24e086a3d4ac07b193ebc094734c8606 [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
Jan Engelhardt96de0e22007-10-19 23:21:04 +020020/* With some changes from Kyösti Mälkki <kmalkki@cc.hut.fi>.
Linus Torvalds1da177e2005-04-16 15:20:36 -070021 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>
Russell Kingd052d1b2005-10-29 19:07:23 +010032#include <linux/platform_device.h>
Arjan van de Venb3585e42006-01-11 10:50:26 +010033#include <linux/mutex.h>
Jean Delvareb8d6f452007-02-13 22:09:00 +010034#include <linux/completion.h>
Mike Rapoportcea443a2008-01-27 18:14:50 +010035#include <linux/hardirq.h>
36#include <linux/irqflags.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070037#include <asm/uaccess.h>
38
David Brownell9c1600e2007-05-01 23:26:31 +020039#include "i2c-core.h"
40
Linus Torvalds1da177e2005-04-16 15:20:36 -070041
Jean Delvarecaada322008-01-27 18:14:49 +010042static DEFINE_MUTEX(core_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -070043static DEFINE_IDR(i2c_adapter_idr);
44
David Brownella1d9e6e2007-05-01 23:26:30 +020045#define is_newstyle_driver(d) ((d)->probe || (d)->remove)
David Brownellf37dd802007-02-13 22:09:00 +010046
47/* ------------------------------------------------------------------------- */
48
Jean Delvared2653e92008-04-29 23:11:39 +020049static const struct i2c_device_id *i2c_match_id(const struct i2c_device_id *id,
50 const struct i2c_client *client)
51{
52 while (id->name[0]) {
53 if (strcmp(client->name, id->name) == 0)
54 return id;
55 id++;
56 }
57 return NULL;
58}
59
Linus Torvalds1da177e2005-04-16 15:20:36 -070060static int i2c_device_match(struct device *dev, struct device_driver *drv)
61{
David Brownell7b4fbc52007-05-01 23:26:30 +020062 struct i2c_client *client = to_i2c_client(dev);
63 struct i2c_driver *driver = to_i2c_driver(drv);
64
65 /* make legacy i2c drivers bypass driver model probing entirely;
66 * such drivers scan each i2c adapter/bus themselves.
67 */
David Brownella1d9e6e2007-05-01 23:26:30 +020068 if (!is_newstyle_driver(driver))
David Brownell7b4fbc52007-05-01 23:26:30 +020069 return 0;
70
Jean Delvared2653e92008-04-29 23:11:39 +020071 /* match on an id table if there is one */
72 if (driver->id_table)
73 return i2c_match_id(driver->id_table, client) != NULL;
74
Jean Delvareeb8a7902008-05-18 20:49:41 +020075 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -070076}
77
David Brownell7b4fbc52007-05-01 23:26:30 +020078#ifdef CONFIG_HOTPLUG
79
80/* uevent helps with hotplug: modprobe -q $(MODALIAS) */
Kay Sievers7eff2e72007-08-14 15:15:12 +020081static int i2c_device_uevent(struct device *dev, struct kobj_uevent_env *env)
David Brownell7b4fbc52007-05-01 23:26:30 +020082{
83 struct i2c_client *client = to_i2c_client(dev);
David Brownell7b4fbc52007-05-01 23:26:30 +020084
85 /* by definition, legacy drivers can't hotplug */
Jean Delvared2653e92008-04-29 23:11:39 +020086 if (dev->driver)
David Brownell7b4fbc52007-05-01 23:26:30 +020087 return 0;
88
Jean Delvareeb8a7902008-05-18 20:49:41 +020089 if (add_uevent_var(env, "MODALIAS=%s%s",
90 I2C_MODULE_PREFIX, client->name))
91 return -ENOMEM;
David Brownell7b4fbc52007-05-01 23:26:30 +020092 dev_dbg(dev, "uevent\n");
93 return 0;
94}
95
96#else
97#define i2c_device_uevent NULL
98#endif /* CONFIG_HOTPLUG */
99
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100static int i2c_device_probe(struct device *dev)
101{
David Brownell7b4fbc52007-05-01 23:26:30 +0200102 struct i2c_client *client = to_i2c_client(dev);
103 struct i2c_driver *driver = to_i2c_driver(dev->driver);
Jean Delvared2653e92008-04-29 23:11:39 +0200104 const struct i2c_device_id *id;
Hans Verkuil50c33042008-03-12 14:15:00 +0100105 int status;
David Brownell7b4fbc52007-05-01 23:26:30 +0200106
107 if (!driver->probe)
108 return -ENODEV;
109 client->driver = driver;
110 dev_dbg(dev, "probe\n");
Jean Delvared2653e92008-04-29 23:11:39 +0200111
112 if (driver->id_table)
113 id = i2c_match_id(driver->id_table, client);
114 else
115 id = NULL;
116 status = driver->probe(client, id);
Hans Verkuil50c33042008-03-12 14:15:00 +0100117 if (status)
118 client->driver = NULL;
119 return status;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700120}
121
122static int i2c_device_remove(struct device *dev)
123{
David Brownella1d9e6e2007-05-01 23:26:30 +0200124 struct i2c_client *client = to_i2c_client(dev);
125 struct i2c_driver *driver;
126 int status;
127
128 if (!dev->driver)
129 return 0;
130
131 driver = to_i2c_driver(dev->driver);
132 if (driver->remove) {
133 dev_dbg(dev, "remove\n");
134 status = driver->remove(client);
135 } else {
136 dev->driver = NULL;
137 status = 0;
138 }
139 if (status == 0)
140 client->driver = NULL;
141 return status;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700142}
143
David Brownellf37dd802007-02-13 22:09:00 +0100144static void i2c_device_shutdown(struct device *dev)
145{
146 struct i2c_driver *driver;
147
148 if (!dev->driver)
149 return;
150 driver = to_i2c_driver(dev->driver);
151 if (driver->shutdown)
152 driver->shutdown(to_i2c_client(dev));
153}
154
155static int i2c_device_suspend(struct device * dev, pm_message_t mesg)
156{
157 struct i2c_driver *driver;
158
159 if (!dev->driver)
160 return 0;
161 driver = to_i2c_driver(dev->driver);
162 if (!driver->suspend)
163 return 0;
164 return driver->suspend(to_i2c_client(dev), mesg);
165}
166
167static int i2c_device_resume(struct device * dev)
168{
169 struct i2c_driver *driver;
170
171 if (!dev->driver)
172 return 0;
173 driver = to_i2c_driver(dev->driver);
174 if (!driver->resume)
175 return 0;
176 return driver->resume(to_i2c_client(dev));
177}
178
David Brownell7b4fbc52007-05-01 23:26:30 +0200179static void i2c_client_release(struct device *dev)
180{
181 struct i2c_client *client = to_i2c_client(dev);
182 complete(&client->released);
183}
184
David Brownell9c1600e2007-05-01 23:26:31 +0200185static void i2c_client_dev_release(struct device *dev)
186{
187 kfree(to_i2c_client(dev));
188}
189
David Brownell7b4fbc52007-05-01 23:26:30 +0200190static ssize_t show_client_name(struct device *dev, struct device_attribute *attr, char *buf)
191{
192 struct i2c_client *client = to_i2c_client(dev);
193 return sprintf(buf, "%s\n", client->name);
194}
195
196static ssize_t show_modalias(struct device *dev, struct device_attribute *attr, char *buf)
197{
198 struct i2c_client *client = to_i2c_client(dev);
Jean Delvareeb8a7902008-05-18 20:49:41 +0200199 return sprintf(buf, "%s%s\n", I2C_MODULE_PREFIX, client->name);
David Brownell7b4fbc52007-05-01 23:26:30 +0200200}
201
202static struct device_attribute i2c_dev_attrs[] = {
203 __ATTR(name, S_IRUGO, show_client_name, NULL),
204 /* modalias helps coldplug: modprobe $(cat .../modalias) */
205 __ATTR(modalias, S_IRUGO, show_modalias, NULL),
206 { },
207};
208
Adrian Bunk83eaaed2007-10-13 23:56:30 +0200209static struct bus_type i2c_bus_type = {
David Brownellf37dd802007-02-13 22:09:00 +0100210 .name = "i2c",
David Brownell7b4fbc52007-05-01 23:26:30 +0200211 .dev_attrs = i2c_dev_attrs,
David Brownellf37dd802007-02-13 22:09:00 +0100212 .match = i2c_device_match,
David Brownell7b4fbc52007-05-01 23:26:30 +0200213 .uevent = i2c_device_uevent,
David Brownellf37dd802007-02-13 22:09:00 +0100214 .probe = i2c_device_probe,
215 .remove = i2c_device_remove,
216 .shutdown = i2c_device_shutdown,
217 .suspend = i2c_device_suspend,
218 .resume = i2c_device_resume,
Russell Kingb864c7d2006-01-05 14:37:50 +0000219};
220
David Brownell9b766b82008-01-27 18:14:51 +0100221
222/**
223 * i2c_verify_client - return parameter as i2c_client, or NULL
224 * @dev: device, probably from some driver model iterator
225 *
226 * When traversing the driver model tree, perhaps using driver model
227 * iterators like @device_for_each_child(), you can't assume very much
228 * about the nodes you find. Use this function to avoid oopses caused
229 * by wrongly treating some non-I2C device as an i2c_client.
230 */
231struct i2c_client *i2c_verify_client(struct device *dev)
232{
233 return (dev->bus == &i2c_bus_type)
234 ? to_i2c_client(dev)
235 : NULL;
236}
237EXPORT_SYMBOL(i2c_verify_client);
238
239
David Brownell9c1600e2007-05-01 23:26:31 +0200240/**
241 * i2c_new_device - instantiate an i2c device for use with a new style driver
242 * @adap: the adapter managing the device
243 * @info: describes one I2C device; bus_num is ignored
David Brownelld64f73b2007-07-12 14:12:28 +0200244 * Context: can sleep
David Brownell9c1600e2007-05-01 23:26:31 +0200245 *
246 * Create a device to work with a new style i2c driver, where binding is
247 * handled through driver model probe()/remove() methods. This call is not
248 * appropriate for use by mainboad initialization logic, which usually runs
249 * during an arch_initcall() long before any i2c_adapter could exist.
250 *
251 * This returns the new i2c client, which may be saved for later use with
252 * i2c_unregister_device(); or NULL to indicate an error.
253 */
254struct i2c_client *
255i2c_new_device(struct i2c_adapter *adap, struct i2c_board_info const *info)
256{
257 struct i2c_client *client;
258 int status;
259
260 client = kzalloc(sizeof *client, GFP_KERNEL);
261 if (!client)
262 return NULL;
263
264 client->adapter = adap;
265
266 client->dev.platform_data = info->platform_data;
David Brownell3bbb8352007-10-13 23:56:29 +0200267 device_init_wakeup(&client->dev, info->flags & I2C_CLIENT_WAKE);
268
269 client->flags = info->flags & ~I2C_CLIENT_WAKE;
David Brownell9c1600e2007-05-01 23:26:31 +0200270 client->addr = info->addr;
271 client->irq = info->irq;
272
David Brownell9c1600e2007-05-01 23:26:31 +0200273 strlcpy(client->name, info->type, sizeof(client->name));
274
275 /* a new style driver may be bound to this device when we
276 * return from this function, or any later moment (e.g. maybe
277 * hotplugging will load the driver module). and the device
278 * refcount model is the standard driver model one.
279 */
280 status = i2c_attach_client(client);
281 if (status < 0) {
282 kfree(client);
283 client = NULL;
284 }
285 return client;
286}
287EXPORT_SYMBOL_GPL(i2c_new_device);
288
289
290/**
291 * i2c_unregister_device - reverse effect of i2c_new_device()
292 * @client: value returned from i2c_new_device()
David Brownelld64f73b2007-07-12 14:12:28 +0200293 * Context: can sleep
David Brownell9c1600e2007-05-01 23:26:31 +0200294 */
295void i2c_unregister_device(struct i2c_client *client)
David Brownella1d9e6e2007-05-01 23:26:30 +0200296{
297 struct i2c_adapter *adapter = client->adapter;
298 struct i2c_driver *driver = client->driver;
299
300 if (driver && !is_newstyle_driver(driver)) {
301 dev_err(&client->dev, "can't unregister devices "
302 "with legacy drivers\n");
303 WARN_ON(1);
304 return;
305 }
306
307 mutex_lock(&adapter->clist_lock);
308 list_del(&client->list);
309 mutex_unlock(&adapter->clist_lock);
310
311 device_unregister(&client->dev);
312}
David Brownell9c1600e2007-05-01 23:26:31 +0200313EXPORT_SYMBOL_GPL(i2c_unregister_device);
David Brownella1d9e6e2007-05-01 23:26:30 +0200314
315
Jean Delvare60b129d2008-05-11 20:37:06 +0200316static const struct i2c_device_id dummy_id[] = {
317 { "dummy", 0 },
318 { },
319};
320
Jean Delvared2653e92008-04-29 23:11:39 +0200321static int dummy_probe(struct i2c_client *client,
322 const struct i2c_device_id *id)
323{
324 return 0;
325}
326
327static int dummy_remove(struct i2c_client *client)
David Brownelle9f13732008-01-27 18:14:52 +0100328{
329 return 0;
330}
331
332static struct i2c_driver dummy_driver = {
333 .driver.name = "dummy",
Jean Delvared2653e92008-04-29 23:11:39 +0200334 .probe = dummy_probe,
335 .remove = dummy_remove,
Jean Delvare60b129d2008-05-11 20:37:06 +0200336 .id_table = dummy_id,
David Brownelle9f13732008-01-27 18:14:52 +0100337};
338
339/**
340 * i2c_new_dummy - return a new i2c device bound to a dummy driver
341 * @adapter: the adapter managing the device
342 * @address: seven bit address to be used
David Brownelle9f13732008-01-27 18:14:52 +0100343 * Context: can sleep
344 *
345 * This returns an I2C client bound to the "dummy" driver, intended for use
346 * with devices that consume multiple addresses. Examples of such chips
347 * include various EEPROMS (like 24c04 and 24c08 models).
348 *
349 * These dummy devices have two main uses. First, most I2C and SMBus calls
350 * except i2c_transfer() need a client handle; the dummy will be that handle.
351 * And second, this prevents the specified address from being bound to a
352 * different driver.
353 *
354 * This returns the new i2c client, which should be saved for later use with
355 * i2c_unregister_device(); or NULL to indicate an error.
356 */
357struct i2c_client *
Jean Delvare60b129d2008-05-11 20:37:06 +0200358i2c_new_dummy(struct i2c_adapter *adapter, u16 address)
David Brownelle9f13732008-01-27 18:14:52 +0100359{
360 struct i2c_board_info info = {
Jean Delvare60b129d2008-05-11 20:37:06 +0200361 I2C_BOARD_INFO("dummy", address),
David Brownelle9f13732008-01-27 18:14:52 +0100362 };
363
David Brownelle9f13732008-01-27 18:14:52 +0100364 return i2c_new_device(adapter, &info);
365}
366EXPORT_SYMBOL_GPL(i2c_new_dummy);
367
David Brownellf37dd802007-02-13 22:09:00 +0100368/* ------------------------------------------------------------------------- */
369
David Brownell16ffadf2007-05-01 23:26:28 +0200370/* I2C bus adapters -- one roots each I2C or SMBUS segment */
371
Adrian Bunk83eaaed2007-10-13 23:56:30 +0200372static void i2c_adapter_dev_release(struct device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700373{
David Brownellef2c83212007-05-01 23:26:28 +0200374 struct i2c_adapter *adap = to_i2c_adapter(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700375 complete(&adap->dev_released);
376}
377
David Brownell16ffadf2007-05-01 23:26:28 +0200378static ssize_t
379show_adapter_name(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700380{
David Brownellef2c83212007-05-01 23:26:28 +0200381 struct i2c_adapter *adap = to_i2c_adapter(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700382 return sprintf(buf, "%s\n", adap->name);
383}
David Brownell16ffadf2007-05-01 23:26:28 +0200384
385static struct device_attribute i2c_adapter_attrs[] = {
386 __ATTR(name, S_IRUGO, show_adapter_name, NULL),
387 { },
388};
389
Adrian Bunk83eaaed2007-10-13 23:56:30 +0200390static struct class i2c_adapter_class = {
David Brownell16ffadf2007-05-01 23:26:28 +0200391 .owner = THIS_MODULE,
392 .name = "i2c-adapter",
393 .dev_attrs = i2c_adapter_attrs,
394};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395
David Brownell9c1600e2007-05-01 23:26:31 +0200396static void i2c_scan_static_board_info(struct i2c_adapter *adapter)
397{
398 struct i2c_devinfo *devinfo;
399
400 mutex_lock(&__i2c_board_lock);
401 list_for_each_entry(devinfo, &__i2c_board_list, list) {
402 if (devinfo->busnum == adapter->nr
403 && !i2c_new_device(adapter,
404 &devinfo->board_info))
405 printk(KERN_ERR "i2c-core: can't create i2c%d-%04x\n",
406 i2c_adapter_id(adapter),
407 devinfo->board_info.addr);
408 }
409 mutex_unlock(&__i2c_board_lock);
410}
411
Jean Delvare026526f2008-01-27 18:14:49 +0100412static int i2c_do_add_adapter(struct device_driver *d, void *data)
413{
414 struct i2c_driver *driver = to_i2c_driver(d);
415 struct i2c_adapter *adap = data;
416
417 if (driver->attach_adapter) {
418 /* We ignore the return code; if it fails, too bad */
419 driver->attach_adapter(adap);
420 }
421 return 0;
422}
423
David Brownell6e13e642007-05-01 23:26:31 +0200424static int i2c_register_adapter(struct i2c_adapter *adap)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700425{
Jean Delvare026526f2008-01-27 18:14:49 +0100426 int res = 0, dummy;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700427
Ingo Molnar5c085d32006-01-18 23:16:04 +0100428 mutex_init(&adap->bus_lock);
429 mutex_init(&adap->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700430 INIT_LIST_HEAD(&adap->clients);
431
Jean Delvarecaada322008-01-27 18:14:49 +0100432 mutex_lock(&core_lock);
David Brownell6e13e642007-05-01 23:26:31 +0200433
Linus Torvalds1da177e2005-04-16 15:20:36 -0700434 /* Add the adapter to the driver core.
435 * If the parent pointer is not set up,
436 * we add this adapter to the host bus.
437 */
David Brownellb119dc32007-01-04 13:07:04 +0100438 if (adap->dev.parent == NULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700439 adap->dev.parent = &platform_bus;
Jean Delvarefe2c8d52007-02-13 22:09:04 +0100440 pr_debug("I2C adapter driver [%s] forgot to specify "
441 "physical device\n", adap->name);
David Brownellb119dc32007-01-04 13:07:04 +0100442 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700443 sprintf(adap->dev.bus_id, "i2c-%d", adap->nr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700444 adap->dev.release = &i2c_adapter_dev_release;
Jean Delvarefccb56e2007-05-01 23:26:27 +0200445 adap->dev.class = &i2c_adapter_class;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200446 res = device_register(&adap->dev);
447 if (res)
448 goto out_list;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700449
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200450 dev_dbg(&adap->dev, "adapter [%s] registered\n", adap->name);
451
David Brownell6e13e642007-05-01 23:26:31 +0200452 /* create pre-declared device nodes for new-style drivers */
453 if (adap->nr < __i2c_first_dynamic_bus_num)
454 i2c_scan_static_board_info(adap);
455
David Brownell7b4fbc52007-05-01 23:26:30 +0200456 /* let legacy drivers scan this bus for matching devices */
Jean Delvare026526f2008-01-27 18:14:49 +0100457 dummy = bus_for_each_drv(&i2c_bus_type, NULL, adap,
458 i2c_do_add_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700459
Linus Torvalds1da177e2005-04-16 15:20:36 -0700460out_unlock:
Jean Delvarecaada322008-01-27 18:14:49 +0100461 mutex_unlock(&core_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700462 return res;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200463
Jean Delvareb119c6c2006-08-15 18:26:30 +0200464out_list:
Jean Delvareb119c6c2006-08-15 18:26:30 +0200465 idr_remove(&i2c_adapter_idr, adap->nr);
466 goto out_unlock;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700467}
468
David Brownell6e13e642007-05-01 23:26:31 +0200469/**
470 * i2c_add_adapter - declare i2c adapter, use dynamic bus number
471 * @adapter: the adapter to add
David Brownelld64f73b2007-07-12 14:12:28 +0200472 * Context: can sleep
David Brownell6e13e642007-05-01 23:26:31 +0200473 *
474 * This routine is used to declare an I2C adapter when its bus number
475 * doesn't matter. Examples: for I2C adapters dynamically added by
476 * USB links or PCI plugin cards.
477 *
478 * When this returns zero, a new bus number was allocated and stored
479 * in adap->nr, and the specified adapter became available for clients.
480 * Otherwise, a negative errno value is returned.
481 */
482int i2c_add_adapter(struct i2c_adapter *adapter)
483{
484 int id, res = 0;
485
486retry:
487 if (idr_pre_get(&i2c_adapter_idr, GFP_KERNEL) == 0)
488 return -ENOMEM;
489
Jean Delvarecaada322008-01-27 18:14:49 +0100490 mutex_lock(&core_lock);
David Brownell6e13e642007-05-01 23:26:31 +0200491 /* "above" here means "above or equal to", sigh */
492 res = idr_get_new_above(&i2c_adapter_idr, adapter,
493 __i2c_first_dynamic_bus_num, &id);
Jean Delvarecaada322008-01-27 18:14:49 +0100494 mutex_unlock(&core_lock);
David Brownell6e13e642007-05-01 23:26:31 +0200495
496 if (res < 0) {
497 if (res == -EAGAIN)
498 goto retry;
499 return res;
500 }
501
502 adapter->nr = id;
503 return i2c_register_adapter(adapter);
504}
505EXPORT_SYMBOL(i2c_add_adapter);
506
507/**
508 * i2c_add_numbered_adapter - declare i2c adapter, use static bus number
509 * @adap: the adapter to register (with adap->nr initialized)
David Brownelld64f73b2007-07-12 14:12:28 +0200510 * Context: can sleep
David Brownell6e13e642007-05-01 23:26:31 +0200511 *
512 * This routine is used to declare an I2C adapter when its bus number
Randy Dunlap8c07e462008-03-23 20:28:20 +0100513 * matters. For example, use it for I2C adapters from system-on-chip CPUs,
514 * or otherwise built in to the system's mainboard, and where i2c_board_info
David Brownell6e13e642007-05-01 23:26:31 +0200515 * is used to properly configure I2C devices.
516 *
517 * If no devices have pre-been declared for this bus, then be sure to
518 * register the adapter before any dynamically allocated ones. Otherwise
519 * the required bus ID may not be available.
520 *
521 * When this returns zero, the specified adapter became available for
522 * clients using the bus number provided in adap->nr. Also, the table
523 * of I2C devices pre-declared using i2c_register_board_info() is scanned,
524 * and the appropriate driver model device nodes are created. Otherwise, a
525 * negative errno value is returned.
526 */
527int i2c_add_numbered_adapter(struct i2c_adapter *adap)
528{
529 int id;
530 int status;
531
532 if (adap->nr & ~MAX_ID_MASK)
533 return -EINVAL;
534
535retry:
536 if (idr_pre_get(&i2c_adapter_idr, GFP_KERNEL) == 0)
537 return -ENOMEM;
538
Jean Delvarecaada322008-01-27 18:14:49 +0100539 mutex_lock(&core_lock);
David Brownell6e13e642007-05-01 23:26:31 +0200540 /* "above" here means "above or equal to", sigh;
541 * we need the "equal to" result to force the result
542 */
543 status = idr_get_new_above(&i2c_adapter_idr, adap, adap->nr, &id);
544 if (status == 0 && id != adap->nr) {
545 status = -EBUSY;
546 idr_remove(&i2c_adapter_idr, id);
547 }
Jean Delvarecaada322008-01-27 18:14:49 +0100548 mutex_unlock(&core_lock);
David Brownell6e13e642007-05-01 23:26:31 +0200549 if (status == -EAGAIN)
550 goto retry;
551
552 if (status == 0)
553 status = i2c_register_adapter(adap);
554 return status;
555}
556EXPORT_SYMBOL_GPL(i2c_add_numbered_adapter);
557
Jean Delvare026526f2008-01-27 18:14:49 +0100558static int i2c_do_del_adapter(struct device_driver *d, void *data)
559{
560 struct i2c_driver *driver = to_i2c_driver(d);
561 struct i2c_adapter *adapter = data;
562 int res;
563
564 if (!driver->detach_adapter)
565 return 0;
566 res = driver->detach_adapter(adapter);
567 if (res)
568 dev_err(&adapter->dev, "detach_adapter failed (%d) "
569 "for driver [%s]\n", res, driver->driver.name);
570 return res;
571}
572
David Brownelld64f73b2007-07-12 14:12:28 +0200573/**
574 * i2c_del_adapter - unregister I2C adapter
575 * @adap: the adapter being unregistered
576 * Context: can sleep
577 *
578 * This unregisters an I2C adapter which was previously registered
579 * by @i2c_add_adapter or @i2c_add_numbered_adapter.
580 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700581int i2c_del_adapter(struct i2c_adapter *adap)
582{
583 struct list_head *item, *_n;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700584 struct i2c_client *client;
585 int res = 0;
586
Jean Delvarecaada322008-01-27 18:14:49 +0100587 mutex_lock(&core_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700588
589 /* First make sure that this adapter was ever added */
Jean Delvare87c6c222008-01-27 18:14:48 +0100590 if (idr_find(&i2c_adapter_idr, adap->nr) != adap) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200591 pr_debug("i2c-core: attempting to delete unregistered "
592 "adapter [%s]\n", adap->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700593 res = -EINVAL;
594 goto out_unlock;
595 }
596
Jean Delvare026526f2008-01-27 18:14:49 +0100597 /* Tell drivers about this removal */
598 res = bus_for_each_drv(&i2c_bus_type, NULL, adap,
599 i2c_do_del_adapter);
600 if (res)
601 goto out_unlock;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700602
603 /* detach any active clients. This must be done first, because
Tobias Klausera551acc2005-05-19 21:40:38 +0200604 * it can fail; in which case we give up. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700605 list_for_each_safe(item, _n, &adap->clients) {
David Brownella1d9e6e2007-05-01 23:26:30 +0200606 struct i2c_driver *driver;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700607
David Brownella1d9e6e2007-05-01 23:26:30 +0200608 client = list_entry(item, struct i2c_client, list);
609 driver = client->driver;
610
611 /* new style, follow standard driver model */
612 if (!driver || is_newstyle_driver(driver)) {
613 i2c_unregister_device(client);
614 continue;
615 }
616
617 /* legacy drivers create and remove clients themselves */
618 if ((res = driver->detach_client(client))) {
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200619 dev_err(&adap->dev, "detach_client failed for client "
620 "[%s] at address 0x%02x\n", client->name,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700621 client->addr);
622 goto out_unlock;
623 }
624 }
625
626 /* clean up the sysfs representation */
627 init_completion(&adap->dev_released);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700628 device_unregister(&adap->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700629
630 /* wait for sysfs to drop all references */
631 wait_for_completion(&adap->dev_released);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700632
David Brownell6e13e642007-05-01 23:26:31 +0200633 /* free bus id */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700634 idr_remove(&i2c_adapter_idr, adap->nr);
635
Jean Delvareb6d7b3d2005-07-31 19:02:53 +0200636 dev_dbg(&adap->dev, "adapter [%s] unregistered\n", adap->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700637
638 out_unlock:
Jean Delvarecaada322008-01-27 18:14:49 +0100639 mutex_unlock(&core_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700640 return res;
641}
David Brownellc0564602007-05-01 23:26:31 +0200642EXPORT_SYMBOL(i2c_del_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700643
644
David Brownell7b4fbc52007-05-01 23:26:30 +0200645/* ------------------------------------------------------------------------- */
646
Dave Young7f101a92008-07-14 22:38:19 +0200647static int __attach_adapter(struct device *dev, void *data)
648{
649 struct i2c_adapter *adapter = to_i2c_adapter(dev);
650 struct i2c_driver *driver = data;
651
652 driver->attach_adapter(adapter);
653
654 return 0;
655}
656
David Brownell7b4fbc52007-05-01 23:26:30 +0200657/*
658 * An i2c_driver is used with one or more i2c_client (device) nodes to access
659 * i2c slave chips, on a bus instance associated with some i2c_adapter. There
660 * are two models for binding the driver to its device: "new style" drivers
661 * follow the standard Linux driver model and just respond to probe() calls
662 * issued if the driver core sees they match(); "legacy" drivers create device
663 * nodes themselves.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700664 */
665
Greg Kroah-Hartmande59cf92005-12-06 15:33:15 -0800666int i2c_register_driver(struct module *owner, struct i2c_driver *driver)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700667{
Jean Delvare7eebcb72006-02-05 23:28:21 +0100668 int res;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700669
David Brownell7b4fbc52007-05-01 23:26:30 +0200670 /* new style driver methods can't mix with legacy ones */
David Brownella1d9e6e2007-05-01 23:26:30 +0200671 if (is_newstyle_driver(driver)) {
David Brownell7b4fbc52007-05-01 23:26:30 +0200672 if (driver->attach_adapter || driver->detach_adapter
673 || driver->detach_client) {
674 printk(KERN_WARNING
675 "i2c-core: driver [%s] is confused\n",
676 driver->driver.name);
677 return -EINVAL;
678 }
679 }
680
Linus Torvalds1da177e2005-04-16 15:20:36 -0700681 /* add the driver to the list of i2c drivers in the driver core */
Greg Kroah-Hartmande59cf92005-12-06 15:33:15 -0800682 driver->driver.owner = owner;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700683 driver->driver.bus = &i2c_bus_type;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700684
David Brownell6e13e642007-05-01 23:26:31 +0200685 /* for new style drivers, when registration returns the driver core
686 * will have called probe() for all matching-but-unbound devices.
687 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700688 res = driver_register(&driver->driver);
689 if (res)
Jean Delvare7eebcb72006-02-05 23:28:21 +0100690 return res;
David Brownell438d6c22006-12-10 21:21:31 +0100691
Jean Delvarecaada322008-01-27 18:14:49 +0100692 mutex_lock(&core_lock);
Jean Delvare7eebcb72006-02-05 23:28:21 +0100693
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100694 pr_debug("i2c-core: driver [%s] registered\n", driver->driver.name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700695
David Brownell7b4fbc52007-05-01 23:26:30 +0200696 /* legacy drivers scan i2c busses directly */
Dave Young7f101a92008-07-14 22:38:19 +0200697 if (driver->attach_adapter)
698 class_for_each_device(&i2c_adapter_class, driver,
699 __attach_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700700
Jean Delvarecaada322008-01-27 18:14:49 +0100701 mutex_unlock(&core_lock);
Jean Delvare7eebcb72006-02-05 23:28:21 +0100702 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700703}
Greg Kroah-Hartmande59cf92005-12-06 15:33:15 -0800704EXPORT_SYMBOL(i2c_register_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700705
Dave Young7f101a92008-07-14 22:38:19 +0200706static int __detach_adapter(struct device *dev, void *data)
707{
708 struct i2c_adapter *adapter = to_i2c_adapter(dev);
709 struct i2c_driver *driver = data;
710
711 /* Have a look at each adapter, if clients of this driver are still
712 * attached. If so, detach them to be able to kill the driver
713 * afterwards.
714 */
715 if (driver->detach_adapter) {
716 if (driver->detach_adapter(adapter))
717 dev_err(&adapter->dev,
718 "detach_adapter failed for driver [%s]\n",
719 driver->driver.name);
720 } else {
721 struct list_head *item, *_n;
722 struct i2c_client *client;
723
724 list_for_each_safe(item, _n, &adapter->clients) {
725 client = list_entry(item, struct i2c_client, list);
726 if (client->driver != driver)
727 continue;
728 dev_dbg(&adapter->dev,
729 "detaching client [%s] at 0x%02x\n",
730 client->name, client->addr);
731 if (driver->detach_client(client))
732 dev_err(&adapter->dev, "detach_client "
733 "failed for client [%s] at 0x%02x\n",
734 client->name, client->addr);
735 }
736 }
737
738 return 0;
739}
740
David Brownella1d9e6e2007-05-01 23:26:30 +0200741/**
742 * i2c_del_driver - unregister I2C driver
743 * @driver: the driver being unregistered
David Brownelld64f73b2007-07-12 14:12:28 +0200744 * Context: can sleep
David Brownella1d9e6e2007-05-01 23:26:30 +0200745 */
Jean Delvareb3e82092007-05-01 23:26:32 +0200746void i2c_del_driver(struct i2c_driver *driver)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700747{
Jean Delvarecaada322008-01-27 18:14:49 +0100748 mutex_lock(&core_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700749
David Brownella1d9e6e2007-05-01 23:26:30 +0200750 /* new-style driver? */
751 if (is_newstyle_driver(driver))
752 goto unregister;
753
Dave Young7f101a92008-07-14 22:38:19 +0200754 class_for_each_device(&i2c_adapter_class, driver, __detach_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700755
David Brownella1d9e6e2007-05-01 23:26:30 +0200756 unregister:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700757 driver_unregister(&driver->driver);
Laurent Riffard35d8b2e2005-11-26 20:34:05 +0100758 pr_debug("i2c-core: driver [%s] unregistered\n", driver->driver.name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700759
Jean Delvarecaada322008-01-27 18:14:49 +0100760 mutex_unlock(&core_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700761}
David Brownellc0564602007-05-01 23:26:31 +0200762EXPORT_SYMBOL(i2c_del_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700763
David Brownell7b4fbc52007-05-01 23:26:30 +0200764/* ------------------------------------------------------------------------- */
765
David Brownell9b766b82008-01-27 18:14:51 +0100766static int __i2c_check_addr(struct device *dev, void *addrp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700767{
David Brownell9b766b82008-01-27 18:14:51 +0100768 struct i2c_client *client = i2c_verify_client(dev);
769 int addr = *(int *)addrp;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700770
David Brownell9b766b82008-01-27 18:14:51 +0100771 if (client && client->addr == addr)
772 return -EBUSY;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700773 return 0;
774}
775
Jean Delvare5e31c2b2007-11-15 19:24:02 +0100776static int i2c_check_addr(struct i2c_adapter *adapter, int addr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700777{
David Brownell9b766b82008-01-27 18:14:51 +0100778 return device_for_each_child(&adapter->dev, &addr, __i2c_check_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700779}
780
781int i2c_attach_client(struct i2c_client *client)
782{
783 struct i2c_adapter *adapter = client->adapter;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200784 int res = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700785
Linus Torvalds1da177e2005-04-16 15:20:36 -0700786 client->dev.parent = &client->adapter->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700787 client->dev.bus = &i2c_bus_type;
David Brownell9c1600e2007-05-01 23:26:31 +0200788
789 if (client->driver)
790 client->dev.driver = &client->driver->driver;
791
David Brownellde81d2a2007-05-22 19:49:16 +0200792 if (client->driver && !is_newstyle_driver(client->driver)) {
David Brownell9c1600e2007-05-01 23:26:31 +0200793 client->dev.release = i2c_client_release;
David Brownellde81d2a2007-05-22 19:49:16 +0200794 client->dev.uevent_suppress = 1;
795 } else
David Brownell9c1600e2007-05-01 23:26:31 +0200796 client->dev.release = i2c_client_dev_release;
David Brownell438d6c22006-12-10 21:21:31 +0100797
Linus Torvalds1da177e2005-04-16 15:20:36 -0700798 snprintf(&client->dev.bus_id[0], sizeof(client->dev.bus_id),
799 "%d-%04x", i2c_adapter_id(adapter), client->addr);
Jean Delvareb119c6c2006-08-15 18:26:30 +0200800 res = device_register(&client->dev);
801 if (res)
David Brownell86ec5ec2008-01-27 18:14:51 +0100802 goto out_err;
803
804 mutex_lock(&adapter->clist_lock);
805 list_add_tail(&client->list, &adapter->clients);
Jean Delvareb119c6c2006-08-15 18:26:30 +0200806 mutex_unlock(&adapter->clist_lock);
Jean Delvare77ed74d2006-09-30 17:18:59 +0200807
David Brownell86ec5ec2008-01-27 18:14:51 +0100808 dev_dbg(&adapter->dev, "client [%s] registered with bus id %s\n",
809 client->name, client->dev.bus_id);
810
Jean Delvare77ed74d2006-09-30 17:18:59 +0200811 if (adapter->client_register) {
812 if (adapter->client_register(client)) {
813 dev_dbg(&adapter->dev, "client_register "
814 "failed for client [%s] at 0x%02x\n",
815 client->name, client->addr);
816 }
817 }
818
819 return 0;
Jean Delvareb119c6c2006-08-15 18:26:30 +0200820
David Brownell86ec5ec2008-01-27 18:14:51 +0100821out_err:
Jean Delvareb119c6c2006-08-15 18:26:30 +0200822 dev_err(&adapter->dev, "Failed to attach i2c client %s at 0x%02x "
823 "(%d)\n", client->name, client->addr, res);
Jean Delvare77ed74d2006-09-30 17:18:59 +0200824 return res;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700825}
David Brownellc0564602007-05-01 23:26:31 +0200826EXPORT_SYMBOL(i2c_attach_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700827
828int i2c_detach_client(struct i2c_client *client)
829{
830 struct i2c_adapter *adapter = client->adapter;
831 int res = 0;
David Brownell438d6c22006-12-10 21:21:31 +0100832
Linus Torvalds1da177e2005-04-16 15:20:36 -0700833 if (adapter->client_unregister) {
834 res = adapter->client_unregister(client);
835 if (res) {
836 dev_err(&client->dev,
Jean Delvare86749e82005-07-29 12:15:29 -0700837 "client_unregister [%s] failed, "
838 "client not detached\n", client->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700839 goto out;
840 }
841 }
842
Ingo Molnar5c085d32006-01-18 23:16:04 +0100843 mutex_lock(&adapter->clist_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700844 list_del(&client->list);
Jean Delvare9ddced12008-01-27 18:14:51 +0100845 mutex_unlock(&adapter->clist_lock);
846
Linus Torvalds1da177e2005-04-16 15:20:36 -0700847 init_completion(&client->released);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700848 device_unregister(&client->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700849 wait_for_completion(&client->released);
850
851 out:
852 return res;
853}
David Brownellc0564602007-05-01 23:26:31 +0200854EXPORT_SYMBOL(i2c_detach_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700855
Jean Delvaree48d3312008-01-27 18:14:48 +0100856/**
857 * i2c_use_client - increments the reference count of the i2c client structure
858 * @client: the client being referenced
859 *
860 * Each live reference to a client should be refcounted. The driver model does
861 * that automatically as part of driver binding, so that most drivers don't
862 * need to do this explicitly: they hold a reference until they're unbound
863 * from the device.
864 *
865 * A pointer to the client with the incremented reference counter is returned.
866 */
867struct i2c_client *i2c_use_client(struct i2c_client *client)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700868{
Jean Delvarebdc511f2008-01-27 18:14:48 +0100869 get_device(&client->dev);
Jean Delvaree48d3312008-01-27 18:14:48 +0100870 return client;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700871}
David Brownellc0564602007-05-01 23:26:31 +0200872EXPORT_SYMBOL(i2c_use_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700873
Jean Delvaree48d3312008-01-27 18:14:48 +0100874/**
875 * i2c_release_client - release a use of the i2c client structure
876 * @client: the client being no longer referenced
877 *
878 * Must be called when a user of a client is finished with it.
879 */
880void i2c_release_client(struct i2c_client *client)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700881{
Jean Delvarebdc511f2008-01-27 18:14:48 +0100882 put_device(&client->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700883}
David Brownellc0564602007-05-01 23:26:31 +0200884EXPORT_SYMBOL(i2c_release_client);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700885
David Brownell9b766b82008-01-27 18:14:51 +0100886struct i2c_cmd_arg {
887 unsigned cmd;
888 void *arg;
889};
890
891static int i2c_cmd(struct device *dev, void *_arg)
892{
893 struct i2c_client *client = i2c_verify_client(dev);
894 struct i2c_cmd_arg *arg = _arg;
895
896 if (client && client->driver && client->driver->command)
897 client->driver->command(client, arg->cmd, arg->arg);
898 return 0;
899}
900
Linus Torvalds1da177e2005-04-16 15:20:36 -0700901void i2c_clients_command(struct i2c_adapter *adap, unsigned int cmd, void *arg)
902{
David Brownell9b766b82008-01-27 18:14:51 +0100903 struct i2c_cmd_arg cmd_arg;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700904
David Brownell9b766b82008-01-27 18:14:51 +0100905 cmd_arg.cmd = cmd;
906 cmd_arg.arg = arg;
907 device_for_each_child(&adap->dev, &cmd_arg, i2c_cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700908}
David Brownellc0564602007-05-01 23:26:31 +0200909EXPORT_SYMBOL(i2c_clients_command);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700910
911static int __init i2c_init(void)
912{
913 int retval;
914
915 retval = bus_register(&i2c_bus_type);
916 if (retval)
917 return retval;
David Brownelle9f13732008-01-27 18:14:52 +0100918 retval = class_register(&i2c_adapter_class);
919 if (retval)
920 goto bus_err;
921 retval = i2c_add_driver(&dummy_driver);
922 if (retval)
923 goto class_err;
924 return 0;
925
926class_err:
927 class_unregister(&i2c_adapter_class);
928bus_err:
929 bus_unregister(&i2c_bus_type);
930 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700931}
932
933static void __exit i2c_exit(void)
934{
David Brownelle9f13732008-01-27 18:14:52 +0100935 i2c_del_driver(&dummy_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700936 class_unregister(&i2c_adapter_class);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700937 bus_unregister(&i2c_bus_type);
938}
939
940subsys_initcall(i2c_init);
941module_exit(i2c_exit);
942
943/* ----------------------------------------------------
944 * the functional interface to the i2c busses.
945 * ----------------------------------------------------
946 */
947
948int i2c_transfer(struct i2c_adapter * adap, struct i2c_msg *msgs, int num)
949{
950 int ret;
951
952 if (adap->algo->master_xfer) {
953#ifdef DEBUG
954 for (ret = 0; ret < num; ret++) {
955 dev_dbg(&adap->dev, "master_xfer[%d] %c, addr=0x%02x, "
Jean Delvare209d27c2007-05-01 23:26:29 +0200956 "len=%d%s\n", ret, (msgs[ret].flags & I2C_M_RD)
957 ? 'R' : 'W', msgs[ret].addr, msgs[ret].len,
958 (msgs[ret].flags & I2C_M_RECV_LEN) ? "+" : "");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700959 }
960#endif
961
Mike Rapoportcea443a2008-01-27 18:14:50 +0100962 if (in_atomic() || irqs_disabled()) {
963 ret = mutex_trylock(&adap->bus_lock);
964 if (!ret)
965 /* I2C activity is ongoing. */
966 return -EAGAIN;
967 } else {
968 mutex_lock_nested(&adap->bus_lock, adap->level);
969 }
970
Linus Torvalds1da177e2005-04-16 15:20:36 -0700971 ret = adap->algo->master_xfer(adap,msgs,num);
Ingo Molnar5c085d32006-01-18 23:16:04 +0100972 mutex_unlock(&adap->bus_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700973
974 return ret;
975 } else {
976 dev_dbg(&adap->dev, "I2C level transfers not supported\n");
977 return -ENOSYS;
978 }
979}
David Brownellc0564602007-05-01 23:26:31 +0200980EXPORT_SYMBOL(i2c_transfer);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700981
982int i2c_master_send(struct i2c_client *client,const char *buf ,int count)
983{
984 int ret;
985 struct i2c_adapter *adap=client->adapter;
986 struct i2c_msg msg;
987
Jean Delvare815f55f2005-05-07 22:58:46 +0200988 msg.addr = client->addr;
989 msg.flags = client->flags & I2C_M_TEN;
990 msg.len = count;
991 msg.buf = (char *)buf;
David Brownell438d6c22006-12-10 21:21:31 +0100992
Jean Delvare815f55f2005-05-07 22:58:46 +0200993 ret = i2c_transfer(adap, &msg, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700994
Jean Delvare815f55f2005-05-07 22:58:46 +0200995 /* If everything went ok (i.e. 1 msg transmitted), return #bytes
996 transmitted, else error code. */
997 return (ret == 1) ? count : ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700998}
David Brownellc0564602007-05-01 23:26:31 +0200999EXPORT_SYMBOL(i2c_master_send);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001000
1001int i2c_master_recv(struct i2c_client *client, char *buf ,int count)
1002{
1003 struct i2c_adapter *adap=client->adapter;
1004 struct i2c_msg msg;
1005 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001006
Jean Delvare815f55f2005-05-07 22:58:46 +02001007 msg.addr = client->addr;
1008 msg.flags = client->flags & I2C_M_TEN;
1009 msg.flags |= I2C_M_RD;
1010 msg.len = count;
1011 msg.buf = buf;
1012
1013 ret = i2c_transfer(adap, &msg, 1);
1014
1015 /* If everything went ok (i.e. 1 msg transmitted), return #bytes
1016 transmitted, else error code. */
1017 return (ret == 1) ? count : ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001018}
David Brownellc0564602007-05-01 23:26:31 +02001019EXPORT_SYMBOL(i2c_master_recv);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001020
Linus Torvalds1da177e2005-04-16 15:20:36 -07001021/* ----------------------------------------------------
1022 * the i2c address scanning function
1023 * Will not work for 10-bit addresses!
1024 * ----------------------------------------------------
1025 */
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001026static int i2c_probe_address(struct i2c_adapter *adapter, int addr, int kind,
1027 int (*found_proc) (struct i2c_adapter *, int, int))
Jean Delvare9fc6adf2005-07-31 21:20:43 +02001028{
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001029 int err;
Jean Delvare9fc6adf2005-07-31 21:20:43 +02001030
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001031 /* Make sure the address is valid */
1032 if (addr < 0x03 || addr > 0x77) {
1033 dev_warn(&adapter->dev, "Invalid probe address 0x%02x\n",
1034 addr);
1035 return -EINVAL;
Jean Delvare9fc6adf2005-07-31 21:20:43 +02001036 }
1037
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001038 /* Skip if already in use */
1039 if (i2c_check_addr(adapter, addr))
1040 return 0;
1041
1042 /* Make sure there is something at this address, unless forced */
Jean Delvare4c9337d2005-08-09 20:28:10 +02001043 if (kind < 0) {
1044 if (i2c_smbus_xfer(adapter, addr, 0, 0, 0,
1045 I2C_SMBUS_QUICK, NULL) < 0)
1046 return 0;
1047
1048 /* prevent 24RF08 corruption */
1049 if ((addr & ~0x0f) == 0x50)
1050 i2c_smbus_xfer(adapter, addr, 0, 0, 0,
1051 I2C_SMBUS_QUICK, NULL);
1052 }
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001053
1054 /* Finally call the custom detection function */
1055 err = found_proc(adapter, addr, kind);
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001056 /* -ENODEV can be returned if there is a chip at the given address
1057 but it isn't supported by this chip driver. We catch it here as
1058 this isn't an error. */
Jean Delvare114fd182006-09-03 22:25:04 +02001059 if (err == -ENODEV)
1060 err = 0;
1061
1062 if (err)
1063 dev_warn(&adapter->dev, "Client creation failed at 0x%x (%d)\n",
1064 addr, err);
1065 return err;
Jean Delvare9fc6adf2005-07-31 21:20:43 +02001066}
1067
Linus Torvalds1da177e2005-04-16 15:20:36 -07001068int i2c_probe(struct i2c_adapter *adapter,
Mark M. Hoffmanbfb6df22008-01-27 18:14:46 +01001069 const struct i2c_client_address_data *address_data,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001070 int (*found_proc) (struct i2c_adapter *, int, int))
1071{
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001072 int i, err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001073 int adap_id = i2c_adapter_id(adapter);
1074
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001075 /* Force entries are done first, and are not affected by ignore
1076 entries */
1077 if (address_data->forces) {
Mark M. Hoffmanbfb6df22008-01-27 18:14:46 +01001078 const unsigned short * const *forces = address_data->forces;
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001079 int kind;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001080
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001081 for (kind = 0; forces[kind]; kind++) {
1082 for (i = 0; forces[kind][i] != I2C_CLIENT_END;
1083 i += 2) {
1084 if (forces[kind][i] == adap_id
1085 || forces[kind][i] == ANY_I2C_BUS) {
1086 dev_dbg(&adapter->dev, "found force "
1087 "parameter for adapter %d, "
1088 "addr 0x%02x, kind %d\n",
1089 adap_id, forces[kind][i + 1],
1090 kind);
1091 err = i2c_probe_address(adapter,
1092 forces[kind][i + 1],
1093 kind, found_proc);
1094 if (err)
1095 return err;
1096 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001097 }
1098 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001099 }
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001100
Jean Delvare4366dc92005-09-25 16:50:06 +02001101 /* Stop here if we can't use SMBUS_QUICK */
1102 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_QUICK)) {
1103 if (address_data->probe[0] == I2C_CLIENT_END
1104 && address_data->normal_i2c[0] == I2C_CLIENT_END)
David Brownell438d6c22006-12-10 21:21:31 +01001105 return 0;
Jean Delvare4366dc92005-09-25 16:50:06 +02001106
1107 dev_warn(&adapter->dev, "SMBus Quick command not supported, "
1108 "can't probe for chips\n");
1109 return -1;
1110 }
1111
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001112 /* Probe entries are done second, and are not affected by ignore
1113 entries either */
1114 for (i = 0; address_data->probe[i] != I2C_CLIENT_END; i += 2) {
1115 if (address_data->probe[i] == adap_id
1116 || address_data->probe[i] == ANY_I2C_BUS) {
1117 dev_dbg(&adapter->dev, "found probe parameter for "
1118 "adapter %d, addr 0x%02x\n", adap_id,
1119 address_data->probe[i + 1]);
1120 err = i2c_probe_address(adapter,
1121 address_data->probe[i + 1],
1122 -1, found_proc);
1123 if (err)
1124 return err;
1125 }
1126 }
1127
1128 /* Normal entries are done last, unless shadowed by an ignore entry */
1129 for (i = 0; address_data->normal_i2c[i] != I2C_CLIENT_END; i += 1) {
1130 int j, ignore;
1131
1132 ignore = 0;
1133 for (j = 0; address_data->ignore[j] != I2C_CLIENT_END;
1134 j += 2) {
1135 if ((address_data->ignore[j] == adap_id ||
1136 address_data->ignore[j] == ANY_I2C_BUS)
1137 && address_data->ignore[j + 1]
1138 == address_data->normal_i2c[i]) {
1139 dev_dbg(&adapter->dev, "found ignore "
1140 "parameter for adapter %d, "
1141 "addr 0x%02x\n", adap_id,
1142 address_data->ignore[j + 1]);
Mark M. Hoffman2369df92006-07-01 17:01:59 +02001143 ignore = 1;
1144 break;
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001145 }
Jean Delvarea89ba0b2005-08-09 20:17:55 +02001146 }
1147 if (ignore)
1148 continue;
1149
1150 dev_dbg(&adapter->dev, "found normal entry for adapter %d, "
1151 "addr 0x%02x\n", adap_id,
1152 address_data->normal_i2c[i]);
1153 err = i2c_probe_address(adapter, address_data->normal_i2c[i],
1154 -1, found_proc);
1155 if (err)
1156 return err;
1157 }
1158
Linus Torvalds1da177e2005-04-16 15:20:36 -07001159 return 0;
1160}
David Brownellc0564602007-05-01 23:26:31 +02001161EXPORT_SYMBOL(i2c_probe);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001162
Jean Delvare12b5053a2007-05-01 23:26:31 +02001163struct i2c_client *
1164i2c_new_probed_device(struct i2c_adapter *adap,
1165 struct i2c_board_info *info,
1166 unsigned short const *addr_list)
1167{
1168 int i;
1169
1170 /* Stop here if the bus doesn't support probing */
1171 if (!i2c_check_functionality(adap, I2C_FUNC_SMBUS_READ_BYTE)) {
1172 dev_err(&adap->dev, "Probing not supported\n");
1173 return NULL;
1174 }
1175
Jean Delvare12b5053a2007-05-01 23:26:31 +02001176 for (i = 0; addr_list[i] != I2C_CLIENT_END; i++) {
1177 /* Check address validity */
1178 if (addr_list[i] < 0x03 || addr_list[i] > 0x77) {
1179 dev_warn(&adap->dev, "Invalid 7-bit address "
1180 "0x%02x\n", addr_list[i]);
1181 continue;
1182 }
1183
1184 /* Check address availability */
David Brownell9b766b82008-01-27 18:14:51 +01001185 if (i2c_check_addr(adap, addr_list[i])) {
Jean Delvare12b5053a2007-05-01 23:26:31 +02001186 dev_dbg(&adap->dev, "Address 0x%02x already in "
1187 "use, not probing\n", addr_list[i]);
1188 continue;
1189 }
1190
1191 /* Test address responsiveness
1192 The default probe method is a quick write, but it is known
1193 to corrupt the 24RF08 EEPROMs due to a state machine bug,
1194 and could also irreversibly write-protect some EEPROMs, so
1195 for address ranges 0x30-0x37 and 0x50-0x5f, we use a byte
1196 read instead. Also, some bus drivers don't implement
1197 quick write, so we fallback to a byte read it that case
1198 too. */
1199 if ((addr_list[i] & ~0x07) == 0x30
1200 || (addr_list[i] & ~0x0f) == 0x50
1201 || !i2c_check_functionality(adap, I2C_FUNC_SMBUS_QUICK)) {
1202 if (i2c_smbus_xfer(adap, addr_list[i], 0,
1203 I2C_SMBUS_READ, 0,
1204 I2C_SMBUS_BYTE, NULL) >= 0)
1205 break;
1206 } else {
1207 if (i2c_smbus_xfer(adap, addr_list[i], 0,
1208 I2C_SMBUS_WRITE, 0,
1209 I2C_SMBUS_QUICK, NULL) >= 0)
1210 break;
1211 }
1212 }
Jean Delvare12b5053a2007-05-01 23:26:31 +02001213
1214 if (addr_list[i] == I2C_CLIENT_END) {
1215 dev_dbg(&adap->dev, "Probing failed, no device found\n");
1216 return NULL;
1217 }
1218
1219 info->addr = addr_list[i];
1220 return i2c_new_device(adap, info);
1221}
1222EXPORT_SYMBOL_GPL(i2c_new_probed_device);
1223
Linus Torvalds1da177e2005-04-16 15:20:36 -07001224struct i2c_adapter* i2c_get_adapter(int id)
1225{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001226 struct i2c_adapter *adapter;
David Brownell438d6c22006-12-10 21:21:31 +01001227
Jean Delvarecaada322008-01-27 18:14:49 +01001228 mutex_lock(&core_lock);
Mark M. Hoffmana0920e12005-06-28 00:21:30 -04001229 adapter = (struct i2c_adapter *)idr_find(&i2c_adapter_idr, id);
1230 if (adapter && !try_module_get(adapter->owner))
1231 adapter = NULL;
1232
Jean Delvarecaada322008-01-27 18:14:49 +01001233 mutex_unlock(&core_lock);
Mark M. Hoffmana0920e12005-06-28 00:21:30 -04001234 return adapter;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001235}
David Brownellc0564602007-05-01 23:26:31 +02001236EXPORT_SYMBOL(i2c_get_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001237
1238void i2c_put_adapter(struct i2c_adapter *adap)
1239{
1240 module_put(adap->owner);
1241}
David Brownellc0564602007-05-01 23:26:31 +02001242EXPORT_SYMBOL(i2c_put_adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001243
1244/* The SMBus parts */
1245
David Brownell438d6c22006-12-10 21:21:31 +01001246#define POLY (0x1070U << 3)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001247static u8
1248crc8(u16 data)
1249{
1250 int i;
David Brownell438d6c22006-12-10 21:21:31 +01001251
Linus Torvalds1da177e2005-04-16 15:20:36 -07001252 for(i = 0; i < 8; i++) {
David Brownell438d6c22006-12-10 21:21:31 +01001253 if (data & 0x8000)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001254 data = data ^ POLY;
1255 data = data << 1;
1256 }
1257 return (u8)(data >> 8);
1258}
1259
Jean Delvare421ef472005-10-26 21:28:55 +02001260/* Incremental CRC8 over count bytes in the array pointed to by p */
1261static u8 i2c_smbus_pec(u8 crc, u8 *p, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001262{
1263 int i;
1264
1265 for(i = 0; i < count; i++)
Jean Delvare421ef472005-10-26 21:28:55 +02001266 crc = crc8((crc ^ p[i]) << 8);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001267 return crc;
1268}
1269
Jean Delvare421ef472005-10-26 21:28:55 +02001270/* Assume a 7-bit address, which is reasonable for SMBus */
1271static u8 i2c_smbus_msg_pec(u8 pec, struct i2c_msg *msg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001272{
Jean Delvare421ef472005-10-26 21:28:55 +02001273 /* The address will be sent first */
1274 u8 addr = (msg->addr << 1) | !!(msg->flags & I2C_M_RD);
1275 pec = i2c_smbus_pec(pec, &addr, 1);
1276
1277 /* The data buffer follows */
1278 return i2c_smbus_pec(pec, msg->buf, msg->len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001279}
1280
Jean Delvare421ef472005-10-26 21:28:55 +02001281/* Used for write only transactions */
1282static inline void i2c_smbus_add_pec(struct i2c_msg *msg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001283{
Jean Delvare421ef472005-10-26 21:28:55 +02001284 msg->buf[msg->len] = i2c_smbus_msg_pec(0, msg);
1285 msg->len++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001286}
1287
Jean Delvare421ef472005-10-26 21:28:55 +02001288/* Return <0 on CRC error
1289 If there was a write before this read (most cases) we need to take the
1290 partial CRC from the write part into account.
1291 Note that this function does modify the message (we need to decrease the
1292 message length to hide the CRC byte from the caller). */
1293static int i2c_smbus_check_pec(u8 cpec, struct i2c_msg *msg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001294{
Jean Delvare421ef472005-10-26 21:28:55 +02001295 u8 rpec = msg->buf[--msg->len];
1296 cpec = i2c_smbus_msg_pec(cpec, msg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001297
Linus Torvalds1da177e2005-04-16 15:20:36 -07001298 if (rpec != cpec) {
1299 pr_debug("i2c-core: Bad PEC 0x%02x vs. 0x%02x\n",
1300 rpec, cpec);
1301 return -1;
1302 }
David Brownell438d6c22006-12-10 21:21:31 +01001303 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001304}
1305
1306s32 i2c_smbus_write_quick(struct i2c_client *client, u8 value)
1307{
1308 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
David Brownell438d6c22006-12-10 21:21:31 +01001309 value,0,I2C_SMBUS_QUICK,NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001310}
David Brownellc0564602007-05-01 23:26:31 +02001311EXPORT_SYMBOL(i2c_smbus_write_quick);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001312
1313s32 i2c_smbus_read_byte(struct i2c_client *client)
1314{
1315 union i2c_smbus_data data;
1316 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1317 I2C_SMBUS_READ,0,I2C_SMBUS_BYTE, &data))
1318 return -1;
1319 else
Jean Delvare7eff82c2006-09-03 22:24:00 +02001320 return data.byte;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001321}
David Brownellc0564602007-05-01 23:26:31 +02001322EXPORT_SYMBOL(i2c_smbus_read_byte);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001323
1324s32 i2c_smbus_write_byte(struct i2c_client *client, u8 value)
1325{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001326 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
Jean Delvare421ef472005-10-26 21:28:55 +02001327 I2C_SMBUS_WRITE, value, I2C_SMBUS_BYTE, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001328}
David Brownellc0564602007-05-01 23:26:31 +02001329EXPORT_SYMBOL(i2c_smbus_write_byte);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001330
1331s32 i2c_smbus_read_byte_data(struct i2c_client *client, u8 command)
1332{
1333 union i2c_smbus_data data;
1334 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1335 I2C_SMBUS_READ,command, I2C_SMBUS_BYTE_DATA,&data))
1336 return -1;
1337 else
Jean Delvare7eff82c2006-09-03 22:24:00 +02001338 return data.byte;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001339}
David Brownellc0564602007-05-01 23:26:31 +02001340EXPORT_SYMBOL(i2c_smbus_read_byte_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001341
1342s32 i2c_smbus_write_byte_data(struct i2c_client *client, u8 command, u8 value)
1343{
1344 union i2c_smbus_data data;
1345 data.byte = value;
1346 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1347 I2C_SMBUS_WRITE,command,
1348 I2C_SMBUS_BYTE_DATA,&data);
1349}
David Brownellc0564602007-05-01 23:26:31 +02001350EXPORT_SYMBOL(i2c_smbus_write_byte_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001351
1352s32 i2c_smbus_read_word_data(struct i2c_client *client, u8 command)
1353{
1354 union i2c_smbus_data data;
1355 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1356 I2C_SMBUS_READ,command, I2C_SMBUS_WORD_DATA, &data))
1357 return -1;
1358 else
Jean Delvare7eff82c2006-09-03 22:24:00 +02001359 return data.word;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001360}
David Brownellc0564602007-05-01 23:26:31 +02001361EXPORT_SYMBOL(i2c_smbus_read_word_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001362
1363s32 i2c_smbus_write_word_data(struct i2c_client *client, u8 command, u16 value)
1364{
1365 union i2c_smbus_data data;
1366 data.word = value;
1367 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1368 I2C_SMBUS_WRITE,command,
1369 I2C_SMBUS_WORD_DATA,&data);
1370}
David Brownellc0564602007-05-01 23:26:31 +02001371EXPORT_SYMBOL(i2c_smbus_write_word_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001372
David Brownella64ec072007-10-13 23:56:31 +02001373/**
1374 * i2c_smbus_read_block_data - SMBus block read request
1375 * @client: Handle to slave device
1376 * @command: Command byte issued to let the slave know what data should
1377 * be returned
1378 * @values: Byte array into which data will be read; big enough to hold
1379 * the data returned by the slave. SMBus allows at most 32 bytes.
1380 *
1381 * Returns the number of bytes read in the slave's response, else a
1382 * negative number to indicate some kind of error.
1383 *
1384 * Note that using this function requires that the client's adapter support
1385 * the I2C_FUNC_SMBUS_READ_BLOCK_DATA functionality. Not all adapter drivers
1386 * support this; its emulation through I2C messaging relies on a specific
1387 * mechanism (I2C_M_RECV_LEN) which may not be implemented.
1388 */
Jean Delvareb86a1bc2007-05-01 23:26:34 +02001389s32 i2c_smbus_read_block_data(struct i2c_client *client, u8 command,
1390 u8 *values)
1391{
1392 union i2c_smbus_data data;
1393
1394 if (i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1395 I2C_SMBUS_READ, command,
1396 I2C_SMBUS_BLOCK_DATA, &data))
1397 return -1;
1398
1399 memcpy(values, &data.block[1], data.block[0]);
1400 return data.block[0];
1401}
1402EXPORT_SYMBOL(i2c_smbus_read_block_data);
1403
Linus Torvalds1da177e2005-04-16 15:20:36 -07001404s32 i2c_smbus_write_block_data(struct i2c_client *client, u8 command,
Krzysztof Halasa46f5ed72006-06-12 21:42:20 +02001405 u8 length, const u8 *values)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001406{
1407 union i2c_smbus_data data;
Jean Delvare76560322006-01-18 23:14:55 +01001408
Linus Torvalds1da177e2005-04-16 15:20:36 -07001409 if (length > I2C_SMBUS_BLOCK_MAX)
1410 length = I2C_SMBUS_BLOCK_MAX;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001411 data.block[0] = length;
Jean Delvare76560322006-01-18 23:14:55 +01001412 memcpy(&data.block[1], values, length);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001413 return i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1414 I2C_SMBUS_WRITE,command,
1415 I2C_SMBUS_BLOCK_DATA,&data);
1416}
David Brownellc0564602007-05-01 23:26:31 +02001417EXPORT_SYMBOL(i2c_smbus_write_block_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001418
1419/* Returns the number of read bytes */
Jean Delvare4b2643d2007-07-12 14:12:29 +02001420s32 i2c_smbus_read_i2c_block_data(struct i2c_client *client, u8 command,
1421 u8 length, u8 *values)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001422{
1423 union i2c_smbus_data data;
Jean Delvare76560322006-01-18 23:14:55 +01001424
Jean Delvare4b2643d2007-07-12 14:12:29 +02001425 if (length > I2C_SMBUS_BLOCK_MAX)
1426 length = I2C_SMBUS_BLOCK_MAX;
1427 data.block[0] = length;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001428 if (i2c_smbus_xfer(client->adapter,client->addr,client->flags,
1429 I2C_SMBUS_READ,command,
1430 I2C_SMBUS_I2C_BLOCK_DATA,&data))
1431 return -1;
Jean Delvare76560322006-01-18 23:14:55 +01001432
1433 memcpy(values, &data.block[1], data.block[0]);
1434 return data.block[0];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001435}
David Brownellc0564602007-05-01 23:26:31 +02001436EXPORT_SYMBOL(i2c_smbus_read_i2c_block_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001437
Jean Delvare21bbd692006-01-09 15:19:18 +11001438s32 i2c_smbus_write_i2c_block_data(struct i2c_client *client, u8 command,
Krzysztof Halasa46f5ed72006-06-12 21:42:20 +02001439 u8 length, const u8 *values)
Jean Delvare21bbd692006-01-09 15:19:18 +11001440{
1441 union i2c_smbus_data data;
1442
1443 if (length > I2C_SMBUS_BLOCK_MAX)
1444 length = I2C_SMBUS_BLOCK_MAX;
1445 data.block[0] = length;
1446 memcpy(data.block + 1, values, length);
1447 return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1448 I2C_SMBUS_WRITE, command,
1449 I2C_SMBUS_I2C_BLOCK_DATA, &data);
1450}
David Brownellc0564602007-05-01 23:26:31 +02001451EXPORT_SYMBOL(i2c_smbus_write_i2c_block_data);
Jean Delvare21bbd692006-01-09 15:19:18 +11001452
David Brownell438d6c22006-12-10 21:21:31 +01001453/* Simulate a SMBus command using the i2c protocol
Linus Torvalds1da177e2005-04-16 15:20:36 -07001454 No checking of parameters is done! */
David Brownell438d6c22006-12-10 21:21:31 +01001455static s32 i2c_smbus_xfer_emulated(struct i2c_adapter * adapter, u16 addr,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001456 unsigned short flags,
David Brownell438d6c22006-12-10 21:21:31 +01001457 char read_write, u8 command, int size,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001458 union i2c_smbus_data * data)
1459{
1460 /* So we need to generate a series of msgs. In the case of writing, we
1461 need to use only one message; when reading, we need two. We initialize
1462 most things with sane defaults, to keep the code below somewhat
1463 simpler. */
Hideki Iwamoto5c50d182005-09-25 17:01:11 +02001464 unsigned char msgbuf0[I2C_SMBUS_BLOCK_MAX+3];
1465 unsigned char msgbuf1[I2C_SMBUS_BLOCK_MAX+2];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001466 int num = read_write == I2C_SMBUS_READ?2:1;
David Brownell438d6c22006-12-10 21:21:31 +01001467 struct i2c_msg msg[2] = { { addr, flags, 1, msgbuf0 },
Linus Torvalds1da177e2005-04-16 15:20:36 -07001468 { addr, flags | I2C_M_RD, 0, msgbuf1 }
1469 };
1470 int i;
Jean Delvare421ef472005-10-26 21:28:55 +02001471 u8 partial_pec = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001472
1473 msgbuf0[0] = command;
1474 switch(size) {
1475 case I2C_SMBUS_QUICK:
1476 msg[0].len = 0;
1477 /* Special case: The read/write field is used as data */
1478 msg[0].flags = flags | (read_write==I2C_SMBUS_READ)?I2C_M_RD:0;
1479 num = 1;
1480 break;
1481 case I2C_SMBUS_BYTE:
1482 if (read_write == I2C_SMBUS_READ) {
1483 /* Special case: only a read! */
1484 msg[0].flags = I2C_M_RD | flags;
1485 num = 1;
1486 }
1487 break;
1488 case I2C_SMBUS_BYTE_DATA:
1489 if (read_write == I2C_SMBUS_READ)
1490 msg[1].len = 1;
1491 else {
1492 msg[0].len = 2;
1493 msgbuf0[1] = data->byte;
1494 }
1495 break;
1496 case I2C_SMBUS_WORD_DATA:
1497 if (read_write == I2C_SMBUS_READ)
1498 msg[1].len = 2;
1499 else {
1500 msg[0].len=3;
1501 msgbuf0[1] = data->word & 0xff;
Jean Delvare7eff82c2006-09-03 22:24:00 +02001502 msgbuf0[2] = data->word >> 8;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001503 }
1504 break;
1505 case I2C_SMBUS_PROC_CALL:
1506 num = 2; /* Special case */
1507 read_write = I2C_SMBUS_READ;
1508 msg[0].len = 3;
1509 msg[1].len = 2;
1510 msgbuf0[1] = data->word & 0xff;
Jean Delvare7eff82c2006-09-03 22:24:00 +02001511 msgbuf0[2] = data->word >> 8;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001512 break;
1513 case I2C_SMBUS_BLOCK_DATA:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001514 if (read_write == I2C_SMBUS_READ) {
Jean Delvare209d27c2007-05-01 23:26:29 +02001515 msg[1].flags |= I2C_M_RECV_LEN;
1516 msg[1].len = 1; /* block length will be added by
1517 the underlying bus driver */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001518 } else {
1519 msg[0].len = data->block[0] + 2;
1520 if (msg[0].len > I2C_SMBUS_BLOCK_MAX + 2) {
1521 dev_err(&adapter->dev, "smbus_access called with "
1522 "invalid block write size (%d)\n",
1523 data->block[0]);
1524 return -1;
1525 }
Hideki Iwamoto5c50d182005-09-25 17:01:11 +02001526 for (i = 1; i < msg[0].len; i++)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001527 msgbuf0[i] = data->block[i-1];
1528 }
1529 break;
1530 case I2C_SMBUS_BLOCK_PROC_CALL:
Jean Delvare209d27c2007-05-01 23:26:29 +02001531 num = 2; /* Another special case */
1532 read_write = I2C_SMBUS_READ;
1533 if (data->block[0] > I2C_SMBUS_BLOCK_MAX) {
1534 dev_err(&adapter->dev, "%s called with invalid "
Harvey Harrison08882d22008-04-22 22:16:47 +02001535 "block proc call size (%d)\n", __func__,
Jean Delvare209d27c2007-05-01 23:26:29 +02001536 data->block[0]);
1537 return -1;
1538 }
1539 msg[0].len = data->block[0] + 2;
1540 for (i = 1; i < msg[0].len; i++)
1541 msgbuf0[i] = data->block[i-1];
1542 msg[1].flags |= I2C_M_RECV_LEN;
1543 msg[1].len = 1; /* block length will be added by
1544 the underlying bus driver */
1545 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001546 case I2C_SMBUS_I2C_BLOCK_DATA:
1547 if (read_write == I2C_SMBUS_READ) {
Jean Delvare4b2643d2007-07-12 14:12:29 +02001548 msg[1].len = data->block[0];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001549 } else {
1550 msg[0].len = data->block[0] + 1;
Jean Delvare30dac742005-10-08 00:15:59 +02001551 if (msg[0].len > I2C_SMBUS_BLOCK_MAX + 1) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001552 dev_err(&adapter->dev, "i2c_smbus_xfer_emulated called with "
1553 "invalid block write size (%d)\n",
1554 data->block[0]);
1555 return -1;
1556 }
1557 for (i = 1; i <= data->block[0]; i++)
1558 msgbuf0[i] = data->block[i];
1559 }
1560 break;
1561 default:
1562 dev_err(&adapter->dev, "smbus_access called with invalid size (%d)\n",
1563 size);
1564 return -1;
1565 }
1566
Jean Delvare421ef472005-10-26 21:28:55 +02001567 i = ((flags & I2C_CLIENT_PEC) && size != I2C_SMBUS_QUICK
1568 && size != I2C_SMBUS_I2C_BLOCK_DATA);
1569 if (i) {
1570 /* Compute PEC if first message is a write */
1571 if (!(msg[0].flags & I2C_M_RD)) {
David Brownell438d6c22006-12-10 21:21:31 +01001572 if (num == 1) /* Write only */
Jean Delvare421ef472005-10-26 21:28:55 +02001573 i2c_smbus_add_pec(&msg[0]);
1574 else /* Write followed by read */
1575 partial_pec = i2c_smbus_msg_pec(0, &msg[0]);
1576 }
1577 /* Ask for PEC if last message is a read */
1578 if (msg[num-1].flags & I2C_M_RD)
David Brownell438d6c22006-12-10 21:21:31 +01001579 msg[num-1].len++;
Jean Delvare421ef472005-10-26 21:28:55 +02001580 }
1581
Linus Torvalds1da177e2005-04-16 15:20:36 -07001582 if (i2c_transfer(adapter, msg, num) < 0)
1583 return -1;
1584
Jean Delvare421ef472005-10-26 21:28:55 +02001585 /* Check PEC if last message is a read */
1586 if (i && (msg[num-1].flags & I2C_M_RD)) {
1587 if (i2c_smbus_check_pec(partial_pec, &msg[num-1]) < 0)
1588 return -1;
1589 }
1590
Linus Torvalds1da177e2005-04-16 15:20:36 -07001591 if (read_write == I2C_SMBUS_READ)
1592 switch(size) {
1593 case I2C_SMBUS_BYTE:
1594 data->byte = msgbuf0[0];
1595 break;
1596 case I2C_SMBUS_BYTE_DATA:
1597 data->byte = msgbuf1[0];
1598 break;
David Brownell438d6c22006-12-10 21:21:31 +01001599 case I2C_SMBUS_WORD_DATA:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001600 case I2C_SMBUS_PROC_CALL:
1601 data->word = msgbuf1[0] | (msgbuf1[1] << 8);
1602 break;
1603 case I2C_SMBUS_I2C_BLOCK_DATA:
Jean Delvare4b2643d2007-07-12 14:12:29 +02001604 for (i = 0; i < data->block[0]; i++)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001605 data->block[i+1] = msgbuf1[i];
1606 break;
Jean Delvare209d27c2007-05-01 23:26:29 +02001607 case I2C_SMBUS_BLOCK_DATA:
1608 case I2C_SMBUS_BLOCK_PROC_CALL:
1609 for (i = 0; i < msgbuf1[0] + 1; i++)
1610 data->block[i] = msgbuf1[i];
1611 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001612 }
1613 return 0;
1614}
1615
1616
1617s32 i2c_smbus_xfer(struct i2c_adapter * adapter, u16 addr, unsigned short flags,
David Brownell438d6c22006-12-10 21:21:31 +01001618 char read_write, u8 command, int size,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001619 union i2c_smbus_data * data)
1620{
1621 s32 res;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001622
1623 flags &= I2C_M_TEN | I2C_CLIENT_PEC;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001624
1625 if (adapter->algo->smbus_xfer) {
Ingo Molnar5c085d32006-01-18 23:16:04 +01001626 mutex_lock(&adapter->bus_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001627 res = adapter->algo->smbus_xfer(adapter,addr,flags,read_write,
1628 command,size,data);
Ingo Molnar5c085d32006-01-18 23:16:04 +01001629 mutex_unlock(&adapter->bus_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001630 } else
1631 res = i2c_smbus_xfer_emulated(adapter,addr,flags,read_write,
1632 command,size,data);
1633
Linus Torvalds1da177e2005-04-16 15:20:36 -07001634 return res;
1635}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001636EXPORT_SYMBOL(i2c_smbus_xfer);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001637
1638MODULE_AUTHOR("Simon G. Vogl <simon@tk.uni-linz.ac.at>");
1639MODULE_DESCRIPTION("I2C-Bus main module");
1640MODULE_LICENSE("GPL");