i2c: Fix for suspend/resume issue
[linux-2.6.git] / drivers / i2c / i2c-core.c
1 /* 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>
22    SMBus 2.0 support by Mark Studebaker <mdsxyz123@yahoo.com> and
23    Jean Delvare <khali@linux-fr.org>
24    Mux support by Rodolfo Giometti <giometti@enneenne.com> and
25    Michael Lawnick <michael.lawnick.ext@nsn.com> */
26
27 #include <linux/module.h>
28 #include <linux/kernel.h>
29 #include <linux/errno.h>
30 #include <linux/slab.h>
31 #include <linux/i2c.h>
32 #include <linux/init.h>
33 #include <linux/idr.h>
34 #include <linux/mutex.h>
35 #include <linux/of_i2c.h>
36 #include <linux/of_device.h>
37 #include <linux/completion.h>
38 #include <linux/hardirq.h>
39 #include <linux/irqflags.h>
40 #include <linux/rwsem.h>
41 #include <linux/pm_runtime.h>
42 #include <asm/uaccess.h>
43
44 #include "i2c-core.h"
45
46
47 /* core_lock protects i2c_adapter_idr, and guarantees
48    that device detection, deletion of detected devices, and attach_adapter
49    and detach_adapter calls are serialized */
50 static DEFINE_MUTEX(core_lock);
51 static DEFINE_IDR(i2c_adapter_idr);
52
53 static struct device_type i2c_client_type;
54 static int i2c_detect(struct i2c_adapter *adapter, struct i2c_driver *driver);
55
56 /* ------------------------------------------------------------------------- */
57
58 static const struct i2c_device_id *i2c_match_id(const struct i2c_device_id *id,
59                                                 const struct i2c_client *client)
60 {
61         while (id->name[0]) {
62                 if (strcmp(client->name, id->name) == 0)
63                         return id;
64                 id++;
65         }
66         return NULL;
67 }
68
69 static int i2c_device_match(struct device *dev, struct device_driver *drv)
70 {
71         struct i2c_client       *client = i2c_verify_client(dev);
72         struct i2c_driver       *driver;
73
74         if (!client)
75                 return 0;
76
77         /* Attempt an OF style match */
78         if (of_driver_match_device(dev, drv))
79                 return 1;
80
81         driver = to_i2c_driver(drv);
82         /* match on an id table if there is one */
83         if (driver->id_table)
84                 return i2c_match_id(driver->id_table, client) != NULL;
85
86         return 0;
87 }
88
89 #ifdef  CONFIG_HOTPLUG
90
91 /* uevent helps with hotplug: modprobe -q $(MODALIAS) */
92 static int i2c_device_uevent(struct device *dev, struct kobj_uevent_env *env)
93 {
94         struct i2c_client       *client = to_i2c_client(dev);
95
96         if (add_uevent_var(env, "MODALIAS=%s%s",
97                            I2C_MODULE_PREFIX, client->name))
98                 return -ENOMEM;
99         dev_dbg(dev, "uevent\n");
100         return 0;
101 }
102
103 #else
104 #define i2c_device_uevent       NULL
105 #endif  /* CONFIG_HOTPLUG */
106
107 static int i2c_device_probe(struct device *dev)
108 {
109         struct i2c_client       *client = i2c_verify_client(dev);
110         struct i2c_driver       *driver;
111         int status;
112
113         if (!client)
114                 return 0;
115
116         driver = to_i2c_driver(dev->driver);
117         if (!driver->probe || !driver->id_table)
118                 return -ENODEV;
119         client->driver = driver;
120         if (!device_can_wakeup(&client->dev))
121                 device_init_wakeup(&client->dev,
122                                         client->flags & I2C_CLIENT_WAKE);
123         dev_dbg(dev, "probe\n");
124
125         status = driver->probe(client, i2c_match_id(driver->id_table, client));
126         if (status) {
127                 client->driver = NULL;
128                 i2c_set_clientdata(client, NULL);
129         }
130         return status;
131 }
132
133 static int i2c_device_remove(struct device *dev)
134 {
135         struct i2c_client       *client = i2c_verify_client(dev);
136         struct i2c_driver       *driver;
137         int                     status;
138
139         if (!client || !dev->driver)
140                 return 0;
141
142         driver = to_i2c_driver(dev->driver);
143         if (driver->remove) {
144                 dev_dbg(dev, "remove\n");
145                 status = driver->remove(client);
146         } else {
147                 dev->driver = NULL;
148                 status = 0;
149         }
150         if (status == 0) {
151                 client->driver = NULL;
152                 i2c_set_clientdata(client, NULL);
153         }
154         return status;
155 }
156
157 static void i2c_device_shutdown(struct device *dev)
158 {
159         struct i2c_client *client = i2c_verify_client(dev);
160         struct i2c_driver *driver;
161
162         if (!client || !dev->driver)
163                 return;
164         driver = to_i2c_driver(dev->driver);
165         if (driver->shutdown)
166                 driver->shutdown(client);
167 }
168
169 #ifdef CONFIG_PM_SLEEP
170 static int i2c_legacy_suspend(struct device *dev, pm_message_t mesg)
171 {
172         struct i2c_client *client = i2c_verify_client(dev);
173         struct i2c_driver *driver;
174
175         if (!client || !dev->driver)
176                 return 0;
177         driver = to_i2c_driver(dev->driver);
178         if (!driver->suspend)
179                 return 0;
180         return driver->suspend(client, mesg);
181 }
182
183 static int i2c_legacy_resume(struct device *dev)
184 {
185         struct i2c_client *client = i2c_verify_client(dev);
186         struct i2c_driver *driver;
187
188         if (!client || !dev->driver)
189                 return 0;
190         driver = to_i2c_driver(dev->driver);
191         if (!driver->resume)
192                 return 0;
193         return driver->resume(client);
194 }
195
196 static int i2c_device_pm_suspend(struct device *dev)
197 {
198         const struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
199
200         if (pm_runtime_suspended(dev))
201                 return 0;
202
203         if (pm)
204                 return pm->suspend ? pm->suspend(dev) : 0;
205
206         return i2c_legacy_suspend(dev, PMSG_SUSPEND);
207 }
208
209 static int i2c_device_pm_resume(struct device *dev)
210 {
211         const struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
212         int ret;
213
214         if (pm)
215                 ret = pm->resume ? pm->resume(dev) : 0;
216         else
217                 ret = i2c_legacy_resume(dev);
218
219         return ret;
220 }
221
222 static int i2c_device_pm_freeze(struct device *dev)
223 {
224         const struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
225
226         if (pm_runtime_suspended(dev))
227                 return 0;
228
229         if (pm)
230                 return pm->freeze ? pm->freeze(dev) : 0;
231
232         return i2c_legacy_suspend(dev, PMSG_FREEZE);
233 }
234
235 static int i2c_device_pm_thaw(struct device *dev)
236 {
237         const struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
238
239         if (pm_runtime_suspended(dev))
240                 return 0;
241
242         if (pm)
243                 return pm->thaw ? pm->thaw(dev) : 0;
244
245         return i2c_legacy_resume(dev);
246 }
247
248 static int i2c_device_pm_poweroff(struct device *dev)
249 {
250         const struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
251
252         if (pm_runtime_suspended(dev))
253                 return 0;
254
255         if (pm)
256                 return pm->poweroff ? pm->poweroff(dev) : 0;
257
258         return i2c_legacy_suspend(dev, PMSG_HIBERNATE);
259 }
260
261 static int i2c_device_pm_restore(struct device *dev)
262 {
263         const struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
264         int ret;
265
266         if (pm)
267                 ret = pm->restore ? pm->restore(dev) : 0;
268         else
269                 ret = i2c_legacy_resume(dev);
270
271         if (!ret) {
272                 pm_runtime_disable(dev);
273                 pm_runtime_set_active(dev);
274                 pm_runtime_enable(dev);
275         }
276
277         return ret;
278 }
279 #else /* !CONFIG_PM_SLEEP */
280 #define i2c_device_pm_suspend   NULL
281 #define i2c_device_pm_resume    NULL
282 #define i2c_device_pm_freeze    NULL
283 #define i2c_device_pm_thaw      NULL
284 #define i2c_device_pm_poweroff  NULL
285 #define i2c_device_pm_restore   NULL
286 #endif /* !CONFIG_PM_SLEEP */
287
288 static void i2c_client_dev_release(struct device *dev)
289 {
290         kfree(to_i2c_client(dev));
291 }
292
293 static ssize_t
294 show_name(struct device *dev, struct device_attribute *attr, char *buf)
295 {
296         return sprintf(buf, "%s\n", dev->type == &i2c_client_type ?
297                        to_i2c_client(dev)->name : to_i2c_adapter(dev)->name);
298 }
299
300 static ssize_t
301 show_modalias(struct device *dev, struct device_attribute *attr, char *buf)
302 {
303         struct i2c_client *client = to_i2c_client(dev);
304         return sprintf(buf, "%s%s\n", I2C_MODULE_PREFIX, client->name);
305 }
306
307 static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
308 static DEVICE_ATTR(modalias, S_IRUGO, show_modalias, NULL);
309
310 static struct attribute *i2c_dev_attrs[] = {
311         &dev_attr_name.attr,
312         /* modalias helps coldplug:  modprobe $(cat .../modalias) */
313         &dev_attr_modalias.attr,
314         NULL
315 };
316
317 static struct attribute_group i2c_dev_attr_group = {
318         .attrs          = i2c_dev_attrs,
319 };
320
321 static const struct attribute_group *i2c_dev_attr_groups[] = {
322         &i2c_dev_attr_group,
323         NULL
324 };
325
326 static const struct dev_pm_ops i2c_device_pm_ops = {
327         .suspend = i2c_device_pm_suspend,
328         .resume = i2c_device_pm_resume,
329         .freeze = i2c_device_pm_freeze,
330         .thaw = i2c_device_pm_thaw,
331         .poweroff = i2c_device_pm_poweroff,
332         .restore = i2c_device_pm_restore,
333         SET_RUNTIME_PM_OPS(
334                 pm_generic_runtime_suspend,
335                 pm_generic_runtime_resume,
336                 pm_generic_runtime_idle
337         )
338 };
339
340 struct bus_type i2c_bus_type = {
341         .name           = "i2c",
342         .match          = i2c_device_match,
343         .probe          = i2c_device_probe,
344         .remove         = i2c_device_remove,
345         .shutdown       = i2c_device_shutdown,
346         .pm             = &i2c_device_pm_ops,
347 };
348 EXPORT_SYMBOL_GPL(i2c_bus_type);
349
350 static struct device_type i2c_client_type = {
351         .groups         = i2c_dev_attr_groups,
352         .uevent         = i2c_device_uevent,
353         .release        = i2c_client_dev_release,
354 };
355
356
357 /**
358  * i2c_verify_client - return parameter as i2c_client, or NULL
359  * @dev: device, probably from some driver model iterator
360  *
361  * When traversing the driver model tree, perhaps using driver model
362  * iterators like @device_for_each_child(), you can't assume very much
363  * about the nodes you find.  Use this function to avoid oopses caused
364  * by wrongly treating some non-I2C device as an i2c_client.
365  */
366 struct i2c_client *i2c_verify_client(struct device *dev)
367 {
368         return (dev->type == &i2c_client_type)
369                         ? to_i2c_client(dev)
370                         : NULL;
371 }
372 EXPORT_SYMBOL(i2c_verify_client);
373
374
375 /* This is a permissive address validity check, I2C address map constraints
376  * are purposedly not enforced, except for the general call address. */
377 static int i2c_check_client_addr_validity(const struct i2c_client *client)
378 {
379         if (client->flags & I2C_CLIENT_TEN) {
380                 /* 10-bit address, all values are valid */
381                 if (client->addr > 0x3ff)
382                         return -EINVAL;
383         } else {
384                 /* 7-bit address, reject the general call address */
385                 if (client->addr == 0x00 || client->addr > 0x7f)
386                         return -EINVAL;
387         }
388         return 0;
389 }
390
391 /* And this is a strict address validity check, used when probing. If a
392  * device uses a reserved address, then it shouldn't be probed. 7-bit
393  * addressing is assumed, 10-bit address devices are rare and should be
394  * explicitly enumerated. */
395 static int i2c_check_addr_validity(unsigned short addr)
396 {
397         /*
398          * Reserved addresses per I2C specification:
399          *  0x00       General call address / START byte
400          *  0x01       CBUS address
401          *  0x02       Reserved for different bus format
402          *  0x03       Reserved for future purposes
403          *  0x04-0x07  Hs-mode master code
404          *  0x78-0x7b  10-bit slave addressing
405          *  0x7c-0x7f  Reserved for future purposes
406          */
407         if (addr < 0x08 || addr > 0x77)
408                 return -EINVAL;
409         return 0;
410 }
411
412 static int __i2c_check_addr_busy(struct device *dev, void *addrp)
413 {
414         struct i2c_client       *client = i2c_verify_client(dev);
415         int                     addr = *(int *)addrp;
416
417         if (client && client->addr == addr)
418                 return -EBUSY;
419         return 0;
420 }
421
422 /* walk up mux tree */
423 static int i2c_check_mux_parents(struct i2c_adapter *adapter, int addr)
424 {
425         int result;
426
427         result = device_for_each_child(&adapter->dev, &addr,
428                                         __i2c_check_addr_busy);
429
430         if (!result && i2c_parent_is_i2c_adapter(adapter))
431                 result = i2c_check_mux_parents(
432                                     to_i2c_adapter(adapter->dev.parent), addr);
433
434         return result;
435 }
436
437 /* recurse down mux tree */
438 static int i2c_check_mux_children(struct device *dev, void *addrp)
439 {
440         int result;
441
442         if (dev->type == &i2c_adapter_type)
443                 result = device_for_each_child(dev, addrp,
444                                                 i2c_check_mux_children);
445         else
446                 result = __i2c_check_addr_busy(dev, addrp);
447
448         return result;
449 }
450
451 static int i2c_check_addr_busy(struct i2c_adapter *adapter, int addr)
452 {
453         int result = 0;
454
455         if (i2c_parent_is_i2c_adapter(adapter))
456                 result = i2c_check_mux_parents(
457                                     to_i2c_adapter(adapter->dev.parent), addr);
458
459         if (!result)
460                 result = device_for_each_child(&adapter->dev, &addr,
461                                                 i2c_check_mux_children);
462
463         return result;
464 }
465
466 /**
467  * i2c_lock_adapter - Get exclusive access to an I2C bus segment
468  * @adapter: Target I2C bus segment
469  */
470 void i2c_lock_adapter(struct i2c_adapter *adapter)
471 {
472         if (i2c_parent_is_i2c_adapter(adapter))
473                 i2c_lock_adapter(to_i2c_adapter(adapter->dev.parent));
474         else
475                 rt_mutex_lock(&adapter->bus_lock);
476 }
477 EXPORT_SYMBOL_GPL(i2c_lock_adapter);
478
479 /**
480  * i2c_trylock_adapter - Try to get exclusive access to an I2C bus segment
481  * @adapter: Target I2C bus segment
482  */
483 static int i2c_trylock_adapter(struct i2c_adapter *adapter)
484 {
485         if (i2c_parent_is_i2c_adapter(adapter))
486                 return i2c_trylock_adapter(to_i2c_adapter(adapter->dev.parent));
487         else
488                 return rt_mutex_trylock(&adapter->bus_lock);
489 }
490
491 /**
492  * i2c_unlock_adapter - Release exclusive access to an I2C bus segment
493  * @adapter: Target I2C bus segment
494  */
495 void i2c_unlock_adapter(struct i2c_adapter *adapter)
496 {
497         if (i2c_parent_is_i2c_adapter(adapter))
498                 i2c_unlock_adapter(to_i2c_adapter(adapter->dev.parent));
499         else
500                 rt_mutex_unlock(&adapter->bus_lock);
501 }
502 EXPORT_SYMBOL_GPL(i2c_unlock_adapter);
503
504 /**
505  * i2c_new_device - instantiate an i2c device
506  * @adap: the adapter managing the device
507  * @info: describes one I2C device; bus_num is ignored
508  * Context: can sleep
509  *
510  * Create an i2c device. Binding is handled through driver model
511  * probe()/remove() methods.  A driver may be bound to this device when we
512  * return from this function, or any later moment (e.g. maybe hotplugging will
513  * load the driver module).  This call is not appropriate for use by mainboard
514  * initialization logic, which usually runs during an arch_initcall() long
515  * before any i2c_adapter could exist.
516  *
517  * This returns the new i2c client, which may be saved for later use with
518  * i2c_unregister_device(); or NULL to indicate an error.
519  */
520 struct i2c_client *
521 i2c_new_device(struct i2c_adapter *adap, struct i2c_board_info const *info)
522 {
523         struct i2c_client       *client;
524         int                     status;
525
526         client = kzalloc(sizeof *client, GFP_KERNEL);
527         if (!client)
528                 return NULL;
529
530         client->adapter = adap;
531
532         client->dev.platform_data = info->platform_data;
533
534         if (info->archdata)
535                 client->dev.archdata = *info->archdata;
536
537         client->flags = info->flags;
538         client->addr = info->addr;
539         client->irq = info->irq;
540
541         strlcpy(client->name, info->type, sizeof(client->name));
542
543         /* Check for address validity */
544         status = i2c_check_client_addr_validity(client);
545         if (status) {
546                 dev_err(&adap->dev, "Invalid %d-bit I2C address 0x%02hx\n",
547                         client->flags & I2C_CLIENT_TEN ? 10 : 7, client->addr);
548                 goto out_err_silent;
549         }
550
551         /* Check for address business */
552         status = i2c_check_addr_busy(adap, client->addr);
553         if (status)
554                 goto out_err;
555
556         client->dev.parent = &client->adapter->dev;
557         client->dev.bus = &i2c_bus_type;
558         client->dev.type = &i2c_client_type;
559 #ifdef CONFIG_OF
560         client->dev.of_node = info->of_node;
561 #endif
562
563         dev_set_name(&client->dev, "%d-%04x", i2c_adapter_id(adap),
564                      client->addr);
565         status = device_register(&client->dev);
566         if (status)
567                 goto out_err;
568
569         dev_dbg(&adap->dev, "client [%s] registered with bus id %s\n",
570                 client->name, dev_name(&client->dev));
571
572         return client;
573
574 out_err:
575         dev_err(&adap->dev, "Failed to register i2c client %s at 0x%02x "
576                 "(%d)\n", client->name, client->addr, status);
577 out_err_silent:
578         kfree(client);
579         return NULL;
580 }
581 EXPORT_SYMBOL_GPL(i2c_new_device);
582
583
584 /**
585  * i2c_unregister_device - reverse effect of i2c_new_device()
586  * @client: value returned from i2c_new_device()
587  * Context: can sleep
588  */
589 void i2c_unregister_device(struct i2c_client *client)
590 {
591         device_unregister(&client->dev);
592 }
593 EXPORT_SYMBOL_GPL(i2c_unregister_device);
594
595
596 static const struct i2c_device_id dummy_id[] = {
597         { "dummy", 0 },
598         { },
599 };
600
601 static int dummy_probe(struct i2c_client *client,
602                        const struct i2c_device_id *id)
603 {
604         return 0;
605 }
606
607 static int dummy_remove(struct i2c_client *client)
608 {
609         return 0;
610 }
611
612 static struct i2c_driver dummy_driver = {
613         .driver.name    = "dummy",
614         .probe          = dummy_probe,
615         .remove         = dummy_remove,
616         .id_table       = dummy_id,
617 };
618
619 /**
620  * i2c_new_dummy - return a new i2c device bound to a dummy driver
621  * @adapter: the adapter managing the device
622  * @address: seven bit address to be used
623  * Context: can sleep
624  *
625  * This returns an I2C client bound to the "dummy" driver, intended for use
626  * with devices that consume multiple addresses.  Examples of such chips
627  * include various EEPROMS (like 24c04 and 24c08 models).
628  *
629  * These dummy devices have two main uses.  First, most I2C and SMBus calls
630  * except i2c_transfer() need a client handle; the dummy will be that handle.
631  * And second, this prevents the specified address from being bound to a
632  * different driver.
633  *
634  * This returns the new i2c client, which should be saved for later use with
635  * i2c_unregister_device(); or NULL to indicate an error.
636  */
637 struct i2c_client *i2c_new_dummy(struct i2c_adapter *adapter, u16 address)
638 {
639         struct i2c_board_info info = {
640                 I2C_BOARD_INFO("dummy", address),
641         };
642
643         return i2c_new_device(adapter, &info);
644 }
645 EXPORT_SYMBOL_GPL(i2c_new_dummy);
646
647 /* ------------------------------------------------------------------------- */
648
649 /* I2C bus adapters -- one roots each I2C or SMBUS segment */
650
651 static void i2c_adapter_dev_release(struct device *dev)
652 {
653         struct i2c_adapter *adap = to_i2c_adapter(dev);
654         complete(&adap->dev_released);
655 }
656
657 /*
658  * Let users instantiate I2C devices through sysfs. This can be used when
659  * platform initialization code doesn't contain the proper data for
660  * whatever reason. Also useful for drivers that do device detection and
661  * detection fails, either because the device uses an unexpected address,
662  * or this is a compatible device with different ID register values.
663  *
664  * Parameter checking may look overzealous, but we really don't want
665  * the user to provide incorrect parameters.
666  */
667 static ssize_t
668 i2c_sysfs_new_device(struct device *dev, struct device_attribute *attr,
669                      const char *buf, size_t count)
670 {
671         struct i2c_adapter *adap = to_i2c_adapter(dev);
672         struct i2c_board_info info;
673         struct i2c_client *client;
674         char *blank, end;
675         int res;
676
677         dev_warn(dev, "The new_device interface is still experimental "
678                  "and may change in a near future\n");
679         memset(&info, 0, sizeof(struct i2c_board_info));
680
681         blank = strchr(buf, ' ');
682         if (!blank) {
683                 dev_err(dev, "%s: Missing parameters\n", "new_device");
684                 return -EINVAL;
685         }
686         if (blank - buf > I2C_NAME_SIZE - 1) {
687                 dev_err(dev, "%s: Invalid device name\n", "new_device");
688                 return -EINVAL;
689         }
690         memcpy(info.type, buf, blank - buf);
691
692         /* Parse remaining parameters, reject extra parameters */
693         res = sscanf(++blank, "%hi%c", &info.addr, &end);
694         if (res < 1) {
695                 dev_err(dev, "%s: Can't parse I2C address\n", "new_device");
696                 return -EINVAL;
697         }
698         if (res > 1  && end != '\n') {
699                 dev_err(dev, "%s: Extra parameters\n", "new_device");
700                 return -EINVAL;
701         }
702
703         client = i2c_new_device(adap, &info);
704         if (!client)
705                 return -EINVAL;
706
707         /* Keep track of the added device */
708         mutex_lock(&adap->userspace_clients_lock);
709         list_add_tail(&client->detected, &adap->userspace_clients);
710         mutex_unlock(&adap->userspace_clients_lock);
711         dev_info(dev, "%s: Instantiated device %s at 0x%02hx\n", "new_device",
712                  info.type, info.addr);
713
714         return count;
715 }
716
717 /*
718  * And of course let the users delete the devices they instantiated, if
719  * they got it wrong. This interface can only be used to delete devices
720  * instantiated by i2c_sysfs_new_device above. This guarantees that we
721  * don't delete devices to which some kernel code still has references.
722  *
723  * Parameter checking may look overzealous, but we really don't want
724  * the user to delete the wrong device.
725  */
726 static ssize_t
727 i2c_sysfs_delete_device(struct device *dev, struct device_attribute *attr,
728                         const char *buf, size_t count)
729 {
730         struct i2c_adapter *adap = to_i2c_adapter(dev);
731         struct i2c_client *client, *next;
732         unsigned short addr;
733         char end;
734         int res;
735
736         /* Parse parameters, reject extra parameters */
737         res = sscanf(buf, "%hi%c", &addr, &end);
738         if (res < 1) {
739                 dev_err(dev, "%s: Can't parse I2C address\n", "delete_device");
740                 return -EINVAL;
741         }
742         if (res > 1  && end != '\n') {
743                 dev_err(dev, "%s: Extra parameters\n", "delete_device");
744                 return -EINVAL;
745         }
746
747         /* Make sure the device was added through sysfs */
748         res = -ENOENT;
749         mutex_lock(&adap->userspace_clients_lock);
750         list_for_each_entry_safe(client, next, &adap->userspace_clients,
751                                  detected) {
752                 if (client->addr == addr) {
753                         dev_info(dev, "%s: Deleting device %s at 0x%02hx\n",
754                                  "delete_device", client->name, client->addr);
755
756                         list_del(&client->detected);
757                         i2c_unregister_device(client);
758                         res = count;
759                         break;
760                 }
761         }
762         mutex_unlock(&adap->userspace_clients_lock);
763
764         if (res < 0)
765                 dev_err(dev, "%s: Can't find device in list\n",
766                         "delete_device");
767         return res;
768 }
769
770 static DEVICE_ATTR(new_device, S_IWUSR, NULL, i2c_sysfs_new_device);
771 static DEVICE_ATTR(delete_device, S_IWUSR, NULL, i2c_sysfs_delete_device);
772
773 static struct attribute *i2c_adapter_attrs[] = {
774         &dev_attr_name.attr,
775         &dev_attr_new_device.attr,
776         &dev_attr_delete_device.attr,
777         NULL
778 };
779
780 static struct attribute_group i2c_adapter_attr_group = {
781         .attrs          = i2c_adapter_attrs,
782 };
783
784 static const struct attribute_group *i2c_adapter_attr_groups[] = {
785         &i2c_adapter_attr_group,
786         NULL
787 };
788
789 struct device_type i2c_adapter_type = {
790         .groups         = i2c_adapter_attr_groups,
791         .release        = i2c_adapter_dev_release,
792 };
793 EXPORT_SYMBOL_GPL(i2c_adapter_type);
794
795 #ifdef CONFIG_I2C_COMPAT
796 static struct class_compat *i2c_adapter_compat_class;
797 #endif
798
799 static void i2c_scan_static_board_info(struct i2c_adapter *adapter)
800 {
801         struct i2c_devinfo      *devinfo;
802
803         down_read(&__i2c_board_lock);
804         list_for_each_entry(devinfo, &__i2c_board_list, list) {
805                 if (devinfo->busnum == adapter->nr
806                                 && !i2c_new_device(adapter,
807                                                 &devinfo->board_info))
808                         dev_err(&adapter->dev,
809                                 "Can't create device at 0x%02x\n",
810                                 devinfo->board_info.addr);
811         }
812         up_read(&__i2c_board_lock);
813 }
814
815 static int i2c_do_add_adapter(struct i2c_driver *driver,
816                               struct i2c_adapter *adap)
817 {
818         /* Detect supported devices on that bus, and instantiate them */
819         i2c_detect(adap, driver);
820
821         /* Let legacy drivers scan this bus for matching devices */
822         if (driver->attach_adapter) {
823                 /* We ignore the return code; if it fails, too bad */
824                 driver->attach_adapter(adap);
825         }
826         return 0;
827 }
828
829 static int __process_new_adapter(struct device_driver *d, void *data)
830 {
831         return i2c_do_add_adapter(to_i2c_driver(d), data);
832 }
833
834 static int i2c_register_adapter(struct i2c_adapter *adap)
835 {
836         int res = 0;
837
838         /* Can't register until after driver model init */
839         if (unlikely(WARN_ON(!i2c_bus_type.p))) {
840                 res = -EAGAIN;
841                 goto out_list;
842         }
843
844         rt_mutex_init(&adap->bus_lock);
845         mutex_init(&adap->userspace_clients_lock);
846         INIT_LIST_HEAD(&adap->userspace_clients);
847
848         /* Set default timeout to 1 second if not already set */
849         if (adap->timeout == 0)
850                 adap->timeout = HZ;
851
852         dev_set_name(&adap->dev, "i2c-%d", adap->nr);
853         adap->dev.bus = &i2c_bus_type;
854         adap->dev.type = &i2c_adapter_type;
855         res = device_register(&adap->dev);
856         if (res)
857                 goto out_list;
858
859         dev_dbg(&adap->dev, "adapter [%s] registered\n", adap->name);
860
861 #ifdef CONFIG_I2C_COMPAT
862         res = class_compat_create_link(i2c_adapter_compat_class, &adap->dev,
863                                        adap->dev.parent);
864         if (res)
865                 dev_warn(&adap->dev,
866                          "Failed to create compatibility class link\n");
867 #endif
868
869         /* create pre-declared device nodes */
870         if (adap->nr < __i2c_first_dynamic_bus_num)
871                 i2c_scan_static_board_info(adap);
872
873         /* Register devices from the device tree */
874         of_i2c_register_devices(adap);
875
876         /* Notify drivers */
877         mutex_lock(&core_lock);
878         bus_for_each_drv(&i2c_bus_type, NULL, adap, __process_new_adapter);
879         mutex_unlock(&core_lock);
880
881         return 0;
882
883 out_list:
884         mutex_lock(&core_lock);
885         idr_remove(&i2c_adapter_idr, adap->nr);
886         mutex_unlock(&core_lock);
887         return res;
888 }
889
890 /**
891  * i2c_add_adapter - declare i2c adapter, use dynamic bus number
892  * @adapter: the adapter to add
893  * Context: can sleep
894  *
895  * This routine is used to declare an I2C adapter when its bus number
896  * doesn't matter.  Examples: for I2C adapters dynamically added by
897  * USB links or PCI plugin cards.
898  *
899  * When this returns zero, a new bus number was allocated and stored
900  * in adap->nr, and the specified adapter became available for clients.
901  * Otherwise, a negative errno value is returned.
902  */
903 int i2c_add_adapter(struct i2c_adapter *adapter)
904 {
905         int     id, res = 0;
906
907 retry:
908         if (idr_pre_get(&i2c_adapter_idr, GFP_KERNEL) == 0)
909                 return -ENOMEM;
910
911         mutex_lock(&core_lock);
912         /* "above" here means "above or equal to", sigh */
913         res = idr_get_new_above(&i2c_adapter_idr, adapter,
914                                 __i2c_first_dynamic_bus_num, &id);
915         mutex_unlock(&core_lock);
916
917         if (res < 0) {
918                 if (res == -EAGAIN)
919                         goto retry;
920                 return res;
921         }
922
923         adapter->nr = id;
924         return i2c_register_adapter(adapter);
925 }
926 EXPORT_SYMBOL(i2c_add_adapter);
927
928 /**
929  * i2c_add_numbered_adapter - declare i2c adapter, use static bus number
930  * @adap: the adapter to register (with adap->nr initialized)
931  * Context: can sleep
932  *
933  * This routine is used to declare an I2C adapter when its bus number
934  * matters.  For example, use it for I2C adapters from system-on-chip CPUs,
935  * or otherwise built in to the system's mainboard, and where i2c_board_info
936  * is used to properly configure I2C devices.
937  *
938  * If no devices have pre-been declared for this bus, then be sure to
939  * register the adapter before any dynamically allocated ones.  Otherwise
940  * the required bus ID may not be available.
941  *
942  * When this returns zero, the specified adapter became available for
943  * clients using the bus number provided in adap->nr.  Also, the table
944  * of I2C devices pre-declared using i2c_register_board_info() is scanned,
945  * and the appropriate driver model device nodes are created.  Otherwise, a
946  * negative errno value is returned.
947  */
948 int i2c_add_numbered_adapter(struct i2c_adapter *adap)
949 {
950         int     id;
951         int     status;
952
953         if (adap->nr & ~MAX_ID_MASK)
954                 return -EINVAL;
955
956 retry:
957         if (idr_pre_get(&i2c_adapter_idr, GFP_KERNEL) == 0)
958                 return -ENOMEM;
959
960         mutex_lock(&core_lock);
961         /* "above" here means "above or equal to", sigh;
962          * we need the "equal to" result to force the result
963          */
964         status = idr_get_new_above(&i2c_adapter_idr, adap, adap->nr, &id);
965         if (status == 0 && id != adap->nr) {
966                 status = -EBUSY;
967                 idr_remove(&i2c_adapter_idr, id);
968         }
969         mutex_unlock(&core_lock);
970         if (status == -EAGAIN)
971                 goto retry;
972
973         if (status == 0)
974                 status = i2c_register_adapter(adap);
975         return status;
976 }
977 EXPORT_SYMBOL_GPL(i2c_add_numbered_adapter);
978
979 static int i2c_do_del_adapter(struct i2c_driver *driver,
980                               struct i2c_adapter *adapter)
981 {
982         struct i2c_client *client, *_n;
983         int res;
984
985         /* Remove the devices we created ourselves as the result of hardware
986          * probing (using a driver's detect method) */
987         list_for_each_entry_safe(client, _n, &driver->clients, detected) {
988                 if (client->adapter == adapter) {
989                         dev_dbg(&adapter->dev, "Removing %s at 0x%x\n",
990                                 client->name, client->addr);
991                         list_del(&client->detected);
992                         i2c_unregister_device(client);
993                 }
994         }
995
996         if (!driver->detach_adapter)
997                 return 0;
998         res = driver->detach_adapter(adapter);
999         if (res)
1000                 dev_err(&adapter->dev, "detach_adapter failed (%d) "
1001                         "for driver [%s]\n", res, driver->driver.name);
1002         return res;
1003 }
1004
1005 static int __unregister_client(struct device *dev, void *dummy)
1006 {
1007         struct i2c_client *client = i2c_verify_client(dev);
1008         if (client)
1009                 i2c_unregister_device(client);
1010         return 0;
1011 }
1012
1013 static int __process_removed_adapter(struct device_driver *d, void *data)
1014 {
1015         return i2c_do_del_adapter(to_i2c_driver(d), data);
1016 }
1017
1018 /**
1019  * i2c_del_adapter - unregister I2C adapter
1020  * @adap: the adapter being unregistered
1021  * Context: can sleep
1022  *
1023  * This unregisters an I2C adapter which was previously registered
1024  * by @i2c_add_adapter or @i2c_add_numbered_adapter.
1025  */
1026 int i2c_del_adapter(struct i2c_adapter *adap)
1027 {
1028         int res = 0;
1029         struct i2c_adapter *found;
1030         struct i2c_client *client, *next;
1031
1032         /* First make sure that this adapter was ever added */
1033         mutex_lock(&core_lock);
1034         found = idr_find(&i2c_adapter_idr, adap->nr);
1035         mutex_unlock(&core_lock);
1036         if (found != adap) {
1037                 pr_debug("i2c-core: attempting to delete unregistered "
1038                          "adapter [%s]\n", adap->name);
1039                 return -EINVAL;
1040         }
1041
1042         /* Tell drivers about this removal */
1043         mutex_lock(&core_lock);
1044         res = bus_for_each_drv(&i2c_bus_type, NULL, adap,
1045                                __process_removed_adapter);
1046         mutex_unlock(&core_lock);
1047         if (res)
1048                 return res;
1049
1050         /* Remove devices instantiated from sysfs */
1051         mutex_lock(&adap->userspace_clients_lock);
1052         list_for_each_entry_safe(client, next, &adap->userspace_clients,
1053                                  detected) {
1054                 dev_dbg(&adap->dev, "Removing %s at 0x%x\n", client->name,
1055                         client->addr);
1056                 list_del(&client->detected);
1057                 i2c_unregister_device(client);
1058         }
1059         mutex_unlock(&adap->userspace_clients_lock);
1060
1061         /* Detach any active clients. This can't fail, thus we do not
1062            checking the returned value. */
1063         res = device_for_each_child(&adap->dev, NULL, __unregister_client);
1064
1065 #ifdef CONFIG_I2C_COMPAT
1066         class_compat_remove_link(i2c_adapter_compat_class, &adap->dev,
1067                                  adap->dev.parent);
1068 #endif
1069
1070         /* device name is gone after device_unregister */
1071         dev_dbg(&adap->dev, "adapter [%s] unregistered\n", adap->name);
1072
1073         /* clean up the sysfs representation */
1074         init_completion(&adap->dev_released);
1075         device_unregister(&adap->dev);
1076
1077         /* wait for sysfs to drop all references */
1078         wait_for_completion(&adap->dev_released);
1079
1080         /* free bus id */
1081         mutex_lock(&core_lock);
1082         idr_remove(&i2c_adapter_idr, adap->nr);
1083         mutex_unlock(&core_lock);
1084
1085         /* Clear the device structure in case this adapter is ever going to be
1086            added again */
1087         memset(&adap->dev, 0, sizeof(adap->dev));
1088
1089         return 0;
1090 }
1091 EXPORT_SYMBOL(i2c_del_adapter);
1092
1093
1094 /* ------------------------------------------------------------------------- */
1095
1096 static int __process_new_driver(struct device *dev, void *data)
1097 {
1098         if (dev->type != &i2c_adapter_type)
1099                 return 0;
1100         return i2c_do_add_adapter(data, to_i2c_adapter(dev));
1101 }
1102
1103 /*
1104  * An i2c_driver is used with one or more i2c_client (device) nodes to access
1105  * i2c slave chips, on a bus instance associated with some i2c_adapter.
1106  */
1107
1108 int i2c_register_driver(struct module *owner, struct i2c_driver *driver)
1109 {
1110         int res;
1111
1112         /* Can't register until after driver model init */
1113         if (unlikely(WARN_ON(!i2c_bus_type.p)))
1114                 return -EAGAIN;
1115
1116         /* add the driver to the list of i2c drivers in the driver core */
1117         driver->driver.owner = owner;
1118         driver->driver.bus = &i2c_bus_type;
1119
1120         /* When registration returns, the driver core
1121          * will have called probe() for all matching-but-unbound devices.
1122          */
1123         res = driver_register(&driver->driver);
1124         if (res)
1125                 return res;
1126
1127         pr_debug("i2c-core: driver [%s] registered\n", driver->driver.name);
1128
1129         INIT_LIST_HEAD(&driver->clients);
1130         /* Walk the adapters that are already present */
1131         mutex_lock(&core_lock);
1132         bus_for_each_dev(&i2c_bus_type, NULL, driver, __process_new_driver);
1133         mutex_unlock(&core_lock);
1134
1135         return 0;
1136 }
1137 EXPORT_SYMBOL(i2c_register_driver);
1138
1139 static int __process_removed_driver(struct device *dev, void *data)
1140 {
1141         if (dev->type != &i2c_adapter_type)
1142                 return 0;
1143         return i2c_do_del_adapter(data, to_i2c_adapter(dev));
1144 }
1145
1146 /**
1147  * i2c_del_driver - unregister I2C driver
1148  * @driver: the driver being unregistered
1149  * Context: can sleep
1150  */
1151 void i2c_del_driver(struct i2c_driver *driver)
1152 {
1153         mutex_lock(&core_lock);
1154         bus_for_each_dev(&i2c_bus_type, NULL, driver, __process_removed_driver);
1155         mutex_unlock(&core_lock);
1156
1157         driver_unregister(&driver->driver);
1158         pr_debug("i2c-core: driver [%s] unregistered\n", driver->driver.name);
1159 }
1160 EXPORT_SYMBOL(i2c_del_driver);
1161
1162 /* ------------------------------------------------------------------------- */
1163
1164 /**
1165  * i2c_use_client - increments the reference count of the i2c client structure
1166  * @client: the client being referenced
1167  *
1168  * Each live reference to a client should be refcounted. The driver model does
1169  * that automatically as part of driver binding, so that most drivers don't
1170  * need to do this explicitly: they hold a reference until they're unbound
1171  * from the device.
1172  *
1173  * A pointer to the client with the incremented reference counter is returned.
1174  */
1175 struct i2c_client *i2c_use_client(struct i2c_client *client)
1176 {
1177         if (client && get_device(&client->dev))
1178                 return client;
1179         return NULL;
1180 }
1181 EXPORT_SYMBOL(i2c_use_client);
1182
1183 /**
1184  * i2c_release_client - release a use of the i2c client structure
1185  * @client: the client being no longer referenced
1186  *
1187  * Must be called when a user of a client is finished with it.
1188  */
1189 void i2c_release_client(struct i2c_client *client)
1190 {
1191         if (client)
1192                 put_device(&client->dev);
1193 }
1194 EXPORT_SYMBOL(i2c_release_client);
1195
1196 struct i2c_cmd_arg {
1197         unsigned        cmd;
1198         void            *arg;
1199 };
1200
1201 static int i2c_cmd(struct device *dev, void *_arg)
1202 {
1203         struct i2c_client       *client = i2c_verify_client(dev);
1204         struct i2c_cmd_arg      *arg = _arg;
1205
1206         if (client && client->driver && client->driver->command)
1207                 client->driver->command(client, arg->cmd, arg->arg);
1208         return 0;
1209 }
1210
1211 void i2c_clients_command(struct i2c_adapter *adap, unsigned int cmd, void *arg)
1212 {
1213         struct i2c_cmd_arg      cmd_arg;
1214
1215         cmd_arg.cmd = cmd;
1216         cmd_arg.arg = arg;
1217         device_for_each_child(&adap->dev, &cmd_arg, i2c_cmd);
1218 }
1219 EXPORT_SYMBOL(i2c_clients_command);
1220
1221 static int __init i2c_init(void)
1222 {
1223         int retval;
1224
1225         retval = bus_register(&i2c_bus_type);
1226         if (retval)
1227                 return retval;
1228 #ifdef CONFIG_I2C_COMPAT
1229         i2c_adapter_compat_class = class_compat_register("i2c-adapter");
1230         if (!i2c_adapter_compat_class) {
1231                 retval = -ENOMEM;
1232                 goto bus_err;
1233         }
1234 #endif
1235         retval = i2c_add_driver(&dummy_driver);
1236         if (retval)
1237                 goto class_err;
1238         return 0;
1239
1240 class_err:
1241 #ifdef CONFIG_I2C_COMPAT
1242         class_compat_unregister(i2c_adapter_compat_class);
1243 bus_err:
1244 #endif
1245         bus_unregister(&i2c_bus_type);
1246         return retval;
1247 }
1248
1249 static void __exit i2c_exit(void)
1250 {
1251         i2c_del_driver(&dummy_driver);
1252 #ifdef CONFIG_I2C_COMPAT
1253         class_compat_unregister(i2c_adapter_compat_class);
1254 #endif
1255         bus_unregister(&i2c_bus_type);
1256 }
1257
1258 /* We must initialize early, because some subsystems register i2c drivers
1259  * in subsys_initcall() code, but are linked (and initialized) before i2c.
1260  */
1261 postcore_initcall(i2c_init);
1262 module_exit(i2c_exit);
1263
1264 /* ----------------------------------------------------
1265  * the functional interface to the i2c busses.
1266  * ----------------------------------------------------
1267  */
1268
1269 /**
1270  * i2c_transfer - execute a single or combined I2C message
1271  * @adap: Handle to I2C bus
1272  * @msgs: One or more messages to execute before STOP is issued to
1273  *      terminate the operation; each message begins with a START.
1274  * @num: Number of messages to be executed.
1275  *
1276  * Returns negative errno, else the number of messages executed.
1277  *
1278  * Note that there is no requirement that each message be sent to
1279  * the same slave address, although that is the most common model.
1280  */
1281 int i2c_transfer(struct i2c_adapter *adap, struct i2c_msg *msgs, int num)
1282 {
1283         unsigned long orig_jiffies;
1284         int ret, try;
1285
1286         /* REVISIT the fault reporting model here is weak:
1287          *
1288          *  - When we get an error after receiving N bytes from a slave,
1289          *    there is no way to report "N".
1290          *
1291          *  - When we get a NAK after transmitting N bytes to a slave,
1292          *    there is no way to report "N" ... or to let the master
1293          *    continue executing the rest of this combined message, if
1294          *    that's the appropriate response.
1295          *
1296          *  - When for example "num" is two and we successfully complete
1297          *    the first message but get an error part way through the
1298          *    second, it's unclear whether that should be reported as
1299          *    one (discarding status on the second message) or errno
1300          *    (discarding status on the first one).
1301          */
1302
1303         if (adap->algo->master_xfer) {
1304 #ifdef DEBUG
1305                 for (ret = 0; ret < num; ret++) {
1306                         dev_dbg(&adap->dev, "master_xfer[%d] %c, addr=0x%02x, "
1307                                 "len=%d%s\n", ret, (msgs[ret].flags & I2C_M_RD)
1308                                 ? 'R' : 'W', msgs[ret].addr, msgs[ret].len,
1309                                 (msgs[ret].flags & I2C_M_RECV_LEN) ? "+" : "");
1310                 }
1311 #endif
1312
1313                 if (in_atomic() || irqs_disabled()) {
1314                         ret = i2c_trylock_adapter(adap);
1315                         if (!ret)
1316                                 /* I2C activity is ongoing. */
1317                                 return -EAGAIN;
1318                 } else {
1319                         i2c_lock_adapter(adap);
1320                 }
1321
1322                 /* Retry automatically on arbitration loss */
1323                 orig_jiffies = jiffies;
1324                 for (ret = 0, try = 0; try <= adap->retries; try++) {
1325                         ret = adap->algo->master_xfer(adap, msgs, num);
1326                         if (ret != -EAGAIN)
1327                                 break;
1328                         if (time_after(jiffies, orig_jiffies + adap->timeout))
1329                                 break;
1330                 }
1331                 i2c_unlock_adapter(adap);
1332
1333                 return ret;
1334         } else {
1335                 dev_dbg(&adap->dev, "I2C level transfers not supported\n");
1336                 return -EOPNOTSUPP;
1337         }
1338 }
1339 EXPORT_SYMBOL(i2c_transfer);
1340
1341 /**
1342  * i2c_master_send - issue a single I2C message in master transmit mode
1343  * @client: Handle to slave device
1344  * @buf: Data that will be written to the slave
1345  * @count: How many bytes to write, must be less than 64k since msg.len is u16
1346  *
1347  * Returns negative errno, or else the number of bytes written.
1348  */
1349 int i2c_master_send(struct i2c_client *client, const char *buf, int count)
1350 {
1351         int ret;
1352         struct i2c_adapter *adap = client->adapter;
1353         struct i2c_msg msg;
1354
1355         msg.addr = client->addr;
1356         msg.flags = client->flags & I2C_M_TEN;
1357         msg.len = count;
1358         msg.buf = (char *)buf;
1359
1360         ret = i2c_transfer(adap, &msg, 1);
1361
1362         /* If everything went ok (i.e. 1 msg transmitted), return #bytes
1363            transmitted, else error code. */
1364         return (ret == 1) ? count : ret;
1365 }
1366 EXPORT_SYMBOL(i2c_master_send);
1367
1368 /**
1369  * i2c_master_recv - issue a single I2C message in master receive mode
1370  * @client: Handle to slave device
1371  * @buf: Where to store data read from slave
1372  * @count: How many bytes to read, must be less than 64k since msg.len is u16
1373  *
1374  * Returns negative errno, or else the number of bytes read.
1375  */
1376 int i2c_master_recv(struct i2c_client *client, char *buf, int count)
1377 {
1378         struct i2c_adapter *adap = client->adapter;
1379         struct i2c_msg msg;
1380         int ret;
1381
1382         msg.addr = client->addr;
1383         msg.flags = client->flags & I2C_M_TEN;
1384         msg.flags |= I2C_M_RD;
1385         msg.len = count;
1386         msg.buf = buf;
1387
1388         ret = i2c_transfer(adap, &msg, 1);
1389
1390         /* If everything went ok (i.e. 1 msg transmitted), return #bytes
1391            transmitted, else error code. */
1392         return (ret == 1) ? count : ret;
1393 }
1394 EXPORT_SYMBOL(i2c_master_recv);
1395
1396 /* ----------------------------------------------------
1397  * the i2c address scanning function
1398  * Will not work for 10-bit addresses!
1399  * ----------------------------------------------------
1400  */
1401
1402 /*
1403  * Legacy default probe function, mostly relevant for SMBus. The default
1404  * probe method is a quick write, but it is known to corrupt the 24RF08
1405  * EEPROMs due to a state machine bug, and could also irreversibly
1406  * write-protect some EEPROMs, so for address ranges 0x30-0x37 and 0x50-0x5f,
1407  * we use a short byte read instead. Also, some bus drivers don't implement
1408  * quick write, so we fallback to a byte read in that case too.
1409  * On x86, there is another special case for FSC hardware monitoring chips,
1410  * which want regular byte reads (address 0x73.) Fortunately, these are the
1411  * only known chips using this I2C address on PC hardware.
1412  * Returns 1 if probe succeeded, 0 if not.
1413  */
1414 static int i2c_default_probe(struct i2c_adapter *adap, unsigned short addr)
1415 {
1416         int err;
1417         union i2c_smbus_data dummy;
1418
1419 #ifdef CONFIG_X86
1420         if (addr == 0x73 && (adap->class & I2C_CLASS_HWMON)
1421          && i2c_check_functionality(adap, I2C_FUNC_SMBUS_READ_BYTE_DATA))
1422                 err = i2c_smbus_xfer(adap, addr, 0, I2C_SMBUS_READ, 0,
1423                                      I2C_SMBUS_BYTE_DATA, &dummy);
1424         else
1425 #endif
1426         if (!((addr & ~0x07) == 0x30 || (addr & ~0x0f) == 0x50)
1427          && i2c_check_functionality(adap, I2C_FUNC_SMBUS_QUICK))
1428                 err = i2c_smbus_xfer(adap, addr, 0, I2C_SMBUS_WRITE, 0,
1429                                      I2C_SMBUS_QUICK, NULL);
1430         else if (i2c_check_functionality(adap, I2C_FUNC_SMBUS_READ_BYTE))
1431                 err = i2c_smbus_xfer(adap, addr, 0, I2C_SMBUS_READ, 0,
1432                                      I2C_SMBUS_BYTE, &dummy);
1433         else {
1434                 dev_warn(&adap->dev, "No suitable probing method supported\n");
1435                 err = -EOPNOTSUPP;
1436         }
1437
1438         return err >= 0;
1439 }
1440
1441 static int i2c_detect_address(struct i2c_client *temp_client,
1442                               struct i2c_driver *driver)
1443 {
1444         struct i2c_board_info info;
1445         struct i2c_adapter *adapter = temp_client->adapter;
1446         int addr = temp_client->addr;
1447         int err;
1448
1449         /* Make sure the address is valid */
1450         err = i2c_check_addr_validity(addr);
1451         if (err) {
1452                 dev_warn(&adapter->dev, "Invalid probe address 0x%02x\n",
1453                          addr);
1454                 return err;
1455         }
1456
1457         /* Skip if already in use */
1458         if (i2c_check_addr_busy(adapter, addr))
1459                 return 0;
1460
1461         /* Make sure there is something at this address */
1462         if (!i2c_default_probe(adapter, addr))
1463                 return 0;
1464
1465         /* Finally call the custom detection function */
1466         memset(&info, 0, sizeof(struct i2c_board_info));
1467         info.addr = addr;
1468         err = driver->detect(temp_client, &info);
1469         if (err) {
1470                 /* -ENODEV is returned if the detection fails. We catch it
1471                    here as this isn't an error. */
1472                 return err == -ENODEV ? 0 : err;
1473         }
1474
1475         /* Consistency check */
1476         if (info.type[0] == '\0') {
1477                 dev_err(&adapter->dev, "%s detection function provided "
1478                         "no name for 0x%x\n", driver->driver.name,
1479                         addr);
1480         } else {
1481                 struct i2c_client *client;
1482
1483                 /* Detection succeeded, instantiate the device */
1484                 dev_dbg(&adapter->dev, "Creating %s at 0x%02x\n",
1485                         info.type, info.addr);
1486                 client = i2c_new_device(adapter, &info);
1487                 if (client)
1488                         list_add_tail(&client->detected, &driver->clients);
1489                 else
1490                         dev_err(&adapter->dev, "Failed creating %s at 0x%02x\n",
1491                                 info.type, info.addr);
1492         }
1493         return 0;
1494 }
1495
1496 static int i2c_detect(struct i2c_adapter *adapter, struct i2c_driver *driver)
1497 {
1498         const unsigned short *address_list;
1499         struct i2c_client *temp_client;
1500         int i, err = 0;
1501         int adap_id = i2c_adapter_id(adapter);
1502
1503         address_list = driver->address_list;
1504         if (!driver->detect || !address_list)
1505                 return 0;
1506
1507         /* Set up a temporary client to help detect callback */
1508         temp_client = kzalloc(sizeof(struct i2c_client), GFP_KERNEL);
1509         if (!temp_client)
1510                 return -ENOMEM;
1511         temp_client->adapter = adapter;
1512
1513         /* Stop here if the classes do not match */
1514         if (!(adapter->class & driver->class))
1515                 goto exit_free;
1516
1517         for (i = 0; address_list[i] != I2C_CLIENT_END; i += 1) {
1518                 dev_dbg(&adapter->dev, "found normal entry for adapter %d, "
1519                         "addr 0x%02x\n", adap_id, address_list[i]);
1520                 temp_client->addr = address_list[i];
1521                 err = i2c_detect_address(temp_client, driver);
1522                 if (err)
1523                         goto exit_free;
1524         }
1525
1526  exit_free:
1527         kfree(temp_client);
1528         return err;
1529 }
1530
1531 int i2c_probe_func_quick_read(struct i2c_adapter *adap, unsigned short addr)
1532 {
1533         return i2c_smbus_xfer(adap, addr, 0, I2C_SMBUS_READ, 0,
1534                               I2C_SMBUS_QUICK, NULL) >= 0;
1535 }
1536 EXPORT_SYMBOL_GPL(i2c_probe_func_quick_read);
1537
1538 struct i2c_client *
1539 i2c_new_probed_device(struct i2c_adapter *adap,
1540                       struct i2c_board_info *info,
1541                       unsigned short const *addr_list,
1542                       int (*probe)(struct i2c_adapter *, unsigned short addr))
1543 {
1544         int i;
1545
1546         if (!probe)
1547                 probe = i2c_default_probe;
1548
1549         for (i = 0; addr_list[i] != I2C_CLIENT_END; i++) {
1550                 /* Check address validity */
1551                 if (i2c_check_addr_validity(addr_list[i]) < 0) {
1552                         dev_warn(&adap->dev, "Invalid 7-bit address "
1553                                  "0x%02x\n", addr_list[i]);
1554                         continue;
1555                 }
1556
1557                 /* Check address availability */
1558                 if (i2c_check_addr_busy(adap, addr_list[i])) {
1559                         dev_dbg(&adap->dev, "Address 0x%02x already in "
1560                                 "use, not probing\n", addr_list[i]);
1561                         continue;
1562                 }
1563
1564                 /* Test address responsiveness */
1565                 if (probe(adap, addr_list[i]))
1566                         break;
1567         }
1568
1569         if (addr_list[i] == I2C_CLIENT_END) {
1570                 dev_dbg(&adap->dev, "Probing failed, no device found\n");
1571                 return NULL;
1572         }
1573
1574         info->addr = addr_list[i];
1575         return i2c_new_device(adap, info);
1576 }
1577 EXPORT_SYMBOL_GPL(i2c_new_probed_device);
1578
1579 struct i2c_adapter *i2c_get_adapter(int id)
1580 {
1581         struct i2c_adapter *adapter;
1582
1583         mutex_lock(&core_lock);
1584         adapter = idr_find(&i2c_adapter_idr, id);
1585         if (adapter && !try_module_get(adapter->owner))
1586                 adapter = NULL;
1587
1588         mutex_unlock(&core_lock);
1589         return adapter;
1590 }
1591 EXPORT_SYMBOL(i2c_get_adapter);
1592
1593 void i2c_put_adapter(struct i2c_adapter *adap)
1594 {
1595         module_put(adap->owner);
1596 }
1597 EXPORT_SYMBOL(i2c_put_adapter);
1598
1599 /* The SMBus parts */
1600
1601 #define POLY    (0x1070U << 3)
1602 static u8 crc8(u16 data)
1603 {
1604         int i;
1605
1606         for (i = 0; i < 8; i++) {
1607                 if (data & 0x8000)
1608                         data = data ^ POLY;
1609                 data = data << 1;
1610         }
1611         return (u8)(data >> 8);
1612 }
1613
1614 /* Incremental CRC8 over count bytes in the array pointed to by p */
1615 static u8 i2c_smbus_pec(u8 crc, u8 *p, size_t count)
1616 {
1617         int i;
1618
1619         for (i = 0; i < count; i++)
1620                 crc = crc8((crc ^ p[i]) << 8);
1621         return crc;
1622 }
1623
1624 /* Assume a 7-bit address, which is reasonable for SMBus */
1625 static u8 i2c_smbus_msg_pec(u8 pec, struct i2c_msg *msg)
1626 {
1627         /* The address will be sent first */
1628         u8 addr = (msg->addr << 1) | !!(msg->flags & I2C_M_RD);
1629         pec = i2c_smbus_pec(pec, &addr, 1);
1630
1631         /* The data buffer follows */
1632         return i2c_smbus_pec(pec, msg->buf, msg->len);
1633 }
1634
1635 /* Used for write only transactions */
1636 static inline void i2c_smbus_add_pec(struct i2c_msg *msg)
1637 {
1638         msg->buf[msg->len] = i2c_smbus_msg_pec(0, msg);
1639         msg->len++;
1640 }
1641
1642 /* Return <0 on CRC error
1643    If there was a write before this read (most cases) we need to take the
1644    partial CRC from the write part into account.
1645    Note that this function does modify the message (we need to decrease the
1646    message length to hide the CRC byte from the caller). */
1647 static int i2c_smbus_check_pec(u8 cpec, struct i2c_msg *msg)
1648 {
1649         u8 rpec = msg->buf[--msg->len];
1650         cpec = i2c_smbus_msg_pec(cpec, msg);
1651
1652         if (rpec != cpec) {
1653                 pr_debug("i2c-core: Bad PEC 0x%02x vs. 0x%02x\n",
1654                         rpec, cpec);
1655                 return -EBADMSG;
1656         }
1657         return 0;
1658 }
1659
1660 /**
1661  * i2c_smbus_read_byte - SMBus "receive byte" protocol
1662  * @client: Handle to slave device
1663  *
1664  * This executes the SMBus "receive byte" protocol, returning negative errno
1665  * else the byte received from the device.
1666  */
1667 s32 i2c_smbus_read_byte(struct i2c_client *client)
1668 {
1669         union i2c_smbus_data data;
1670         int status;
1671
1672         status = i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1673                                 I2C_SMBUS_READ, 0,
1674                                 I2C_SMBUS_BYTE, &data);
1675         return (status < 0) ? status : data.byte;
1676 }
1677 EXPORT_SYMBOL(i2c_smbus_read_byte);
1678
1679 /**
1680  * i2c_smbus_write_byte - SMBus "send byte" protocol
1681  * @client: Handle to slave device
1682  * @value: Byte to be sent
1683  *
1684  * This executes the SMBus "send byte" protocol, returning negative errno
1685  * else zero on success.
1686  */
1687 s32 i2c_smbus_write_byte(struct i2c_client *client, u8 value)
1688 {
1689         return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1690                               I2C_SMBUS_WRITE, value, I2C_SMBUS_BYTE, NULL);
1691 }
1692 EXPORT_SYMBOL(i2c_smbus_write_byte);
1693
1694 /**
1695  * i2c_smbus_read_byte_data - SMBus "read byte" protocol
1696  * @client: Handle to slave device
1697  * @command: Byte interpreted by slave
1698  *
1699  * This executes the SMBus "read byte" protocol, returning negative errno
1700  * else a data byte received from the device.
1701  */
1702 s32 i2c_smbus_read_byte_data(struct i2c_client *client, u8 command)
1703 {
1704         union i2c_smbus_data data;
1705         int status;
1706
1707         status = i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1708                                 I2C_SMBUS_READ, command,
1709                                 I2C_SMBUS_BYTE_DATA, &data);
1710         return (status < 0) ? status : data.byte;
1711 }
1712 EXPORT_SYMBOL(i2c_smbus_read_byte_data);
1713
1714 /**
1715  * i2c_smbus_write_byte_data - SMBus "write byte" protocol
1716  * @client: Handle to slave device
1717  * @command: Byte interpreted by slave
1718  * @value: Byte being written
1719  *
1720  * This executes the SMBus "write byte" protocol, returning negative errno
1721  * else zero on success.
1722  */
1723 s32 i2c_smbus_write_byte_data(struct i2c_client *client, u8 command, u8 value)
1724 {
1725         union i2c_smbus_data data;
1726         data.byte = value;
1727         return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1728                               I2C_SMBUS_WRITE, command,
1729                               I2C_SMBUS_BYTE_DATA, &data);
1730 }
1731 EXPORT_SYMBOL(i2c_smbus_write_byte_data);
1732
1733 /**
1734  * i2c_smbus_read_word_data - SMBus "read word" protocol
1735  * @client: Handle to slave device
1736  * @command: Byte interpreted by slave
1737  *
1738  * This executes the SMBus "read word" protocol, returning negative errno
1739  * else a 16-bit unsigned "word" received from the device.
1740  */
1741 s32 i2c_smbus_read_word_data(struct i2c_client *client, u8 command)
1742 {
1743         union i2c_smbus_data data;
1744         int status;
1745
1746         status = i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1747                                 I2C_SMBUS_READ, command,
1748                                 I2C_SMBUS_WORD_DATA, &data);
1749         return (status < 0) ? status : data.word;
1750 }
1751 EXPORT_SYMBOL(i2c_smbus_read_word_data);
1752
1753 /**
1754  * i2c_smbus_write_word_data - SMBus "write word" protocol
1755  * @client: Handle to slave device
1756  * @command: Byte interpreted by slave
1757  * @value: 16-bit "word" being written
1758  *
1759  * This executes the SMBus "write word" protocol, returning negative errno
1760  * else zero on success.
1761  */
1762 s32 i2c_smbus_write_word_data(struct i2c_client *client, u8 command, u16 value)
1763 {
1764         union i2c_smbus_data data;
1765         data.word = value;
1766         return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1767                               I2C_SMBUS_WRITE, command,
1768                               I2C_SMBUS_WORD_DATA, &data);
1769 }
1770 EXPORT_SYMBOL(i2c_smbus_write_word_data);
1771
1772 /**
1773  * i2c_smbus_process_call - SMBus "process call" protocol
1774  * @client: Handle to slave device
1775  * @command: Byte interpreted by slave
1776  * @value: 16-bit "word" being written
1777  *
1778  * This executes the SMBus "process call" protocol, returning negative errno
1779  * else a 16-bit unsigned "word" received from the device.
1780  */
1781 s32 i2c_smbus_process_call(struct i2c_client *client, u8 command, u16 value)
1782 {
1783         union i2c_smbus_data data;
1784         int status;
1785         data.word = value;
1786
1787         status = i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1788                                 I2C_SMBUS_WRITE, command,
1789                                 I2C_SMBUS_PROC_CALL, &data);
1790         return (status < 0) ? status : data.word;
1791 }
1792 EXPORT_SYMBOL(i2c_smbus_process_call);
1793
1794 /**
1795  * i2c_smbus_read_block_data - SMBus "block read" protocol
1796  * @client: Handle to slave device
1797  * @command: Byte interpreted by slave
1798  * @values: Byte array into which data will be read; big enough to hold
1799  *      the data returned by the slave.  SMBus allows at most 32 bytes.
1800  *
1801  * This executes the SMBus "block read" protocol, returning negative errno
1802  * else the number of data bytes in the slave's response.
1803  *
1804  * Note that using this function requires that the client's adapter support
1805  * the I2C_FUNC_SMBUS_READ_BLOCK_DATA functionality.  Not all adapter drivers
1806  * support this; its emulation through I2C messaging relies on a specific
1807  * mechanism (I2C_M_RECV_LEN) which may not be implemented.
1808  */
1809 s32 i2c_smbus_read_block_data(struct i2c_client *client, u8 command,
1810                               u8 *values)
1811 {
1812         union i2c_smbus_data data;
1813         int status;
1814
1815         status = i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1816                                 I2C_SMBUS_READ, command,
1817                                 I2C_SMBUS_BLOCK_DATA, &data);
1818         if (status)
1819                 return status;
1820
1821         memcpy(values, &data.block[1], data.block[0]);
1822         return data.block[0];
1823 }
1824 EXPORT_SYMBOL(i2c_smbus_read_block_data);
1825
1826 /**
1827  * i2c_smbus_write_block_data - SMBus "block write" protocol
1828  * @client: Handle to slave device
1829  * @command: Byte interpreted by slave
1830  * @length: Size of data block; SMBus allows at most 32 bytes
1831  * @values: Byte array which will be written.
1832  *
1833  * This executes the SMBus "block write" protocol, returning negative errno
1834  * else zero on success.
1835  */
1836 s32 i2c_smbus_write_block_data(struct i2c_client *client, u8 command,
1837                                u8 length, const u8 *values)
1838 {
1839         union i2c_smbus_data data;
1840
1841         if (length > I2C_SMBUS_BLOCK_MAX)
1842                 length = I2C_SMBUS_BLOCK_MAX;
1843         data.block[0] = length;
1844         memcpy(&data.block[1], values, length);
1845         return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1846                               I2C_SMBUS_WRITE, command,
1847                               I2C_SMBUS_BLOCK_DATA, &data);
1848 }
1849 EXPORT_SYMBOL(i2c_smbus_write_block_data);
1850
1851 /* Returns the number of read bytes */
1852 s32 i2c_smbus_read_i2c_block_data(struct i2c_client *client, u8 command,
1853                                   u8 length, u8 *values)
1854 {
1855         union i2c_smbus_data data;
1856         int status;
1857
1858         if (length > I2C_SMBUS_BLOCK_MAX)
1859                 length = I2C_SMBUS_BLOCK_MAX;
1860         data.block[0] = length;
1861         status = i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1862                                 I2C_SMBUS_READ, command,
1863                                 I2C_SMBUS_I2C_BLOCK_DATA, &data);
1864         if (status < 0)
1865                 return status;
1866
1867         memcpy(values, &data.block[1], data.block[0]);
1868         return data.block[0];
1869 }
1870 EXPORT_SYMBOL(i2c_smbus_read_i2c_block_data);
1871
1872 s32 i2c_smbus_write_i2c_block_data(struct i2c_client *client, u8 command,
1873                                    u8 length, const u8 *values)
1874 {
1875         union i2c_smbus_data data;
1876
1877         if (length > I2C_SMBUS_BLOCK_MAX)
1878                 length = I2C_SMBUS_BLOCK_MAX;
1879         data.block[0] = length;
1880         memcpy(data.block + 1, values, length);
1881         return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
1882                               I2C_SMBUS_WRITE, command,
1883                               I2C_SMBUS_I2C_BLOCK_DATA, &data);
1884 }
1885 EXPORT_SYMBOL(i2c_smbus_write_i2c_block_data);
1886
1887 /* Simulate a SMBus command using the i2c protocol
1888    No checking of parameters is done!  */
1889 static s32 i2c_smbus_xfer_emulated(struct i2c_adapter *adapter, u16 addr,
1890                                    unsigned short flags,
1891                                    char read_write, u8 command, int size,
1892                                    union i2c_smbus_data *data)
1893 {
1894         /* So we need to generate a series of msgs. In the case of writing, we
1895           need to use only one message; when reading, we need two. We initialize
1896           most things with sane defaults, to keep the code below somewhat
1897           simpler. */
1898         unsigned char msgbuf0[I2C_SMBUS_BLOCK_MAX+3];
1899         unsigned char msgbuf1[I2C_SMBUS_BLOCK_MAX+2];
1900         int num = read_write == I2C_SMBUS_READ ? 2 : 1;
1901         struct i2c_msg msg[2] = { { addr, flags, 1, msgbuf0 },
1902                                   { addr, flags | I2C_M_RD, 0, msgbuf1 }
1903                                 };
1904         int i;
1905         u8 partial_pec = 0;
1906         int status;
1907
1908         msgbuf0[0] = command;
1909         switch (size) {
1910         case I2C_SMBUS_QUICK:
1911                 msg[0].len = 0;
1912                 /* Special case: The read/write field is used as data */
1913                 msg[0].flags = flags | (read_write == I2C_SMBUS_READ ?
1914                                         I2C_M_RD : 0);
1915                 num = 1;
1916                 break;
1917         case I2C_SMBUS_BYTE:
1918                 if (read_write == I2C_SMBUS_READ) {
1919                         /* Special case: only a read! */
1920                         msg[0].flags = I2C_M_RD | flags;
1921                         num = 1;
1922                 }
1923                 break;
1924         case I2C_SMBUS_BYTE_DATA:
1925                 if (read_write == I2C_SMBUS_READ)
1926                         msg[1].len = 1;
1927                 else {
1928                         msg[0].len = 2;
1929                         msgbuf0[1] = data->byte;
1930                 }
1931                 break;
1932         case I2C_SMBUS_WORD_DATA:
1933                 if (read_write == I2C_SMBUS_READ)
1934                         msg[1].len = 2;
1935                 else {
1936                         msg[0].len = 3;
1937                         msgbuf0[1] = data->word & 0xff;
1938                         msgbuf0[2] = data->word >> 8;
1939                 }
1940                 break;
1941         case I2C_SMBUS_PROC_CALL:
1942                 num = 2; /* Special case */
1943                 read_write = I2C_SMBUS_READ;
1944                 msg[0].len = 3;
1945                 msg[1].len = 2;
1946                 msgbuf0[1] = data->word & 0xff;
1947                 msgbuf0[2] = data->word >> 8;
1948                 break;
1949         case I2C_SMBUS_BLOCK_DATA:
1950                 if (read_write == I2C_SMBUS_READ) {
1951                         msg[1].flags |= I2C_M_RECV_LEN;
1952                         msg[1].len = 1; /* block length will be added by
1953                                            the underlying bus driver */
1954                 } else {
1955                         msg[0].len = data->block[0] + 2;
1956                         if (msg[0].len > I2C_SMBUS_BLOCK_MAX + 2) {
1957                                 dev_err(&adapter->dev,
1958                                         "Invalid block write size %d\n",
1959                                         data->block[0]);
1960                                 return -EINVAL;
1961                         }
1962                         for (i = 1; i < msg[0].len; i++)
1963                                 msgbuf0[i] = data->block[i-1];
1964                 }
1965                 break;
1966         case I2C_SMBUS_BLOCK_PROC_CALL:
1967                 num = 2; /* Another special case */
1968                 read_write = I2C_SMBUS_READ;
1969                 if (data->block[0] > I2C_SMBUS_BLOCK_MAX) {
1970                         dev_err(&adapter->dev,
1971                                 "Invalid block write size %d\n",
1972                                 data->block[0]);
1973                         return -EINVAL;
1974                 }
1975                 msg[0].len = data->block[0] + 2;
1976                 for (i = 1; i < msg[0].len; i++)
1977                         msgbuf0[i] = data->block[i-1];
1978                 msg[1].flags |= I2C_M_RECV_LEN;
1979                 msg[1].len = 1; /* block length will be added by
1980                                    the underlying bus driver */
1981                 break;
1982         case I2C_SMBUS_I2C_BLOCK_DATA:
1983                 if (read_write == I2C_SMBUS_READ) {
1984                         msg[1].len = data->block[0];
1985                 } else {
1986                         msg[0].len = data->block[0] + 1;
1987                         if (msg[0].len > I2C_SMBUS_BLOCK_MAX + 1) {
1988                                 dev_err(&adapter->dev,
1989                                         "Invalid block write size %d\n",
1990                                         data->block[0]);
1991                                 return -EINVAL;
1992                         }
1993                         for (i = 1; i <= data->block[0]; i++)
1994                                 msgbuf0[i] = data->block[i];
1995                 }
1996                 break;
1997         default:
1998                 dev_err(&adapter->dev, "Unsupported transaction %d\n", size);
1999                 return -EOPNOTSUPP;
2000         }
2001
2002         i = ((flags & I2C_CLIENT_PEC) && size != I2C_SMBUS_QUICK
2003                                       && size != I2C_SMBUS_I2C_BLOCK_DATA);
2004         if (i) {
2005                 /* Compute PEC if first message is a write */
2006                 if (!(msg[0].flags & I2C_M_RD)) {
2007                         if (num == 1) /* Write only */
2008                                 i2c_smbus_add_pec(&msg[0]);
2009                         else /* Write followed by read */
2010                                 partial_pec = i2c_smbus_msg_pec(0, &msg[0]);
2011                 }
2012                 /* Ask for PEC if last message is a read */
2013                 if (msg[num-1].flags & I2C_M_RD)
2014                         msg[num-1].len++;
2015         }
2016
2017         status = i2c_transfer(adapter, msg, num);
2018         if (status < 0)
2019                 return status;
2020
2021         /* Check PEC if last message is a read */
2022         if (i && (msg[num-1].flags & I2C_M_RD)) {
2023                 status = i2c_smbus_check_pec(partial_pec, &msg[num-1]);
2024                 if (status < 0)
2025                         return status;
2026         }
2027
2028         if (read_write == I2C_SMBUS_READ)
2029                 switch (size) {
2030                 case I2C_SMBUS_BYTE:
2031                         data->byte = msgbuf0[0];
2032                         break;
2033                 case I2C_SMBUS_BYTE_DATA:
2034                         data->byte = msgbuf1[0];
2035                         break;
2036                 case I2C_SMBUS_WORD_DATA:
2037                 case I2C_SMBUS_PROC_CALL:
2038                         data->word = msgbuf1[0] | (msgbuf1[1] << 8);
2039                         break;
2040                 case I2C_SMBUS_I2C_BLOCK_DATA:
2041                         for (i = 0; i < data->block[0]; i++)
2042                                 data->block[i+1] = msgbuf1[i];
2043                         break;
2044                 case I2C_SMBUS_BLOCK_DATA:
2045                 case I2C_SMBUS_BLOCK_PROC_CALL:
2046                         for (i = 0; i < msgbuf1[0] + 1; i++)
2047                                 data->block[i] = msgbuf1[i];
2048                         break;
2049                 }
2050         return 0;
2051 }
2052
2053 /**
2054  * i2c_smbus_xfer - execute SMBus protocol operations
2055  * @adapter: Handle to I2C bus
2056  * @addr: Address of SMBus slave on that bus
2057  * @flags: I2C_CLIENT_* flags (usually zero or I2C_CLIENT_PEC)
2058  * @read_write: I2C_SMBUS_READ or I2C_SMBUS_WRITE
2059  * @command: Byte interpreted by slave, for protocols which use such bytes
2060  * @protocol: SMBus protocol operation to execute, such as I2C_SMBUS_PROC_CALL
2061  * @data: Data to be read or written
2062  *
2063  * This executes an SMBus protocol operation, and returns a negative
2064  * errno code else zero on success.
2065  */
2066 s32 i2c_smbus_xfer(struct i2c_adapter *adapter, u16 addr, unsigned short flags,
2067                    char read_write, u8 command, int protocol,
2068                    union i2c_smbus_data *data)
2069 {
2070         unsigned long orig_jiffies;
2071         int try;
2072         s32 res;
2073
2074         flags &= I2C_M_TEN | I2C_CLIENT_PEC;
2075
2076         if (adapter->algo->smbus_xfer) {
2077                 i2c_lock_adapter(adapter);
2078
2079                 /* Retry automatically on arbitration loss */
2080                 orig_jiffies = jiffies;
2081                 for (res = 0, try = 0; try <= adapter->retries; try++) {
2082                         res = adapter->algo->smbus_xfer(adapter, addr, flags,
2083                                                         read_write, command,
2084                                                         protocol, data);
2085                         if (res != -EAGAIN)
2086                                 break;
2087                         if (time_after(jiffies,
2088                                        orig_jiffies + adapter->timeout))
2089                                 break;
2090                 }
2091                 i2c_unlock_adapter(adapter);
2092         } else
2093                 res = i2c_smbus_xfer_emulated(adapter, addr, flags, read_write,
2094                                               command, protocol, data);
2095
2096         return res;
2097 }
2098 EXPORT_SYMBOL(i2c_smbus_xfer);
2099
2100 MODULE_AUTHOR("Simon G. Vogl <simon@tk.uni-linz.ac.at>");
2101 MODULE_DESCRIPTION("I2C-Bus main module");
2102 MODULE_LICENSE("GPL");