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