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