2005-04-16 16:20:36 -06:00
|
|
|
/* i2c-core.c - a device driver for the iic-bus interface */
|
|
|
|
/* ------------------------------------------------------------------------- */
|
|
|
|
/* Copyright (C) 1995-99 Simon G. Vogl
|
|
|
|
|
|
|
|
This program is free software; you can redistribute it and/or modify
|
|
|
|
it under the terms of the GNU General Public License as published by
|
|
|
|
the Free Software Foundation; either version 2 of the License, or
|
|
|
|
(at your option) any later version.
|
|
|
|
|
|
|
|
This program is distributed in the hope that it will be useful,
|
|
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
2014-11-04 15:46:27 -07:00
|
|
|
GNU General Public License for more details. */
|
2005-04-16 16:20:36 -06:00
|
|
|
/* ------------------------------------------------------------------------- */
|
|
|
|
|
2007-10-19 15:21:04 -06:00
|
|
|
/* With some changes from Kyösti Mälkki <kmalkki@cc.hut.fi>.
|
2005-04-16 16:20:36 -06:00
|
|
|
All SMBus-related things are written by Frodo Looijaard <frodol@dds.nl>
|
[PATCH] i2c: SMBus PEC support rewrite, 2 of 3
This is my rewrite of the SMBus PEC support. The original
implementation was known to have bugs (credits go to Hideki Iwamoto
for reporting many of them recently), and was incomplete due to a
conceptual limitation.
The rewrite affects only software PEC. Hardware PEC needs very little
code and is mostly untouched.
Technically, both implementations differ in that the original one
was emulating PEC in software by modifying the contents of an
i2c_smbus_data union (changing the transaction to a different type),
while the new one works one level lower, on i2c_msg structures (working
on message contents). Due to the definition of the i2c_smbus_data union,
not all SMBus transactions could be handled (at least not without
changing the definition of this union, which would break user-space
compatibility), and those which could had to be implemented
individually. At the opposite, adding PEC to an i2c_msg structure
can be done on any SMBus transaction with common code.
Advantages of the new implementation:
* It's about twice as small (from ~136 lines before to ~70 now, only
counting i2c-core, including blank and comment lines). The memory
used by i2c-core is down by ~640 bytes (~3.5%).
* Easier to validate, less tricky code. The code being common to all
transactions by design, the risk that a bug can stay uncovered is
lower.
* All SMBus transactions have PEC support in I2C emulation mode
(providing the non-PEC transaction is also implemented). Transactions
which have no emulation code right now will get PEC support for free
when they finally get implemented.
* Allows for code simplifications in header files and bus drivers
(patch follows).
Drawbacks (I guess there had to be at least one):
* PEC emulation for non-PEC capable non-I2C SMBus masters was dropped.
It was based on SMBus tricks and doesn't quite fit in the new design.
I don't think it's really a problem, as the benefit was certainly
not worth the additional complexity, but it's only fair that I at
least mention it.
Lastly, let's note that the new implementation does slightly affect
compatibility (both in kernel and user-space), but doesn't actually
break it. Some defines will be dropped, but the code can always be
changed in a way that will work with both the old and the new
implementations. It shouldn't be a problem as there doesn't seem to be
many users of SMBus PEC to date anyway.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2005-10-26 13:28:55 -06:00
|
|
|
SMBus 2.0 support by Mark Studebaker <mdsxyz123@yahoo.com> and
|
2014-01-29 12:40:08 -07:00
|
|
|
Jean Delvare <jdelvare@suse.de>
|
2010-08-11 10:21:02 -06:00
|
|
|
Mux support by Rodolfo Giometti <giometti@enneenne.com> and
|
2013-07-11 05:56:15 -06:00
|
|
|
Michael Lawnick <michael.lawnick.ext@nsn.com>
|
|
|
|
OF support is copyright (c) 2008 Jochen Friedrich <jochen@scram.de>
|
|
|
|
(based on a previous patch from Jon Smirl <jonsmirl@gmail.com>) and
|
|
|
|
(c) 2013 Wolfram Sang <wsa@the-dreams.de>
|
2014-09-22 11:41:00 -06:00
|
|
|
I2C ACPI code Copyright (C) 2014 Intel Corp
|
|
|
|
Author: Lan Tianyu <tianyu.lan@intel.com>
|
2014-11-18 09:04:53 -07:00
|
|
|
I2C slave support (c) 2014 by Wolfram Sang <wsa@sang-engineering.com>
|
2013-07-11 05:56:15 -06:00
|
|
|
*/
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2015-05-19 13:04:40 -06:00
|
|
|
#include <dt-bindings/i2c/i2c.h>
|
2016-02-20 15:33:38 -07:00
|
|
|
#include <asm/uaccess.h>
|
|
|
|
#include <linux/acpi.h>
|
|
|
|
#include <linux/clk/clk-conf.h>
|
|
|
|
#include <linux/completion.h>
|
2012-02-28 05:56:31 -07:00
|
|
|
#include <linux/delay.h>
|
2016-02-20 15:33:38 -07:00
|
|
|
#include <linux/err.h>
|
2005-04-16 16:20:36 -06:00
|
|
|
#include <linux/errno.h>
|
2012-02-28 05:56:31 -07:00
|
|
|
#include <linux/gpio.h>
|
2016-02-20 15:33:38 -07:00
|
|
|
#include <linux/hardirq.h>
|
2005-04-16 16:20:36 -06:00
|
|
|
#include <linux/i2c.h>
|
|
|
|
#include <linux/idr.h>
|
2016-02-20 15:33:38 -07:00
|
|
|
#include <linux/init.h>
|
|
|
|
#include <linux/irqflags.h>
|
|
|
|
#include <linux/jump_label.h>
|
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/module.h>
|
2006-01-11 02:50:26 -07:00
|
|
|
#include <linux/mutex.h>
|
2010-06-08 07:48:19 -06:00
|
|
|
#include <linux/of_device.h>
|
2016-02-20 15:33:38 -07:00
|
|
|
#include <linux/of.h>
|
2013-07-11 05:56:15 -06:00
|
|
|
#include <linux/of_irq.h>
|
2014-09-29 05:58:47 -06:00
|
|
|
#include <linux/pm_domain.h>
|
2016-02-20 15:33:38 -07:00
|
|
|
#include <linux/pm_runtime.h>
|
2015-08-18 00:52:51 -06:00
|
|
|
#include <linux/pm_wakeirq.h>
|
2015-12-08 02:37:46 -07:00
|
|
|
#include <linux/property.h>
|
2016-02-20 15:33:38 -07:00
|
|
|
#include <linux/rwsem.h>
|
|
|
|
#include <linux/slab.h>
|
2005-04-16 16:20:36 -06:00
|
|
|
|
i2c: Add i2c_board_info and i2c_new_device()
This provides partial support for new-style I2C driver binding. It builds
on "struct i2c_board_info" declarations that identify I2C devices on a given
board. This is needed on systems with I2C devices that can't be fully probed
and/or autoconfigured, such as many embedded Linux configurations where the
way a given I2C device is wired may affect how it must be used.
There are two models for declaring such devices:
* LATE -- using a public function i2c_new_device(). This lets modules
declare I2C devices found *AFTER* a given I2C adapter becomes available.
For example, a PCI card could create adapters giving access to utility
chips on that card, and this would be used to associate those chips with
those adapters.
* EARLY -- from arch_initcall() level code, using a non-exported function
i2c_register_board_info(). This copies the declarations *BEFORE* such
an i2c_adapter becomes available, arranging that i2c_new_device() will
be called later when i2c-core registers the relevant i2c_adapter.
For example, arch/.../.../board-*.c files would declare the I2C devices
along with their platform data, and I2C devices would behave much like
PNPACPI devices. (That is, both enumerate from board-specific tables.)
To match the exported i2c_new_device(), the previously-private function
i2c_unregister_device() is now exported.
Pending later patches using these new APIs, this is effectively a NOP.
Signed-off-by: David Brownell <dbrownell@users.sourceforge.net>
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2007-05-01 15:26:31 -06:00
|
|
|
#include "i2c-core.h"
|
|
|
|
|
2014-03-06 06:35:59 -07:00
|
|
|
#define CREATE_TRACE_POINTS
|
|
|
|
#include <trace/events/i2c.h>
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2015-05-18 13:09:12 -06:00
|
|
|
#define I2C_ADDR_OFFSET_TEN_BIT 0xa000
|
|
|
|
#define I2C_ADDR_OFFSET_SLAVE 0x1000
|
|
|
|
|
2010-05-04 03:09:28 -06:00
|
|
|
/* core_lock protects i2c_adapter_idr, and guarantees
|
2009-06-19 08:58:19 -06:00
|
|
|
that device detection, deletion of detected devices, and attach_adapter
|
2013-03-09 01:16:44 -07:00
|
|
|
calls are serialized */
|
2008-01-27 10:14:49 -07:00
|
|
|
static DEFINE_MUTEX(core_lock);
|
2005-04-16 16:20:36 -06:00
|
|
|
static DEFINE_IDR(i2c_adapter_idr);
|
|
|
|
|
2009-09-18 14:45:46 -06:00
|
|
|
static struct device_type i2c_client_type;
|
i2c: Add detection capability to new-style drivers
Add a mechanism to let new-style i2c drivers optionally autodetect
devices they would support on selected buses and ask i2c-core to
instantiate them. This is a replacement for legacy i2c drivers, much
cleaner.
Where drivers had to implement both a legacy i2c_driver and a
new-style i2c_driver so far, this mechanism makes it possible to get
rid of the legacy i2c_driver and implement both enumerated and
detected device support with just one (new-style) i2c_driver.
Here is a quick conversion guide for these drivers, step by step:
* Delete the legacy driver definition, registration and removal.
Delete the attach_adapter and detach_client methods of the legacy
driver.
* Change the prototype of the legacy detect function from
static int foo_detect(struct i2c_adapter *adapter, int address, int kind);
to
static int foo_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info);
* Set the new-style driver detect callback to this new function, and
set its address_data to &addr_data (addr_data is generally provided
by I2C_CLIENT_INSMOD.)
* Add the appropriate class to the new-style driver. This is
typically the class the legacy attach_adapter method was checking
for. Class checking is now mandatory (done by i2c-core.) See
<linux/i2c.h> for the list of available classes.
* Remove the i2c_client allocation and freeing from the detect
function. A pre-allocated client is now handed to you by i2c-core,
and is freed automatically.
* Make the detect function fill the type field of the i2c_board_info
structure it was passed as a parameter, and return 0, on success. If
the detection fails, return -ENODEV.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2008-07-14 14:38:36 -06:00
|
|
|
static int i2c_detect(struct i2c_adapter *adapter, struct i2c_driver *driver);
|
2007-02-13 14:09:00 -07:00
|
|
|
|
2014-03-06 06:35:59 -07:00
|
|
|
static struct static_key i2c_trace_msg = STATIC_KEY_INIT_FALSE;
|
2016-03-07 04:49:17 -07:00
|
|
|
static bool is_registered;
|
2014-03-06 06:35:59 -07:00
|
|
|
|
|
|
|
void i2c_transfer_trace_reg(void)
|
|
|
|
{
|
|
|
|
static_key_slow_inc(&i2c_trace_msg);
|
|
|
|
}
|
|
|
|
|
|
|
|
void i2c_transfer_trace_unreg(void)
|
|
|
|
{
|
|
|
|
static_key_slow_dec(&i2c_trace_msg);
|
|
|
|
}
|
|
|
|
|
2014-09-22 11:41:00 -06:00
|
|
|
#if defined(CONFIG_ACPI)
|
|
|
|
struct acpi_i2c_handler_data {
|
|
|
|
struct acpi_connection_info info;
|
|
|
|
struct i2c_adapter *adapter;
|
|
|
|
};
|
|
|
|
|
|
|
|
struct gsb_buffer {
|
|
|
|
u8 status;
|
|
|
|
u8 len;
|
|
|
|
union {
|
|
|
|
u16 wdata;
|
|
|
|
u8 bdata;
|
|
|
|
u8 data[0];
|
|
|
|
};
|
|
|
|
} __packed;
|
|
|
|
|
2015-10-07 04:18:44 -06:00
|
|
|
struct acpi_i2c_lookup {
|
|
|
|
struct i2c_board_info *info;
|
|
|
|
acpi_handle adapter_handle;
|
|
|
|
acpi_handle device_handle;
|
|
|
|
};
|
2014-09-22 11:41:00 -06:00
|
|
|
|
2015-10-07 04:18:44 -06:00
|
|
|
static int acpi_i2c_find_address(struct acpi_resource *ares, void *data)
|
|
|
|
{
|
|
|
|
struct acpi_i2c_lookup *lookup = data;
|
|
|
|
struct i2c_board_info *info = lookup->info;
|
|
|
|
struct acpi_resource_i2c_serialbus *sb;
|
|
|
|
acpi_handle adapter_handle;
|
|
|
|
acpi_status status;
|
2014-09-22 11:41:00 -06:00
|
|
|
|
2015-10-07 04:18:44 -06:00
|
|
|
if (info->addr || ares->type != ACPI_RESOURCE_TYPE_SERIAL_BUS)
|
|
|
|
return 1;
|
|
|
|
|
|
|
|
sb = &ares->data.i2c_serial_bus;
|
|
|
|
if (sb->type != ACPI_RESOURCE_SERIAL_TYPE_I2C)
|
|
|
|
return 1;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Extract the ResourceSource and make sure that the handle matches
|
|
|
|
* with the I2C adapter handle.
|
|
|
|
*/
|
|
|
|
status = acpi_get_handle(lookup->device_handle,
|
|
|
|
sb->resource_source.string_ptr,
|
|
|
|
&adapter_handle);
|
|
|
|
if (ACPI_SUCCESS(status) && adapter_handle == lookup->adapter_handle) {
|
|
|
|
info->addr = sb->slave_address;
|
|
|
|
if (sb->access_mode == ACPI_I2C_10BIT_MODE)
|
|
|
|
info->flags |= I2C_CLIENT_TEN;
|
2014-09-22 11:41:00 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
static acpi_status acpi_i2c_add_device(acpi_handle handle, u32 level,
|
|
|
|
void *data, void **return_value)
|
|
|
|
{
|
|
|
|
struct i2c_adapter *adapter = data;
|
|
|
|
struct list_head resource_list;
|
2015-10-07 04:18:44 -06:00
|
|
|
struct acpi_i2c_lookup lookup;
|
|
|
|
struct resource_entry *entry;
|
2014-09-22 11:41:00 -06:00
|
|
|
struct i2c_board_info info;
|
|
|
|
struct acpi_device *adev;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
if (acpi_bus_get_device(handle, &adev))
|
|
|
|
return AE_OK;
|
|
|
|
if (acpi_bus_get_status(adev) || !adev->status.present)
|
|
|
|
return AE_OK;
|
|
|
|
|
|
|
|
memset(&info, 0, sizeof(info));
|
2015-03-16 16:49:03 -06:00
|
|
|
info.fwnode = acpi_fwnode_handle(adev);
|
2014-09-22 11:41:00 -06:00
|
|
|
|
2015-10-07 04:18:44 -06:00
|
|
|
memset(&lookup, 0, sizeof(lookup));
|
2015-10-23 13:27:07 -06:00
|
|
|
lookup.adapter_handle = ACPI_HANDLE(&adapter->dev);
|
2015-10-07 04:18:44 -06:00
|
|
|
lookup.device_handle = handle;
|
|
|
|
lookup.info = &info;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Look up for I2cSerialBus resource with ResourceSource that
|
|
|
|
* matches with this adapter.
|
|
|
|
*/
|
2014-09-22 11:41:00 -06:00
|
|
|
INIT_LIST_HEAD(&resource_list);
|
|
|
|
ret = acpi_dev_get_resources(adev, &resource_list,
|
2015-10-07 04:18:44 -06:00
|
|
|
acpi_i2c_find_address, &lookup);
|
2014-09-22 11:41:00 -06:00
|
|
|
acpi_dev_free_resource_list(&resource_list);
|
|
|
|
|
|
|
|
if (ret < 0 || !info.addr)
|
|
|
|
return AE_OK;
|
|
|
|
|
2015-10-07 04:18:44 -06:00
|
|
|
/* Then fill IRQ number if any */
|
|
|
|
ret = acpi_dev_get_resources(adev, &resource_list, NULL, NULL);
|
|
|
|
if (ret < 0)
|
|
|
|
return AE_OK;
|
|
|
|
|
|
|
|
resource_list_for_each_entry(entry, &resource_list) {
|
|
|
|
if (resource_type(entry->res) == IORESOURCE_IRQ) {
|
|
|
|
info.irq = entry->res->start;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
acpi_dev_free_resource_list(&resource_list);
|
|
|
|
|
2014-09-22 11:41:00 -06:00
|
|
|
adev->power.flags.ignore_parent = true;
|
|
|
|
strlcpy(info.type, dev_name(&adev->dev), sizeof(info.type));
|
|
|
|
if (!i2c_new_device(adapter, &info)) {
|
|
|
|
adev->power.flags.ignore_parent = false;
|
|
|
|
dev_err(&adapter->dev,
|
|
|
|
"failed to add I2C device %s from ACPI\n",
|
|
|
|
dev_name(&adev->dev));
|
|
|
|
}
|
|
|
|
|
|
|
|
return AE_OK;
|
|
|
|
}
|
|
|
|
|
2015-10-07 04:18:44 -06:00
|
|
|
#define ACPI_I2C_MAX_SCAN_DEPTH 32
|
|
|
|
|
2014-09-22 11:41:00 -06:00
|
|
|
/**
|
|
|
|
* acpi_i2c_register_devices - enumerate I2C slave devices behind adapter
|
|
|
|
* @adap: pointer to adapter
|
|
|
|
*
|
|
|
|
* Enumerate all I2C slave devices behind this adapter by walking the ACPI
|
|
|
|
* namespace. When a device is found it will be added to the Linux device
|
|
|
|
* model and bound to the corresponding ACPI handle.
|
|
|
|
*/
|
|
|
|
static void acpi_i2c_register_devices(struct i2c_adapter *adap)
|
|
|
|
{
|
|
|
|
acpi_status status;
|
|
|
|
|
2015-10-23 13:27:07 -06:00
|
|
|
if (!has_acpi_companion(&adap->dev))
|
2014-09-22 11:41:00 -06:00
|
|
|
return;
|
|
|
|
|
2015-10-07 04:18:44 -06:00
|
|
|
status = acpi_walk_namespace(ACPI_TYPE_DEVICE, ACPI_ROOT_OBJECT,
|
|
|
|
ACPI_I2C_MAX_SCAN_DEPTH,
|
2014-09-22 11:41:00 -06:00
|
|
|
acpi_i2c_add_device, NULL,
|
|
|
|
adap, NULL);
|
|
|
|
if (ACPI_FAILURE(status))
|
|
|
|
dev_warn(&adap->dev, "failed to enumerate I2C slaves\n");
|
|
|
|
}
|
|
|
|
|
|
|
|
#else /* CONFIG_ACPI */
|
|
|
|
static inline void acpi_i2c_register_devices(struct i2c_adapter *adap) { }
|
|
|
|
#endif /* CONFIG_ACPI */
|
|
|
|
|
|
|
|
#ifdef CONFIG_ACPI_I2C_OPREGION
|
|
|
|
static int acpi_gsb_i2c_read_bytes(struct i2c_client *client,
|
|
|
|
u8 cmd, u8 *data, u8 data_len)
|
|
|
|
{
|
|
|
|
|
|
|
|
struct i2c_msg msgs[2];
|
|
|
|
int ret;
|
|
|
|
u8 *buffer;
|
|
|
|
|
|
|
|
buffer = kzalloc(data_len, GFP_KERNEL);
|
|
|
|
if (!buffer)
|
|
|
|
return AE_NO_MEMORY;
|
|
|
|
|
|
|
|
msgs[0].addr = client->addr;
|
|
|
|
msgs[0].flags = client->flags;
|
|
|
|
msgs[0].len = 1;
|
|
|
|
msgs[0].buf = &cmd;
|
|
|
|
|
|
|
|
msgs[1].addr = client->addr;
|
|
|
|
msgs[1].flags = client->flags | I2C_M_RD;
|
|
|
|
msgs[1].len = data_len;
|
|
|
|
msgs[1].buf = buffer;
|
|
|
|
|
|
|
|
ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
|
|
|
|
if (ret < 0)
|
|
|
|
dev_err(&client->adapter->dev, "i2c read failed\n");
|
|
|
|
else
|
|
|
|
memcpy(data, buffer, data_len);
|
|
|
|
|
|
|
|
kfree(buffer);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int acpi_gsb_i2c_write_bytes(struct i2c_client *client,
|
|
|
|
u8 cmd, u8 *data, u8 data_len)
|
|
|
|
{
|
|
|
|
|
|
|
|
struct i2c_msg msgs[1];
|
|
|
|
u8 *buffer;
|
|
|
|
int ret = AE_OK;
|
|
|
|
|
|
|
|
buffer = kzalloc(data_len + 1, GFP_KERNEL);
|
|
|
|
if (!buffer)
|
|
|
|
return AE_NO_MEMORY;
|
|
|
|
|
|
|
|
buffer[0] = cmd;
|
|
|
|
memcpy(buffer + 1, data, data_len);
|
|
|
|
|
|
|
|
msgs[0].addr = client->addr;
|
|
|
|
msgs[0].flags = client->flags;
|
|
|
|
msgs[0].len = data_len + 1;
|
|
|
|
msgs[0].buf = buffer;
|
|
|
|
|
|
|
|
ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
|
|
|
|
if (ret < 0)
|
|
|
|
dev_err(&client->adapter->dev, "i2c write failed\n");
|
|
|
|
|
|
|
|
kfree(buffer);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static acpi_status
|
|
|
|
acpi_i2c_space_handler(u32 function, acpi_physical_address command,
|
|
|
|
u32 bits, u64 *value64,
|
|
|
|
void *handler_context, void *region_context)
|
|
|
|
{
|
|
|
|
struct gsb_buffer *gsb = (struct gsb_buffer *)value64;
|
|
|
|
struct acpi_i2c_handler_data *data = handler_context;
|
|
|
|
struct acpi_connection_info *info = &data->info;
|
|
|
|
struct acpi_resource_i2c_serialbus *sb;
|
|
|
|
struct i2c_adapter *adapter = data->adapter;
|
2015-05-20 07:36:52 -06:00
|
|
|
struct i2c_client *client;
|
2014-09-22 11:41:00 -06:00
|
|
|
struct acpi_resource *ares;
|
|
|
|
u32 accessor_type = function >> 16;
|
|
|
|
u8 action = function & ACPI_IO_MASK;
|
2014-11-18 07:12:43 -07:00
|
|
|
acpi_status ret;
|
2014-09-22 11:41:00 -06:00
|
|
|
int status;
|
|
|
|
|
|
|
|
ret = acpi_buffer_to_resource(info->connection, info->length, &ares);
|
|
|
|
if (ACPI_FAILURE(ret))
|
|
|
|
return ret;
|
|
|
|
|
2015-05-20 07:36:52 -06:00
|
|
|
client = kzalloc(sizeof(*client), GFP_KERNEL);
|
|
|
|
if (!client) {
|
|
|
|
ret = AE_NO_MEMORY;
|
|
|
|
goto err;
|
|
|
|
}
|
|
|
|
|
2014-09-22 11:41:00 -06:00
|
|
|
if (!value64 || ares->type != ACPI_RESOURCE_TYPE_SERIAL_BUS) {
|
|
|
|
ret = AE_BAD_PARAMETER;
|
|
|
|
goto err;
|
|
|
|
}
|
|
|
|
|
|
|
|
sb = &ares->data.i2c_serial_bus;
|
|
|
|
if (sb->type != ACPI_RESOURCE_SERIAL_TYPE_I2C) {
|
|
|
|
ret = AE_BAD_PARAMETER;
|
|
|
|
goto err;
|
|
|
|
}
|
|
|
|
|
2015-05-20 07:36:52 -06:00
|
|
|
client->adapter = adapter;
|
|
|
|
client->addr = sb->slave_address;
|
2014-09-22 11:41:00 -06:00
|
|
|
|
|
|
|
if (sb->access_mode == ACPI_I2C_10BIT_MODE)
|
2015-05-20 07:36:52 -06:00
|
|
|
client->flags |= I2C_CLIENT_TEN;
|
2014-09-22 11:41:00 -06:00
|
|
|
|
|
|
|
switch (accessor_type) {
|
|
|
|
case ACPI_GSB_ACCESS_ATTRIB_SEND_RCV:
|
|
|
|
if (action == ACPI_READ) {
|
2015-05-20 07:36:52 -06:00
|
|
|
status = i2c_smbus_read_byte(client);
|
2014-09-22 11:41:00 -06:00
|
|
|
if (status >= 0) {
|
|
|
|
gsb->bdata = status;
|
|
|
|
status = 0;
|
|
|
|
}
|
|
|
|
} else {
|
2015-05-20 07:36:52 -06:00
|
|
|
status = i2c_smbus_write_byte(client, gsb->bdata);
|
2014-09-22 11:41:00 -06:00
|
|
|
}
|
|
|
|
break;
|
|
|
|
|
|
|
|
case ACPI_GSB_ACCESS_ATTRIB_BYTE:
|
|
|
|
if (action == ACPI_READ) {
|
2015-05-20 07:36:52 -06:00
|
|
|
status = i2c_smbus_read_byte_data(client, command);
|
2014-09-22 11:41:00 -06:00
|
|
|
if (status >= 0) {
|
|
|
|
gsb->bdata = status;
|
|
|
|
status = 0;
|
|
|
|
}
|
|
|
|
} else {
|
2015-05-20 07:36:52 -06:00
|
|
|
status = i2c_smbus_write_byte_data(client, command,
|
2014-09-22 11:41:00 -06:00
|
|
|
gsb->bdata);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
|
|
|
|
case ACPI_GSB_ACCESS_ATTRIB_WORD:
|
|
|
|
if (action == ACPI_READ) {
|
2015-05-20 07:36:52 -06:00
|
|
|
status = i2c_smbus_read_word_data(client, command);
|
2014-09-22 11:41:00 -06:00
|
|
|
if (status >= 0) {
|
|
|
|
gsb->wdata = status;
|
|
|
|
status = 0;
|
|
|
|
}
|
|
|
|
} else {
|
2015-05-20 07:36:52 -06:00
|
|
|
status = i2c_smbus_write_word_data(client, command,
|
2014-09-22 11:41:00 -06:00
|
|
|
gsb->wdata);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
|
|
|
|
case ACPI_GSB_ACCESS_ATTRIB_BLOCK:
|
|
|
|
if (action == ACPI_READ) {
|
2015-05-20 07:36:52 -06:00
|
|
|
status = i2c_smbus_read_block_data(client, command,
|
2014-09-22 11:41:00 -06:00
|
|
|
gsb->data);
|
|
|
|
if (status >= 0) {
|
|
|
|
gsb->len = status;
|
|
|
|
status = 0;
|
|
|
|
}
|
|
|
|
} else {
|
2015-05-20 07:36:52 -06:00
|
|
|
status = i2c_smbus_write_block_data(client, command,
|
2014-09-22 11:41:00 -06:00
|
|
|
gsb->len, gsb->data);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
|
|
|
|
case ACPI_GSB_ACCESS_ATTRIB_MULTIBYTE:
|
|
|
|
if (action == ACPI_READ) {
|
2015-05-20 07:36:52 -06:00
|
|
|
status = acpi_gsb_i2c_read_bytes(client, command,
|
2014-09-22 11:41:00 -06:00
|
|
|
gsb->data, info->access_length);
|
|
|
|
if (status > 0)
|
|
|
|
status = 0;
|
|
|
|
} else {
|
2015-05-20 07:36:52 -06:00
|
|
|
status = acpi_gsb_i2c_write_bytes(client, command,
|
2014-09-22 11:41:00 -06:00
|
|
|
gsb->data, info->access_length);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
|
|
|
pr_info("protocol(0x%02x) is not supported.\n", accessor_type);
|
|
|
|
ret = AE_BAD_PARAMETER;
|
|
|
|
goto err;
|
|
|
|
}
|
|
|
|
|
|
|
|
gsb->status = status;
|
|
|
|
|
|
|
|
err:
|
2015-05-20 07:36:52 -06:00
|
|
|
kfree(client);
|
2014-09-22 11:41:00 -06:00
|
|
|
ACPI_FREE(ares);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static int acpi_i2c_install_space_handler(struct i2c_adapter *adapter)
|
|
|
|
{
|
2014-09-12 13:09:47 -06:00
|
|
|
acpi_handle handle;
|
2014-09-22 11:41:00 -06:00
|
|
|
struct acpi_i2c_handler_data *data;
|
|
|
|
acpi_status status;
|
|
|
|
|
2014-09-12 13:09:47 -06:00
|
|
|
if (!adapter->dev.parent)
|
|
|
|
return -ENODEV;
|
|
|
|
|
|
|
|
handle = ACPI_HANDLE(adapter->dev.parent);
|
|
|
|
|
2014-09-22 11:41:00 -06:00
|
|
|
if (!handle)
|
|
|
|
return -ENODEV;
|
|
|
|
|
|
|
|
data = kzalloc(sizeof(struct acpi_i2c_handler_data),
|
|
|
|
GFP_KERNEL);
|
|
|
|
if (!data)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
data->adapter = adapter;
|
|
|
|
status = acpi_bus_attach_private_data(handle, (void *)data);
|
|
|
|
if (ACPI_FAILURE(status)) {
|
|
|
|
kfree(data);
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
status = acpi_install_address_space_handler(handle,
|
|
|
|
ACPI_ADR_SPACE_GSBUS,
|
|
|
|
&acpi_i2c_space_handler,
|
|
|
|
NULL,
|
|
|
|
data);
|
|
|
|
if (ACPI_FAILURE(status)) {
|
|
|
|
dev_err(&adapter->dev, "Error installing i2c space handler\n");
|
|
|
|
acpi_bus_detach_private_data(handle);
|
|
|
|
kfree(data);
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
2014-11-23 06:22:54 -07:00
|
|
|
acpi_walk_dep_device_list(handle);
|
2014-09-22 11:41:00 -06:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void acpi_i2c_remove_space_handler(struct i2c_adapter *adapter)
|
|
|
|
{
|
2014-09-12 13:09:47 -06:00
|
|
|
acpi_handle handle;
|
2014-09-22 11:41:00 -06:00
|
|
|
struct acpi_i2c_handler_data *data;
|
|
|
|
acpi_status status;
|
|
|
|
|
2014-09-12 13:09:47 -06:00
|
|
|
if (!adapter->dev.parent)
|
|
|
|
return;
|
|
|
|
|
|
|
|
handle = ACPI_HANDLE(adapter->dev.parent);
|
|
|
|
|
2014-09-22 11:41:00 -06:00
|
|
|
if (!handle)
|
|
|
|
return;
|
|
|
|
|
|
|
|
acpi_remove_address_space_handler(handle,
|
|
|
|
ACPI_ADR_SPACE_GSBUS,
|
|
|
|
&acpi_i2c_space_handler);
|
|
|
|
|
|
|
|
status = acpi_bus_get_private_data(handle, (void **)&data);
|
|
|
|
if (ACPI_SUCCESS(status))
|
|
|
|
kfree(data);
|
|
|
|
|
|
|
|
acpi_bus_detach_private_data(handle);
|
|
|
|
}
|
|
|
|
#else /* CONFIG_ACPI_I2C_OPREGION */
|
|
|
|
static inline void acpi_i2c_remove_space_handler(struct i2c_adapter *adapter)
|
|
|
|
{ }
|
|
|
|
|
|
|
|
static inline int acpi_i2c_install_space_handler(struct i2c_adapter *adapter)
|
|
|
|
{ return 0; }
|
|
|
|
#endif /* CONFIG_ACPI_I2C_OPREGION */
|
|
|
|
|
2007-02-13 14:09:00 -07:00
|
|
|
/* ------------------------------------------------------------------------- */
|
|
|
|
|
2008-04-29 15:11:39 -06:00
|
|
|
static const struct i2c_device_id *i2c_match_id(const struct i2c_device_id *id,
|
|
|
|
const struct i2c_client *client)
|
|
|
|
{
|
|
|
|
while (id->name[0]) {
|
|
|
|
if (strcmp(client->name, id->name) == 0)
|
|
|
|
return id;
|
|
|
|
id++;
|
|
|
|
}
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
2005-04-16 16:20:36 -06:00
|
|
|
static int i2c_device_match(struct device *dev, struct device_driver *drv)
|
|
|
|
{
|
2009-09-18 14:45:45 -06:00
|
|
|
struct i2c_client *client = i2c_verify_client(dev);
|
|
|
|
struct i2c_driver *driver;
|
|
|
|
|
|
|
|
if (!client)
|
|
|
|
return 0;
|
2007-05-01 15:26:30 -06:00
|
|
|
|
2010-06-08 07:48:19 -06:00
|
|
|
/* Attempt an OF style match */
|
|
|
|
if (of_driver_match_device(dev, drv))
|
|
|
|
return 1;
|
|
|
|
|
2012-11-23 04:23:40 -07:00
|
|
|
/* Then ACPI style match */
|
|
|
|
if (acpi_driver_match_device(dev, drv))
|
|
|
|
return 1;
|
|
|
|
|
2009-09-18 14:45:45 -06:00
|
|
|
driver = to_i2c_driver(drv);
|
2008-04-29 15:11:39 -06:00
|
|
|
/* match on an id table if there is one */
|
|
|
|
if (driver->id_table)
|
|
|
|
return i2c_match_id(driver->id_table, client) != NULL;
|
|
|
|
|
2008-05-18 12:49:41 -06:00
|
|
|
return 0;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
2007-08-14 07:15:12 -06:00
|
|
|
static int i2c_device_uevent(struct device *dev, struct kobj_uevent_env *env)
|
2007-05-01 15:26:30 -06:00
|
|
|
{
|
2016-03-23 13:47:02 -06:00
|
|
|
struct i2c_client *client = to_i2c_client(dev);
|
ACPI: fix module autoloading for ACPI enumerated devices
ACPI enumerated devices has ACPI style _HID and _CID strings,
all of these strings can be used for both driver loading and matching.
Currently, in Platform, I2C and SPI bus, the ACPI style driver matching
is supported by invoking acpi_driver_match_device() in bus .match() callback.
But, the module autoloading is still broken.
For example, there is any ACPI device with _HID "INTABCD" that is
enumerated to platform bus, and we have a driver that can probe it.
The driver exports its module_alias as "acpi:INTABCD" use the following code
static const struct acpi_device_id xxx_acpi_match[] = {
{ "INTABCD", 0 },
{ }
};
MODULE_DEVICE_TABLE(acpi, xxx_acpi_match);
But, unfortunately, the device' modalias is shown as "platform:INTABCD:00",
please refer to modalias_show() and platform_uevent() in
drivers/base/platform.c.
This results in that the driver will not be loaded automatically when the
device node is created, because their modalias do not match.
This also applies to I2C and SPI bus.
With this patch, the device' modalias will be shown as "acpi:INTABCD" as well.
Signed-off-by: Zhang Rui <rui.zhang@intel.com>
Acked-by: Mark Brown <broonie@linaro.org>
Acked-by: Wolfram Sang <wsa@the-dreams.de>
Signed-off-by: Rafael J. Wysocki <rafael.j.wysocki@intel.com>
2014-01-14 01:46:37 -07:00
|
|
|
int rc;
|
|
|
|
|
|
|
|
rc = acpi_device_uevent_modalias(dev, env);
|
|
|
|
if (rc != -ENODEV)
|
|
|
|
return rc;
|
2007-05-01 15:26:30 -06:00
|
|
|
|
2016-03-23 13:47:02 -06:00
|
|
|
return add_uevent_var(env, "MODALIAS=%s%s", I2C_MODULE_PREFIX, client->name);
|
2007-05-01 15:26:30 -06:00
|
|
|
}
|
|
|
|
|
2012-02-28 05:56:31 -07:00
|
|
|
/* i2c bus recovery routines */
|
|
|
|
static int get_scl_gpio_value(struct i2c_adapter *adap)
|
|
|
|
{
|
|
|
|
return gpio_get_value(adap->bus_recovery_info->scl_gpio);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void set_scl_gpio_value(struct i2c_adapter *adap, int val)
|
|
|
|
{
|
|
|
|
gpio_set_value(adap->bus_recovery_info->scl_gpio, val);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int get_sda_gpio_value(struct i2c_adapter *adap)
|
|
|
|
{
|
|
|
|
return gpio_get_value(adap->bus_recovery_info->sda_gpio);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int i2c_get_gpios_for_recovery(struct i2c_adapter *adap)
|
|
|
|
{
|
|
|
|
struct i2c_bus_recovery_info *bri = adap->bus_recovery_info;
|
|
|
|
struct device *dev = &adap->dev;
|
|
|
|
int ret = 0;
|
|
|
|
|
|
|
|
ret = gpio_request_one(bri->scl_gpio, GPIOF_OPEN_DRAIN |
|
|
|
|
GPIOF_OUT_INIT_HIGH, "i2c-scl");
|
|
|
|
if (ret) {
|
|
|
|
dev_warn(dev, "Can't get SCL gpio: %d\n", bri->scl_gpio);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (bri->get_sda) {
|
|
|
|
if (gpio_request_one(bri->sda_gpio, GPIOF_IN, "i2c-sda")) {
|
|
|
|
/* work without SDA polling */
|
|
|
|
dev_warn(dev, "Can't get SDA gpio: %d. Not using SDA polling\n",
|
|
|
|
bri->sda_gpio);
|
|
|
|
bri->get_sda = NULL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void i2c_put_gpios_for_recovery(struct i2c_adapter *adap)
|
|
|
|
{
|
|
|
|
struct i2c_bus_recovery_info *bri = adap->bus_recovery_info;
|
|
|
|
|
|
|
|
if (bri->get_sda)
|
|
|
|
gpio_free(bri->sda_gpio);
|
|
|
|
|
|
|
|
gpio_free(bri->scl_gpio);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* We are generating clock pulses. ndelay() determines durating of clk pulses.
|
|
|
|
* We will generate clock with rate 100 KHz and so duration of both clock levels
|
|
|
|
* is: delay in ns = (10^6 / 100) / 2
|
|
|
|
*/
|
|
|
|
#define RECOVERY_NDELAY 5000
|
|
|
|
#define RECOVERY_CLK_CNT 9
|
|
|
|
|
|
|
|
static int i2c_generic_recovery(struct i2c_adapter *adap)
|
|
|
|
{
|
|
|
|
struct i2c_bus_recovery_info *bri = adap->bus_recovery_info;
|
|
|
|
int i = 0, val = 1, ret = 0;
|
|
|
|
|
|
|
|
if (bri->prepare_recovery)
|
2015-04-06 06:38:39 -06:00
|
|
|
bri->prepare_recovery(adap);
|
2012-02-28 05:56:31 -07:00
|
|
|
|
2015-07-08 08:35:06 -06:00
|
|
|
bri->set_scl(adap, val);
|
|
|
|
ndelay(RECOVERY_NDELAY);
|
|
|
|
|
2012-02-28 05:56:31 -07:00
|
|
|
/*
|
|
|
|
* By this time SCL is high, as we need to give 9 falling-rising edges
|
|
|
|
*/
|
|
|
|
while (i++ < RECOVERY_CLK_CNT * 2) {
|
|
|
|
if (val) {
|
|
|
|
/* Break if SDA is high */
|
|
|
|
if (bri->get_sda && bri->get_sda(adap))
|
|
|
|
break;
|
|
|
|
/* SCL shouldn't be low here */
|
|
|
|
if (!bri->get_scl(adap)) {
|
|
|
|
dev_err(&adap->dev,
|
|
|
|
"SCL is stuck low, exit recovery\n");
|
|
|
|
ret = -EBUSY;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
val = !val;
|
|
|
|
bri->set_scl(adap, val);
|
|
|
|
ndelay(RECOVERY_NDELAY);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (bri->unprepare_recovery)
|
2015-04-06 06:38:39 -06:00
|
|
|
bri->unprepare_recovery(adap);
|
2012-02-28 05:56:31 -07:00
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
int i2c_generic_scl_recovery(struct i2c_adapter *adap)
|
|
|
|
{
|
|
|
|
return i2c_generic_recovery(adap);
|
|
|
|
}
|
2015-04-15 12:18:39 -06:00
|
|
|
EXPORT_SYMBOL_GPL(i2c_generic_scl_recovery);
|
2012-02-28 05:56:31 -07:00
|
|
|
|
|
|
|
int i2c_generic_gpio_recovery(struct i2c_adapter *adap)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
ret = i2c_get_gpios_for_recovery(adap);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
ret = i2c_generic_recovery(adap);
|
|
|
|
i2c_put_gpios_for_recovery(adap);
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
2015-04-15 12:18:39 -06:00
|
|
|
EXPORT_SYMBOL_GPL(i2c_generic_gpio_recovery);
|
2012-02-28 05:56:31 -07:00
|
|
|
|
|
|
|
int i2c_recover_bus(struct i2c_adapter *adap)
|
|
|
|
{
|
|
|
|
if (!adap->bus_recovery_info)
|
|
|
|
return -EOPNOTSUPP;
|
|
|
|
|
|
|
|
dev_dbg(&adap->dev, "Trying i2c bus recovery\n");
|
|
|
|
return adap->bus_recovery_info->recover_bus(adap);
|
|
|
|
}
|
2015-04-15 12:18:39 -06:00
|
|
|
EXPORT_SYMBOL_GPL(i2c_recover_bus);
|
2012-02-28 05:56:31 -07:00
|
|
|
|
2007-02-13 14:09:00 -07:00
|
|
|
static int i2c_device_probe(struct device *dev)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2009-09-18 14:45:45 -06:00
|
|
|
struct i2c_client *client = i2c_verify_client(dev);
|
|
|
|
struct i2c_driver *driver;
|
2008-03-12 07:15:00 -06:00
|
|
|
int status;
|
2007-05-01 15:26:30 -06:00
|
|
|
|
2009-09-18 14:45:45 -06:00
|
|
|
if (!client)
|
|
|
|
return 0;
|
|
|
|
|
2015-05-06 04:29:08 -06:00
|
|
|
if (!client->irq) {
|
|
|
|
int irq = -ENOENT;
|
|
|
|
|
2015-08-18 00:52:51 -06:00
|
|
|
if (dev->of_node) {
|
|
|
|
irq = of_irq_get_byname(dev->of_node, "irq");
|
|
|
|
if (irq == -EINVAL || irq == -ENODATA)
|
|
|
|
irq = of_irq_get(dev->of_node, 0);
|
|
|
|
} else if (ACPI_COMPANION(dev)) {
|
2015-05-06 04:29:08 -06:00
|
|
|
irq = acpi_dev_gpio_irq_get(ACPI_COMPANION(dev), 0);
|
2015-08-18 00:52:51 -06:00
|
|
|
}
|
2014-11-17 04:43:00 -07:00
|
|
|
if (irq == -EPROBE_DEFER)
|
2014-10-30 07:59:38 -06:00
|
|
|
return irq;
|
2014-11-17 04:43:00 -07:00
|
|
|
if (irq < 0)
|
|
|
|
irq = 0;
|
2014-10-30 07:59:38 -06:00
|
|
|
|
|
|
|
client->irq = irq;
|
|
|
|
}
|
|
|
|
|
2009-09-18 14:45:45 -06:00
|
|
|
driver = to_i2c_driver(dev->driver);
|
2008-07-14 14:38:30 -06:00
|
|
|
if (!driver->probe || !driver->id_table)
|
2007-05-01 15:26:30 -06:00
|
|
|
return -ENODEV;
|
2013-09-29 02:51:06 -06:00
|
|
|
|
2015-08-18 00:52:51 -06:00
|
|
|
if (client->flags & I2C_CLIENT_WAKE) {
|
|
|
|
int wakeirq = -ENOENT;
|
|
|
|
|
|
|
|
if (dev->of_node) {
|
|
|
|
wakeirq = of_irq_get_byname(dev->of_node, "wakeup");
|
|
|
|
if (wakeirq == -EPROBE_DEFER)
|
|
|
|
return wakeirq;
|
|
|
|
}
|
|
|
|
|
|
|
|
device_init_wakeup(&client->dev, true);
|
|
|
|
|
|
|
|
if (wakeirq > 0 && wakeirq != client->irq)
|
|
|
|
status = dev_pm_set_dedicated_wake_irq(dev, wakeirq);
|
|
|
|
else if (client->irq > 0)
|
2015-11-12 06:42:26 -07:00
|
|
|
status = dev_pm_set_wake_irq(dev, client->irq);
|
2015-08-18 00:52:51 -06:00
|
|
|
else
|
|
|
|
status = 0;
|
|
|
|
|
|
|
|
if (status)
|
|
|
|
dev_warn(&client->dev, "failed to set up wakeup irq");
|
|
|
|
}
|
|
|
|
|
2007-05-01 15:26:30 -06:00
|
|
|
dev_dbg(dev, "probe\n");
|
2008-04-29 15:11:39 -06:00
|
|
|
|
2014-06-18 09:29:32 -06:00
|
|
|
status = of_clk_set_defaults(dev->of_node, false);
|
|
|
|
if (status < 0)
|
2015-08-18 00:52:51 -06:00
|
|
|
goto err_clear_wakeup_irq;
|
2014-06-18 09:29:32 -06:00
|
|
|
|
2014-09-19 12:27:39 -06:00
|
|
|
status = dev_pm_domain_attach(&client->dev, true);
|
2015-10-12 14:54:43 -06:00
|
|
|
if (status == -EPROBE_DEFER)
|
|
|
|
goto err_clear_wakeup_irq;
|
|
|
|
|
|
|
|
status = driver->probe(client, i2c_match_id(driver->id_table, client));
|
|
|
|
if (status)
|
|
|
|
goto err_detach_pm_domain;
|
2014-01-21 09:48:34 -07:00
|
|
|
|
2015-08-18 00:52:51 -06:00
|
|
|
return 0;
|
|
|
|
|
|
|
|
err_detach_pm_domain:
|
|
|
|
dev_pm_domain_detach(&client->dev, true);
|
|
|
|
err_clear_wakeup_irq:
|
|
|
|
dev_pm_clear_wake_irq(&client->dev);
|
|
|
|
device_init_wakeup(&client->dev, false);
|
2008-03-12 07:15:00 -06:00
|
|
|
return status;
|
2007-02-13 14:09:00 -07:00
|
|
|
}
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2007-02-13 14:09:00 -07:00
|
|
|
static int i2c_device_remove(struct device *dev)
|
|
|
|
{
|
2009-09-18 14:45:45 -06:00
|
|
|
struct i2c_client *client = i2c_verify_client(dev);
|
2007-05-01 15:26:30 -06:00
|
|
|
struct i2c_driver *driver;
|
2014-01-21 09:48:34 -07:00
|
|
|
int status = 0;
|
2007-05-01 15:26:30 -06:00
|
|
|
|
2009-09-18 14:45:45 -06:00
|
|
|
if (!client || !dev->driver)
|
2007-05-01 15:26:30 -06:00
|
|
|
return 0;
|
|
|
|
|
|
|
|
driver = to_i2c_driver(dev->driver);
|
|
|
|
if (driver->remove) {
|
|
|
|
dev_dbg(dev, "remove\n");
|
|
|
|
status = driver->remove(client);
|
|
|
|
}
|
2014-01-21 09:48:34 -07:00
|
|
|
|
2014-09-19 12:27:39 -06:00
|
|
|
dev_pm_domain_detach(&client->dev, true);
|
2015-08-18 00:52:51 -06:00
|
|
|
|
|
|
|
dev_pm_clear_wake_irq(&client->dev);
|
|
|
|
device_init_wakeup(&client->dev, false);
|
|
|
|
|
2007-05-01 15:26:30 -06:00
|
|
|
return status;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
2007-02-13 14:09:00 -07:00
|
|
|
static void i2c_device_shutdown(struct device *dev)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2009-09-18 14:45:45 -06:00
|
|
|
struct i2c_client *client = i2c_verify_client(dev);
|
2007-02-13 14:09:00 -07:00
|
|
|
struct i2c_driver *driver;
|
|
|
|
|
2009-09-18 14:45:45 -06:00
|
|
|
if (!client || !dev->driver)
|
2007-02-13 14:09:00 -07:00
|
|
|
return;
|
|
|
|
driver = to_i2c_driver(dev->driver);
|
|
|
|
if (driver->shutdown)
|
2009-09-18 14:45:45 -06:00
|
|
|
driver->shutdown(client);
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
i2c: Add i2c_board_info and i2c_new_device()
This provides partial support for new-style I2C driver binding. It builds
on "struct i2c_board_info" declarations that identify I2C devices on a given
board. This is needed on systems with I2C devices that can't be fully probed
and/or autoconfigured, such as many embedded Linux configurations where the
way a given I2C device is wired may affect how it must be used.
There are two models for declaring such devices:
* LATE -- using a public function i2c_new_device(). This lets modules
declare I2C devices found *AFTER* a given I2C adapter becomes available.
For example, a PCI card could create adapters giving access to utility
chips on that card, and this would be used to associate those chips with
those adapters.
* EARLY -- from arch_initcall() level code, using a non-exported function
i2c_register_board_info(). This copies the declarations *BEFORE* such
an i2c_adapter becomes available, arranging that i2c_new_device() will
be called later when i2c-core registers the relevant i2c_adapter.
For example, arch/.../.../board-*.c files would declare the I2C devices
along with their platform data, and I2C devices would behave much like
PNPACPI devices. (That is, both enumerate from board-specific tables.)
To match the exported i2c_new_device(), the previously-private function
i2c_unregister_device() is now exported.
Pending later patches using these new APIs, this is effectively a NOP.
Signed-off-by: David Brownell <dbrownell@users.sourceforge.net>
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2007-05-01 15:26:31 -06:00
|
|
|
static void i2c_client_dev_release(struct device *dev)
|
|
|
|
{
|
|
|
|
kfree(to_i2c_client(dev));
|
|
|
|
}
|
|
|
|
|
2009-03-28 14:34:46 -06:00
|
|
|
static ssize_t
|
2009-09-18 14:45:46 -06:00
|
|
|
show_name(struct device *dev, struct device_attribute *attr, char *buf)
|
2007-05-01 15:26:30 -06:00
|
|
|
{
|
2009-09-18 14:45:46 -06:00
|
|
|
return sprintf(buf, "%s\n", dev->type == &i2c_client_type ?
|
|
|
|
to_i2c_client(dev)->name : to_i2c_adapter(dev)->name);
|
2007-05-01 15:26:30 -06:00
|
|
|
}
|
2015-01-19 12:12:24 -07:00
|
|
|
static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
|
2007-05-01 15:26:30 -06:00
|
|
|
|
2009-03-28 14:34:46 -06:00
|
|
|
static ssize_t
|
|
|
|
show_modalias(struct device *dev, struct device_attribute *attr, char *buf)
|
2007-05-01 15:26:30 -06:00
|
|
|
{
|
|
|
|
struct i2c_client *client = to_i2c_client(dev);
|
ACPI: fix module autoloading for ACPI enumerated devices
ACPI enumerated devices has ACPI style _HID and _CID strings,
all of these strings can be used for both driver loading and matching.
Currently, in Platform, I2C and SPI bus, the ACPI style driver matching
is supported by invoking acpi_driver_match_device() in bus .match() callback.
But, the module autoloading is still broken.
For example, there is any ACPI device with _HID "INTABCD" that is
enumerated to platform bus, and we have a driver that can probe it.
The driver exports its module_alias as "acpi:INTABCD" use the following code
static const struct acpi_device_id xxx_acpi_match[] = {
{ "INTABCD", 0 },
{ }
};
MODULE_DEVICE_TABLE(acpi, xxx_acpi_match);
But, unfortunately, the device' modalias is shown as "platform:INTABCD:00",
please refer to modalias_show() and platform_uevent() in
drivers/base/platform.c.
This results in that the driver will not be loaded automatically when the
device node is created, because their modalias do not match.
This also applies to I2C and SPI bus.
With this patch, the device' modalias will be shown as "acpi:INTABCD" as well.
Signed-off-by: Zhang Rui <rui.zhang@intel.com>
Acked-by: Mark Brown <broonie@linaro.org>
Acked-by: Wolfram Sang <wsa@the-dreams.de>
Signed-off-by: Rafael J. Wysocki <rafael.j.wysocki@intel.com>
2014-01-14 01:46:37 -07:00
|
|
|
int len;
|
|
|
|
|
|
|
|
len = acpi_device_modalias(dev, buf, PAGE_SIZE -1);
|
|
|
|
if (len != -ENODEV)
|
|
|
|
return len;
|
|
|
|
|
2008-05-18 12:49:41 -06:00
|
|
|
return sprintf(buf, "%s%s\n", I2C_MODULE_PREFIX, client->name);
|
2007-05-01 15:26:30 -06:00
|
|
|
}
|
2009-09-18 14:45:45 -06:00
|
|
|
static DEVICE_ATTR(modalias, S_IRUGO, show_modalias, NULL);
|
|
|
|
|
|
|
|
static struct attribute *i2c_dev_attrs[] = {
|
|
|
|
&dev_attr_name.attr,
|
2007-05-01 15:26:30 -06:00
|
|
|
/* modalias helps coldplug: modprobe $(cat .../modalias) */
|
2009-09-18 14:45:45 -06:00
|
|
|
&dev_attr_modalias.attr,
|
|
|
|
NULL
|
|
|
|
};
|
2015-01-19 12:12:24 -07:00
|
|
|
ATTRIBUTE_GROUPS(i2c_dev);
|
2009-12-14 13:17:30 -07:00
|
|
|
|
2008-07-14 14:38:35 -06:00
|
|
|
struct bus_type i2c_bus_type = {
|
2007-02-13 14:09:00 -07:00
|
|
|
.name = "i2c",
|
|
|
|
.match = i2c_device_match,
|
|
|
|
.probe = i2c_device_probe,
|
|
|
|
.remove = i2c_device_remove,
|
|
|
|
.shutdown = i2c_device_shutdown,
|
2006-01-05 07:37:50 -07:00
|
|
|
};
|
2008-07-14 14:38:35 -06:00
|
|
|
EXPORT_SYMBOL_GPL(i2c_bus_type);
|
2006-01-05 07:37:50 -07:00
|
|
|
|
2009-09-18 14:45:45 -06:00
|
|
|
static struct device_type i2c_client_type = {
|
2015-01-19 12:12:24 -07:00
|
|
|
.groups = i2c_dev_groups,
|
2009-09-18 14:45:45 -06:00
|
|
|
.uevent = i2c_device_uevent,
|
|
|
|
.release = i2c_client_dev_release,
|
|
|
|
};
|
|
|
|
|
2008-01-27 10:14:51 -07:00
|
|
|
|
|
|
|
/**
|
|
|
|
* i2c_verify_client - return parameter as i2c_client, or NULL
|
|
|
|
* @dev: device, probably from some driver model iterator
|
|
|
|
*
|
|
|
|
* When traversing the driver model tree, perhaps using driver model
|
|
|
|
* iterators like @device_for_each_child(), you can't assume very much
|
|
|
|
* about the nodes you find. Use this function to avoid oopses caused
|
|
|
|
* by wrongly treating some non-I2C device as an i2c_client.
|
|
|
|
*/
|
|
|
|
struct i2c_client *i2c_verify_client(struct device *dev)
|
|
|
|
{
|
2009-09-18 14:45:45 -06:00
|
|
|
return (dev->type == &i2c_client_type)
|
2008-01-27 10:14:51 -07:00
|
|
|
? to_i2c_client(dev)
|
|
|
|
: NULL;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(i2c_verify_client);
|
|
|
|
|
|
|
|
|
2015-05-18 13:09:12 -06:00
|
|
|
/* Return a unique address which takes the flags of the client into account */
|
|
|
|
static unsigned short i2c_encode_flags_to_addr(struct i2c_client *client)
|
|
|
|
{
|
|
|
|
unsigned short addr = client->addr;
|
|
|
|
|
|
|
|
/* For some client flags, add an arbitrary offset to avoid collisions */
|
|
|
|
if (client->flags & I2C_CLIENT_TEN)
|
|
|
|
addr |= I2C_ADDR_OFFSET_TEN_BIT;
|
|
|
|
|
|
|
|
if (client->flags & I2C_CLIENT_SLAVE)
|
|
|
|
addr |= I2C_ADDR_OFFSET_SLAVE;
|
|
|
|
|
|
|
|
return addr;
|
|
|
|
}
|
|
|
|
|
2010-06-03 03:33:52 -06:00
|
|
|
/* This is a permissive address validity check, I2C address map constraints
|
2011-03-30 19:57:33 -06:00
|
|
|
* are purposely not enforced, except for the general call address. */
|
2015-07-17 04:50:06 -06:00
|
|
|
static int i2c_check_addr_validity(unsigned addr, unsigned short flags)
|
2010-06-03 03:33:52 -06:00
|
|
|
{
|
2015-07-17 04:50:06 -06:00
|
|
|
if (flags & I2C_CLIENT_TEN) {
|
2010-06-03 03:33:52 -06:00
|
|
|
/* 10-bit address, all values are valid */
|
2015-07-17 04:50:06 -06:00
|
|
|
if (addr > 0x3ff)
|
2010-06-03 03:33:52 -06:00
|
|
|
return -EINVAL;
|
|
|
|
} else {
|
|
|
|
/* 7-bit address, reject the general call address */
|
2015-07-17 04:50:06 -06:00
|
|
|
if (addr == 0x00 || addr > 0x7f)
|
2010-06-03 03:33:52 -06:00
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2010-06-03 03:33:53 -06:00
|
|
|
/* And this is a strict address validity check, used when probing. If a
|
|
|
|
* device uses a reserved address, then it shouldn't be probed. 7-bit
|
|
|
|
* addressing is assumed, 10-bit address devices are rare and should be
|
|
|
|
* explicitly enumerated. */
|
2015-07-17 04:43:22 -06:00
|
|
|
static int i2c_check_7bit_addr_validity_strict(unsigned short addr)
|
2010-06-03 03:33:53 -06:00
|
|
|
{
|
|
|
|
/*
|
|
|
|
* Reserved addresses per I2C specification:
|
|
|
|
* 0x00 General call address / START byte
|
|
|
|
* 0x01 CBUS address
|
|
|
|
* 0x02 Reserved for different bus format
|
|
|
|
* 0x03 Reserved for future purposes
|
|
|
|
* 0x04-0x07 Hs-mode master code
|
|
|
|
* 0x78-0x7b 10-bit slave addressing
|
|
|
|
* 0x7c-0x7f Reserved for future purposes
|
|
|
|
*/
|
|
|
|
if (addr < 0x08 || addr > 0x77)
|
|
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2010-06-03 03:33:55 -06:00
|
|
|
static int __i2c_check_addr_busy(struct device *dev, void *addrp)
|
|
|
|
{
|
|
|
|
struct i2c_client *client = i2c_verify_client(dev);
|
|
|
|
int addr = *(int *)addrp;
|
|
|
|
|
2015-07-17 06:48:56 -06:00
|
|
|
if (client && i2c_encode_flags_to_addr(client) == addr)
|
2010-06-03 03:33:55 -06:00
|
|
|
return -EBUSY;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2010-08-11 10:21:02 -06:00
|
|
|
/* walk up mux tree */
|
|
|
|
static int i2c_check_mux_parents(struct i2c_adapter *adapter, int addr)
|
|
|
|
{
|
2010-10-24 10:16:57 -06:00
|
|
|
struct i2c_adapter *parent = i2c_parent_is_i2c_adapter(adapter);
|
2010-08-11 10:21:02 -06:00
|
|
|
int result;
|
|
|
|
|
|
|
|
result = device_for_each_child(&adapter->dev, &addr,
|
|
|
|
__i2c_check_addr_busy);
|
|
|
|
|
2010-10-24 10:16:57 -06:00
|
|
|
if (!result && parent)
|
|
|
|
result = i2c_check_mux_parents(parent, addr);
|
2010-08-11 10:21:02 -06:00
|
|
|
|
|
|
|
return result;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* recurse down mux tree */
|
|
|
|
static int i2c_check_mux_children(struct device *dev, void *addrp)
|
|
|
|
{
|
|
|
|
int result;
|
|
|
|
|
|
|
|
if (dev->type == &i2c_adapter_type)
|
|
|
|
result = device_for_each_child(dev, addrp,
|
|
|
|
i2c_check_mux_children);
|
|
|
|
else
|
|
|
|
result = __i2c_check_addr_busy(dev, addrp);
|
|
|
|
|
|
|
|
return result;
|
|
|
|
}
|
|
|
|
|
2010-06-03 03:33:55 -06:00
|
|
|
static int i2c_check_addr_busy(struct i2c_adapter *adapter, int addr)
|
|
|
|
{
|
2010-10-24 10:16:57 -06:00
|
|
|
struct i2c_adapter *parent = i2c_parent_is_i2c_adapter(adapter);
|
2010-08-11 10:21:02 -06:00
|
|
|
int result = 0;
|
|
|
|
|
2010-10-24 10:16:57 -06:00
|
|
|
if (parent)
|
|
|
|
result = i2c_check_mux_parents(parent, addr);
|
2010-08-11 10:21:02 -06:00
|
|
|
|
|
|
|
if (!result)
|
|
|
|
result = device_for_each_child(&adapter->dev, &addr,
|
|
|
|
i2c_check_mux_children);
|
|
|
|
|
|
|
|
return result;
|
2010-06-03 03:33:55 -06:00
|
|
|
}
|
|
|
|
|
2010-08-11 10:20:58 -06:00
|
|
|
/**
|
|
|
|
* i2c_lock_adapter - Get exclusive access to an I2C bus segment
|
|
|
|
* @adapter: Target I2C bus segment
|
|
|
|
*/
|
|
|
|
void i2c_lock_adapter(struct i2c_adapter *adapter)
|
|
|
|
{
|
2010-10-24 10:16:57 -06:00
|
|
|
struct i2c_adapter *parent = i2c_parent_is_i2c_adapter(adapter);
|
|
|
|
|
|
|
|
if (parent)
|
|
|
|
i2c_lock_adapter(parent);
|
2010-08-11 10:21:02 -06:00
|
|
|
else
|
|
|
|
rt_mutex_lock(&adapter->bus_lock);
|
2010-08-11 10:20:58 -06:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(i2c_lock_adapter);
|
|
|
|
|
|
|
|
/**
|
|
|
|
* i2c_trylock_adapter - Try to get exclusive access to an I2C bus segment
|
|
|
|
* @adapter: Target I2C bus segment
|
|
|
|
*/
|
|
|
|
static int i2c_trylock_adapter(struct i2c_adapter *adapter)
|
|
|
|
{
|
2010-10-24 10:16:57 -06:00
|
|
|
struct i2c_adapter *parent = i2c_parent_is_i2c_adapter(adapter);
|
|
|
|
|
|
|
|
if (parent)
|
|
|
|
return i2c_trylock_adapter(parent);
|
2010-08-11 10:21:02 -06:00
|
|
|
else
|
|
|
|
return rt_mutex_trylock(&adapter->bus_lock);
|
2010-08-11 10:20:58 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* i2c_unlock_adapter - Release exclusive access to an I2C bus segment
|
|
|
|
* @adapter: Target I2C bus segment
|
|
|
|
*/
|
|
|
|
void i2c_unlock_adapter(struct i2c_adapter *adapter)
|
|
|
|
{
|
2010-10-24 10:16:57 -06:00
|
|
|
struct i2c_adapter *parent = i2c_parent_is_i2c_adapter(adapter);
|
|
|
|
|
|
|
|
if (parent)
|
|
|
|
i2c_unlock_adapter(parent);
|
2010-08-11 10:21:02 -06:00
|
|
|
else
|
|
|
|
rt_mutex_unlock(&adapter->bus_lock);
|
2010-08-11 10:20:58 -06:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(i2c_unlock_adapter);
|
|
|
|
|
2013-11-14 05:03:52 -07:00
|
|
|
static void i2c_dev_set_name(struct i2c_adapter *adap,
|
|
|
|
struct i2c_client *client)
|
|
|
|
{
|
|
|
|
struct acpi_device *adev = ACPI_COMPANION(&client->dev);
|
|
|
|
|
|
|
|
if (adev) {
|
|
|
|
dev_set_name(&client->dev, "i2c-%s", acpi_dev_name(adev));
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
dev_set_name(&client->dev, "%d-%04x", i2c_adapter_id(adap),
|
2015-05-18 13:09:12 -06:00
|
|
|
i2c_encode_flags_to_addr(client));
|
2013-11-14 05:03:52 -07:00
|
|
|
}
|
|
|
|
|
i2c: Add i2c_board_info and i2c_new_device()
This provides partial support for new-style I2C driver binding. It builds
on "struct i2c_board_info" declarations that identify I2C devices on a given
board. This is needed on systems with I2C devices that can't be fully probed
and/or autoconfigured, such as many embedded Linux configurations where the
way a given I2C device is wired may affect how it must be used.
There are two models for declaring such devices:
* LATE -- using a public function i2c_new_device(). This lets modules
declare I2C devices found *AFTER* a given I2C adapter becomes available.
For example, a PCI card could create adapters giving access to utility
chips on that card, and this would be used to associate those chips with
those adapters.
* EARLY -- from arch_initcall() level code, using a non-exported function
i2c_register_board_info(). This copies the declarations *BEFORE* such
an i2c_adapter becomes available, arranging that i2c_new_device() will
be called later when i2c-core registers the relevant i2c_adapter.
For example, arch/.../.../board-*.c files would declare the I2C devices
along with their platform data, and I2C devices would behave much like
PNPACPI devices. (That is, both enumerate from board-specific tables.)
To match the exported i2c_new_device(), the previously-private function
i2c_unregister_device() is now exported.
Pending later patches using these new APIs, this is effectively a NOP.
Signed-off-by: David Brownell <dbrownell@users.sourceforge.net>
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2007-05-01 15:26:31 -06:00
|
|
|
/**
|
2009-06-19 08:58:18 -06:00
|
|
|
* i2c_new_device - instantiate an i2c device
|
i2c: Add i2c_board_info and i2c_new_device()
This provides partial support for new-style I2C driver binding. It builds
on "struct i2c_board_info" declarations that identify I2C devices on a given
board. This is needed on systems with I2C devices that can't be fully probed
and/or autoconfigured, such as many embedded Linux configurations where the
way a given I2C device is wired may affect how it must be used.
There are two models for declaring such devices:
* LATE -- using a public function i2c_new_device(). This lets modules
declare I2C devices found *AFTER* a given I2C adapter becomes available.
For example, a PCI card could create adapters giving access to utility
chips on that card, and this would be used to associate those chips with
those adapters.
* EARLY -- from arch_initcall() level code, using a non-exported function
i2c_register_board_info(). This copies the declarations *BEFORE* such
an i2c_adapter becomes available, arranging that i2c_new_device() will
be called later when i2c-core registers the relevant i2c_adapter.
For example, arch/.../.../board-*.c files would declare the I2C devices
along with their platform data, and I2C devices would behave much like
PNPACPI devices. (That is, both enumerate from board-specific tables.)
To match the exported i2c_new_device(), the previously-private function
i2c_unregister_device() is now exported.
Pending later patches using these new APIs, this is effectively a NOP.
Signed-off-by: David Brownell <dbrownell@users.sourceforge.net>
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2007-05-01 15:26:31 -06:00
|
|
|
* @adap: the adapter managing the device
|
|
|
|
* @info: describes one I2C device; bus_num is ignored
|
2007-07-12 06:12:28 -06:00
|
|
|
* Context: can sleep
|
i2c: Add i2c_board_info and i2c_new_device()
This provides partial support for new-style I2C driver binding. It builds
on "struct i2c_board_info" declarations that identify I2C devices on a given
board. This is needed on systems with I2C devices that can't be fully probed
and/or autoconfigured, such as many embedded Linux configurations where the
way a given I2C device is wired may affect how it must be used.
There are two models for declaring such devices:
* LATE -- using a public function i2c_new_device(). This lets modules
declare I2C devices found *AFTER* a given I2C adapter becomes available.
For example, a PCI card could create adapters giving access to utility
chips on that card, and this would be used to associate those chips with
those adapters.
* EARLY -- from arch_initcall() level code, using a non-exported function
i2c_register_board_info(). This copies the declarations *BEFORE* such
an i2c_adapter becomes available, arranging that i2c_new_device() will
be called later when i2c-core registers the relevant i2c_adapter.
For example, arch/.../.../board-*.c files would declare the I2C devices
along with their platform data, and I2C devices would behave much like
PNPACPI devices. (That is, both enumerate from board-specific tables.)
To match the exported i2c_new_device(), the previously-private function
i2c_unregister_device() is now exported.
Pending later patches using these new APIs, this is effectively a NOP.
Signed-off-by: David Brownell <dbrownell@users.sourceforge.net>
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2007-05-01 15:26:31 -06:00
|
|
|
*
|
2009-06-19 08:58:18 -06:00
|
|
|
* Create an i2c device. Binding is handled through driver model
|
|
|
|
* probe()/remove() methods. A driver may be bound to this device when we
|
|
|
|
* return from this function, or any later moment (e.g. maybe hotplugging will
|
|
|
|
* load the driver module). This call is not appropriate for use by mainboard
|
|
|
|
* initialization logic, which usually runs during an arch_initcall() long
|
|
|
|
* before any i2c_adapter could exist.
|
i2c: Add i2c_board_info and i2c_new_device()
This provides partial support for new-style I2C driver binding. It builds
on "struct i2c_board_info" declarations that identify I2C devices on a given
board. This is needed on systems with I2C devices that can't be fully probed
and/or autoconfigured, such as many embedded Linux configurations where the
way a given I2C device is wired may affect how it must be used.
There are two models for declaring such devices:
* LATE -- using a public function i2c_new_device(). This lets modules
declare I2C devices found *AFTER* a given I2C adapter becomes available.
For example, a PCI card could create adapters giving access to utility
chips on that card, and this would be used to associate those chips with
those adapters.
* EARLY -- from arch_initcall() level code, using a non-exported function
i2c_register_board_info(). This copies the declarations *BEFORE* such
an i2c_adapter becomes available, arranging that i2c_new_device() will
be called later when i2c-core registers the relevant i2c_adapter.
For example, arch/.../.../board-*.c files would declare the I2C devices
along with their platform data, and I2C devices would behave much like
PNPACPI devices. (That is, both enumerate from board-specific tables.)
To match the exported i2c_new_device(), the previously-private function
i2c_unregister_device() is now exported.
Pending later patches using these new APIs, this is effectively a NOP.
Signed-off-by: David Brownell <dbrownell@users.sourceforge.net>
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2007-05-01 15:26:31 -06:00
|
|
|
*
|
|
|
|
* This returns the new i2c client, which may be saved for later use with
|
|
|
|
* i2c_unregister_device(); or NULL to indicate an error.
|
|
|
|
*/
|
|
|
|
struct i2c_client *
|
|
|
|
i2c_new_device(struct i2c_adapter *adap, struct i2c_board_info const *info)
|
|
|
|
{
|
|
|
|
struct i2c_client *client;
|
|
|
|
int status;
|
|
|
|
|
|
|
|
client = kzalloc(sizeof *client, GFP_KERNEL);
|
|
|
|
if (!client)
|
|
|
|
return NULL;
|
|
|
|
|
|
|
|
client->adapter = adap;
|
|
|
|
|
|
|
|
client->dev.platform_data = info->platform_data;
|
2007-10-13 15:56:29 -06:00
|
|
|
|
2008-10-22 12:21:33 -06:00
|
|
|
if (info->archdata)
|
|
|
|
client->dev.archdata = *info->archdata;
|
|
|
|
|
2008-08-28 00:33:22 -06:00
|
|
|
client->flags = info->flags;
|
i2c: Add i2c_board_info and i2c_new_device()
This provides partial support for new-style I2C driver binding. It builds
on "struct i2c_board_info" declarations that identify I2C devices on a given
board. This is needed on systems with I2C devices that can't be fully probed
and/or autoconfigured, such as many embedded Linux configurations where the
way a given I2C device is wired may affect how it must be used.
There are two models for declaring such devices:
* LATE -- using a public function i2c_new_device(). This lets modules
declare I2C devices found *AFTER* a given I2C adapter becomes available.
For example, a PCI card could create adapters giving access to utility
chips on that card, and this would be used to associate those chips with
those adapters.
* EARLY -- from arch_initcall() level code, using a non-exported function
i2c_register_board_info(). This copies the declarations *BEFORE* such
an i2c_adapter becomes available, arranging that i2c_new_device() will
be called later when i2c-core registers the relevant i2c_adapter.
For example, arch/.../.../board-*.c files would declare the I2C devices
along with their platform data, and I2C devices would behave much like
PNPACPI devices. (That is, both enumerate from board-specific tables.)
To match the exported i2c_new_device(), the previously-private function
i2c_unregister_device() is now exported.
Pending later patches using these new APIs, this is effectively a NOP.
Signed-off-by: David Brownell <dbrownell@users.sourceforge.net>
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2007-05-01 15:26:31 -06:00
|
|
|
client->addr = info->addr;
|
|
|
|
client->irq = info->irq;
|
|
|
|
|
|
|
|
strlcpy(client->name, info->type, sizeof(client->name));
|
|
|
|
|
2015-07-17 04:50:06 -06:00
|
|
|
status = i2c_check_addr_validity(client->addr, client->flags);
|
2010-06-03 03:33:52 -06:00
|
|
|
if (status) {
|
|
|
|
dev_err(&adap->dev, "Invalid %d-bit I2C address 0x%02hx\n",
|
|
|
|
client->flags & I2C_CLIENT_TEN ? 10 : 7, client->addr);
|
|
|
|
goto out_err_silent;
|
|
|
|
}
|
|
|
|
|
2009-06-19 08:58:18 -06:00
|
|
|
/* Check for address business */
|
2015-07-17 06:48:56 -06:00
|
|
|
status = i2c_check_addr_busy(adap, i2c_encode_flags_to_addr(client));
|
2009-06-19 08:58:18 -06:00
|
|
|
if (status)
|
|
|
|
goto out_err;
|
|
|
|
|
|
|
|
client->dev.parent = &client->adapter->dev;
|
|
|
|
client->dev.bus = &i2c_bus_type;
|
2009-09-18 14:45:45 -06:00
|
|
|
client->dev.type = &i2c_client_type;
|
2010-04-13 17:12:28 -06:00
|
|
|
client->dev.of_node = info->of_node;
|
2015-03-16 16:49:03 -06:00
|
|
|
client->dev.fwnode = info->fwnode;
|
2009-06-19 08:58:18 -06:00
|
|
|
|
2013-11-14 05:03:52 -07:00
|
|
|
i2c_dev_set_name(adap, client);
|
2009-06-19 08:58:18 -06:00
|
|
|
status = device_register(&client->dev);
|
|
|
|
if (status)
|
|
|
|
goto out_err;
|
|
|
|
|
|
|
|
dev_dbg(&adap->dev, "client [%s] registered with bus id %s\n",
|
|
|
|
client->name, dev_name(&client->dev));
|
|
|
|
|
i2c: Add i2c_board_info and i2c_new_device()
This provides partial support for new-style I2C driver binding. It builds
on "struct i2c_board_info" declarations that identify I2C devices on a given
board. This is needed on systems with I2C devices that can't be fully probed
and/or autoconfigured, such as many embedded Linux configurations where the
way a given I2C device is wired may affect how it must be used.
There are two models for declaring such devices:
* LATE -- using a public function i2c_new_device(). This lets modules
declare I2C devices found *AFTER* a given I2C adapter becomes available.
For example, a PCI card could create adapters giving access to utility
chips on that card, and this would be used to associate those chips with
those adapters.
* EARLY -- from arch_initcall() level code, using a non-exported function
i2c_register_board_info(). This copies the declarations *BEFORE* such
an i2c_adapter becomes available, arranging that i2c_new_device() will
be called later when i2c-core registers the relevant i2c_adapter.
For example, arch/.../.../board-*.c files would declare the I2C devices
along with their platform data, and I2C devices would behave much like
PNPACPI devices. (That is, both enumerate from board-specific tables.)
To match the exported i2c_new_device(), the previously-private function
i2c_unregister_device() is now exported.
Pending later patches using these new APIs, this is effectively a NOP.
Signed-off-by: David Brownell <dbrownell@users.sourceforge.net>
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2007-05-01 15:26:31 -06:00
|
|
|
return client;
|
2009-06-19 08:58:18 -06:00
|
|
|
|
|
|
|
out_err:
|
|
|
|
dev_err(&adap->dev, "Failed to register i2c client %s at 0x%02x "
|
|
|
|
"(%d)\n", client->name, client->addr, status);
|
2010-06-03 03:33:52 -06:00
|
|
|
out_err_silent:
|
2009-06-19 08:58:18 -06:00
|
|
|
kfree(client);
|
|
|
|
return NULL;
|
i2c: Add i2c_board_info and i2c_new_device()
This provides partial support for new-style I2C driver binding. It builds
on "struct i2c_board_info" declarations that identify I2C devices on a given
board. This is needed on systems with I2C devices that can't be fully probed
and/or autoconfigured, such as many embedded Linux configurations where the
way a given I2C device is wired may affect how it must be used.
There are two models for declaring such devices:
* LATE -- using a public function i2c_new_device(). This lets modules
declare I2C devices found *AFTER* a given I2C adapter becomes available.
For example, a PCI card could create adapters giving access to utility
chips on that card, and this would be used to associate those chips with
those adapters.
* EARLY -- from arch_initcall() level code, using a non-exported function
i2c_register_board_info(). This copies the declarations *BEFORE* such
an i2c_adapter becomes available, arranging that i2c_new_device() will
be called later when i2c-core registers the relevant i2c_adapter.
For example, arch/.../.../board-*.c files would declare the I2C devices
along with their platform data, and I2C devices would behave much like
PNPACPI devices. (That is, both enumerate from board-specific tables.)
To match the exported i2c_new_device(), the previously-private function
i2c_unregister_device() is now exported.
Pending later patches using these new APIs, this is effectively a NOP.
Signed-off-by: David Brownell <dbrownell@users.sourceforge.net>
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2007-05-01 15:26:31 -06:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(i2c_new_device);
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
* i2c_unregister_device - reverse effect of i2c_new_device()
|
|
|
|
* @client: value returned from i2c_new_device()
|
2007-07-12 06:12:28 -06:00
|
|
|
* Context: can sleep
|
i2c: Add i2c_board_info and i2c_new_device()
This provides partial support for new-style I2C driver binding. It builds
on "struct i2c_board_info" declarations that identify I2C devices on a given
board. This is needed on systems with I2C devices that can't be fully probed
and/or autoconfigured, such as many embedded Linux configurations where the
way a given I2C device is wired may affect how it must be used.
There are two models for declaring such devices:
* LATE -- using a public function i2c_new_device(). This lets modules
declare I2C devices found *AFTER* a given I2C adapter becomes available.
For example, a PCI card could create adapters giving access to utility
chips on that card, and this would be used to associate those chips with
those adapters.
* EARLY -- from arch_initcall() level code, using a non-exported function
i2c_register_board_info(). This copies the declarations *BEFORE* such
an i2c_adapter becomes available, arranging that i2c_new_device() will
be called later when i2c-core registers the relevant i2c_adapter.
For example, arch/.../.../board-*.c files would declare the I2C devices
along with their platform data, and I2C devices would behave much like
PNPACPI devices. (That is, both enumerate from board-specific tables.)
To match the exported i2c_new_device(), the previously-private function
i2c_unregister_device() is now exported.
Pending later patches using these new APIs, this is effectively a NOP.
Signed-off-by: David Brownell <dbrownell@users.sourceforge.net>
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2007-05-01 15:26:31 -06:00
|
|
|
*/
|
|
|
|
void i2c_unregister_device(struct i2c_client *client)
|
2007-05-01 15:26:30 -06:00
|
|
|
{
|
2015-01-24 00:16:29 -07:00
|
|
|
if (client->dev.of_node)
|
|
|
|
of_node_clear_flag(client->dev.of_node, OF_POPULATED);
|
2007-05-01 15:26:30 -06:00
|
|
|
device_unregister(&client->dev);
|
|
|
|
}
|
i2c: Add i2c_board_info and i2c_new_device()
This provides partial support for new-style I2C driver binding. It builds
on "struct i2c_board_info" declarations that identify I2C devices on a given
board. This is needed on systems with I2C devices that can't be fully probed
and/or autoconfigured, such as many embedded Linux configurations where the
way a given I2C device is wired may affect how it must be used.
There are two models for declaring such devices:
* LATE -- using a public function i2c_new_device(). This lets modules
declare I2C devices found *AFTER* a given I2C adapter becomes available.
For example, a PCI card could create adapters giving access to utility
chips on that card, and this would be used to associate those chips with
those adapters.
* EARLY -- from arch_initcall() level code, using a non-exported function
i2c_register_board_info(). This copies the declarations *BEFORE* such
an i2c_adapter becomes available, arranging that i2c_new_device() will
be called later when i2c-core registers the relevant i2c_adapter.
For example, arch/.../.../board-*.c files would declare the I2C devices
along with their platform data, and I2C devices would behave much like
PNPACPI devices. (That is, both enumerate from board-specific tables.)
To match the exported i2c_new_device(), the previously-private function
i2c_unregister_device() is now exported.
Pending later patches using these new APIs, this is effectively a NOP.
Signed-off-by: David Brownell <dbrownell@users.sourceforge.net>
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL_GPL(i2c_unregister_device);
|
2007-05-01 15:26:30 -06:00
|
|
|
|
|
|
|
|
2008-05-11 12:37:06 -06:00
|
|
|
static const struct i2c_device_id dummy_id[] = {
|
|
|
|
{ "dummy", 0 },
|
|
|
|
{ },
|
|
|
|
};
|
|
|
|
|
2008-04-29 15:11:39 -06:00
|
|
|
static int dummy_probe(struct i2c_client *client,
|
|
|
|
const struct i2c_device_id *id)
|
|
|
|
{
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int dummy_remove(struct i2c_client *client)
|
2008-01-27 10:14:52 -07:00
|
|
|
{
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static struct i2c_driver dummy_driver = {
|
|
|
|
.driver.name = "dummy",
|
2008-04-29 15:11:39 -06:00
|
|
|
.probe = dummy_probe,
|
|
|
|
.remove = dummy_remove,
|
2008-05-11 12:37:06 -06:00
|
|
|
.id_table = dummy_id,
|
2008-01-27 10:14:52 -07:00
|
|
|
};
|
|
|
|
|
|
|
|
/**
|
|
|
|
* i2c_new_dummy - return a new i2c device bound to a dummy driver
|
|
|
|
* @adapter: the adapter managing the device
|
|
|
|
* @address: seven bit address to be used
|
|
|
|
* Context: can sleep
|
|
|
|
*
|
|
|
|
* This returns an I2C client bound to the "dummy" driver, intended for use
|
|
|
|
* with devices that consume multiple addresses. Examples of such chips
|
|
|
|
* include various EEPROMS (like 24c04 and 24c08 models).
|
|
|
|
*
|
|
|
|
* These dummy devices have two main uses. First, most I2C and SMBus calls
|
|
|
|
* except i2c_transfer() need a client handle; the dummy will be that handle.
|
|
|
|
* And second, this prevents the specified address from being bound to a
|
|
|
|
* different driver.
|
|
|
|
*
|
|
|
|
* This returns the new i2c client, which should be saved for later use with
|
|
|
|
* i2c_unregister_device(); or NULL to indicate an error.
|
|
|
|
*/
|
2009-03-28 14:34:46 -06:00
|
|
|
struct i2c_client *i2c_new_dummy(struct i2c_adapter *adapter, u16 address)
|
2008-01-27 10:14:52 -07:00
|
|
|
{
|
|
|
|
struct i2c_board_info info = {
|
2008-05-11 12:37:06 -06:00
|
|
|
I2C_BOARD_INFO("dummy", address),
|
2008-01-27 10:14:52 -07:00
|
|
|
};
|
|
|
|
|
|
|
|
return i2c_new_device(adapter, &info);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(i2c_new_dummy);
|
|
|
|
|
2007-02-13 14:09:00 -07:00
|
|
|
/* ------------------------------------------------------------------------- */
|
|
|
|
|
2007-05-01 15:26:28 -06:00
|
|
|
/* I2C bus adapters -- one roots each I2C or SMBUS segment */
|
|
|
|
|
2007-10-13 15:56:30 -06:00
|
|
|
static void i2c_adapter_dev_release(struct device *dev)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2007-05-01 15:26:28 -06:00
|
|
|
struct i2c_adapter *adap = to_i2c_adapter(dev);
|
2005-04-16 16:20:36 -06:00
|
|
|
complete(&adap->dev_released);
|
|
|
|
}
|
|
|
|
|
2012-09-10 02:14:02 -06:00
|
|
|
/*
|
|
|
|
* This function is only needed for mutex_lock_nested, so it is never
|
|
|
|
* called unless locking correctness checking is enabled. Thus we
|
|
|
|
* make it inline to avoid a compiler warning. That's what gcc ends up
|
|
|
|
* doing anyway.
|
|
|
|
*/
|
|
|
|
static inline unsigned int i2c_adapter_depth(struct i2c_adapter *adapter)
|
|
|
|
{
|
|
|
|
unsigned int depth = 0;
|
|
|
|
|
|
|
|
while ((adapter = i2c_parent_is_i2c_adapter(adapter)))
|
|
|
|
depth++;
|
|
|
|
|
|
|
|
return depth;
|
|
|
|
}
|
|
|
|
|
2009-06-19 08:58:20 -06:00
|
|
|
/*
|
|
|
|
* Let users instantiate I2C devices through sysfs. This can be used when
|
|
|
|
* platform initialization code doesn't contain the proper data for
|
|
|
|
* whatever reason. Also useful for drivers that do device detection and
|
|
|
|
* detection fails, either because the device uses an unexpected address,
|
|
|
|
* or this is a compatible device with different ID register values.
|
|
|
|
*
|
|
|
|
* Parameter checking may look overzealous, but we really don't want
|
|
|
|
* the user to provide incorrect parameters.
|
|
|
|
*/
|
|
|
|
static ssize_t
|
|
|
|
i2c_sysfs_new_device(struct device *dev, struct device_attribute *attr,
|
|
|
|
const char *buf, size_t count)
|
|
|
|
{
|
|
|
|
struct i2c_adapter *adap = to_i2c_adapter(dev);
|
|
|
|
struct i2c_board_info info;
|
|
|
|
struct i2c_client *client;
|
|
|
|
char *blank, end;
|
|
|
|
int res;
|
|
|
|
|
|
|
|
memset(&info, 0, sizeof(struct i2c_board_info));
|
|
|
|
|
|
|
|
blank = strchr(buf, ' ');
|
|
|
|
if (!blank) {
|
|
|
|
dev_err(dev, "%s: Missing parameters\n", "new_device");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
if (blank - buf > I2C_NAME_SIZE - 1) {
|
|
|
|
dev_err(dev, "%s: Invalid device name\n", "new_device");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
memcpy(info.type, buf, blank - buf);
|
|
|
|
|
|
|
|
/* Parse remaining parameters, reject extra parameters */
|
|
|
|
res = sscanf(++blank, "%hi%c", &info.addr, &end);
|
|
|
|
if (res < 1) {
|
|
|
|
dev_err(dev, "%s: Can't parse I2C address\n", "new_device");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
if (res > 1 && end != '\n') {
|
|
|
|
dev_err(dev, "%s: Extra parameters\n", "new_device");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2015-07-27 06:03:38 -06:00
|
|
|
if ((info.addr & I2C_ADDR_OFFSET_TEN_BIT) == I2C_ADDR_OFFSET_TEN_BIT) {
|
|
|
|
info.addr &= ~I2C_ADDR_OFFSET_TEN_BIT;
|
|
|
|
info.flags |= I2C_CLIENT_TEN;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (info.addr & I2C_ADDR_OFFSET_SLAVE) {
|
|
|
|
info.addr &= ~I2C_ADDR_OFFSET_SLAVE;
|
|
|
|
info.flags |= I2C_CLIENT_SLAVE;
|
|
|
|
}
|
|
|
|
|
2009-06-19 08:58:20 -06:00
|
|
|
client = i2c_new_device(adap, &info);
|
|
|
|
if (!client)
|
2010-06-03 03:33:52 -06:00
|
|
|
return -EINVAL;
|
2009-06-19 08:58:20 -06:00
|
|
|
|
|
|
|
/* Keep track of the added device */
|
2010-08-11 10:21:01 -06:00
|
|
|
mutex_lock(&adap->userspace_clients_lock);
|
2010-05-04 03:09:28 -06:00
|
|
|
list_add_tail(&client->detected, &adap->userspace_clients);
|
2010-08-11 10:21:01 -06:00
|
|
|
mutex_unlock(&adap->userspace_clients_lock);
|
2009-06-19 08:58:20 -06:00
|
|
|
dev_info(dev, "%s: Instantiated device %s at 0x%02hx\n", "new_device",
|
|
|
|
info.type, info.addr);
|
|
|
|
|
|
|
|
return count;
|
|
|
|
}
|
2015-01-19 12:12:24 -07:00
|
|
|
static DEVICE_ATTR(new_device, S_IWUSR, NULL, i2c_sysfs_new_device);
|
2009-06-19 08:58:20 -06:00
|
|
|
|
|
|
|
/*
|
|
|
|
* And of course let the users delete the devices they instantiated, if
|
|
|
|
* they got it wrong. This interface can only be used to delete devices
|
|
|
|
* instantiated by i2c_sysfs_new_device above. This guarantees that we
|
|
|
|
* don't delete devices to which some kernel code still has references.
|
|
|
|
*
|
|
|
|
* Parameter checking may look overzealous, but we really don't want
|
|
|
|
* the user to delete the wrong device.
|
|
|
|
*/
|
|
|
|
static ssize_t
|
|
|
|
i2c_sysfs_delete_device(struct device *dev, struct device_attribute *attr,
|
|
|
|
const char *buf, size_t count)
|
|
|
|
{
|
|
|
|
struct i2c_adapter *adap = to_i2c_adapter(dev);
|
|
|
|
struct i2c_client *client, *next;
|
|
|
|
unsigned short addr;
|
|
|
|
char end;
|
|
|
|
int res;
|
|
|
|
|
|
|
|
/* Parse parameters, reject extra parameters */
|
|
|
|
res = sscanf(buf, "%hi%c", &addr, &end);
|
|
|
|
if (res < 1) {
|
|
|
|
dev_err(dev, "%s: Can't parse I2C address\n", "delete_device");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
if (res > 1 && end != '\n') {
|
|
|
|
dev_err(dev, "%s: Extra parameters\n", "delete_device");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Make sure the device was added through sysfs */
|
|
|
|
res = -ENOENT;
|
2012-09-10 02:14:02 -06:00
|
|
|
mutex_lock_nested(&adap->userspace_clients_lock,
|
|
|
|
i2c_adapter_depth(adap));
|
2010-05-04 03:09:28 -06:00
|
|
|
list_for_each_entry_safe(client, next, &adap->userspace_clients,
|
|
|
|
detected) {
|
2015-07-27 06:03:38 -06:00
|
|
|
if (i2c_encode_flags_to_addr(client) == addr) {
|
2009-06-19 08:58:20 -06:00
|
|
|
dev_info(dev, "%s: Deleting device %s at 0x%02hx\n",
|
|
|
|
"delete_device", client->name, client->addr);
|
|
|
|
|
|
|
|
list_del(&client->detected);
|
|
|
|
i2c_unregister_device(client);
|
|
|
|
res = count;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
2010-08-11 10:21:01 -06:00
|
|
|
mutex_unlock(&adap->userspace_clients_lock);
|
2009-06-19 08:58:20 -06:00
|
|
|
|
|
|
|
if (res < 0)
|
|
|
|
dev_err(dev, "%s: Can't find device in list\n",
|
|
|
|
"delete_device");
|
|
|
|
return res;
|
|
|
|
}
|
2013-05-17 06:56:35 -06:00
|
|
|
static DEVICE_ATTR_IGNORE_LOCKDEP(delete_device, S_IWUSR, NULL,
|
|
|
|
i2c_sysfs_delete_device);
|
2009-09-18 14:45:46 -06:00
|
|
|
|
|
|
|
static struct attribute *i2c_adapter_attrs[] = {
|
|
|
|
&dev_attr_name.attr,
|
|
|
|
&dev_attr_new_device.attr,
|
|
|
|
&dev_attr_delete_device.attr,
|
|
|
|
NULL
|
|
|
|
};
|
2015-01-19 12:12:24 -07:00
|
|
|
ATTRIBUTE_GROUPS(i2c_adapter);
|
2007-01-04 05:07:04 -07:00
|
|
|
|
2010-08-11 10:21:02 -06:00
|
|
|
struct device_type i2c_adapter_type = {
|
2015-01-19 12:12:24 -07:00
|
|
|
.groups = i2c_adapter_groups,
|
2009-09-18 14:45:46 -06:00
|
|
|
.release = i2c_adapter_dev_release,
|
2005-04-16 16:20:36 -06:00
|
|
|
};
|
2010-08-11 10:21:02 -06:00
|
|
|
EXPORT_SYMBOL_GPL(i2c_adapter_type);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2012-04-17 12:43:33 -06:00
|
|
|
/**
|
|
|
|
* i2c_verify_adapter - return parameter as i2c_adapter or NULL
|
|
|
|
* @dev: device, probably from some driver model iterator
|
|
|
|
*
|
|
|
|
* When traversing the driver model tree, perhaps using driver model
|
|
|
|
* iterators like @device_for_each_child(), you can't assume very much
|
|
|
|
* about the nodes you find. Use this function to avoid oopses caused
|
|
|
|
* by wrongly treating some non-I2C device as an i2c_adapter.
|
|
|
|
*/
|
|
|
|
struct i2c_adapter *i2c_verify_adapter(struct device *dev)
|
|
|
|
{
|
|
|
|
return (dev->type == &i2c_adapter_type)
|
|
|
|
? to_i2c_adapter(dev)
|
|
|
|
: NULL;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(i2c_verify_adapter);
|
|
|
|
|
2009-09-18 14:45:46 -06:00
|
|
|
#ifdef CONFIG_I2C_COMPAT
|
|
|
|
static struct class_compat *i2c_adapter_compat_class;
|
|
|
|
#endif
|
|
|
|
|
i2c: Add i2c_board_info and i2c_new_device()
This provides partial support for new-style I2C driver binding. It builds
on "struct i2c_board_info" declarations that identify I2C devices on a given
board. This is needed on systems with I2C devices that can't be fully probed
and/or autoconfigured, such as many embedded Linux configurations where the
way a given I2C device is wired may affect how it must be used.
There are two models for declaring such devices:
* LATE -- using a public function i2c_new_device(). This lets modules
declare I2C devices found *AFTER* a given I2C adapter becomes available.
For example, a PCI card could create adapters giving access to utility
chips on that card, and this would be used to associate those chips with
those adapters.
* EARLY -- from arch_initcall() level code, using a non-exported function
i2c_register_board_info(). This copies the declarations *BEFORE* such
an i2c_adapter becomes available, arranging that i2c_new_device() will
be called later when i2c-core registers the relevant i2c_adapter.
For example, arch/.../.../board-*.c files would declare the I2C devices
along with their platform data, and I2C devices would behave much like
PNPACPI devices. (That is, both enumerate from board-specific tables.)
To match the exported i2c_new_device(), the previously-private function
i2c_unregister_device() is now exported.
Pending later patches using these new APIs, this is effectively a NOP.
Signed-off-by: David Brownell <dbrownell@users.sourceforge.net>
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2007-05-01 15:26:31 -06:00
|
|
|
static void i2c_scan_static_board_info(struct i2c_adapter *adapter)
|
|
|
|
{
|
|
|
|
struct i2c_devinfo *devinfo;
|
|
|
|
|
2009-06-19 08:58:20 -06:00
|
|
|
down_read(&__i2c_board_lock);
|
i2c: Add i2c_board_info and i2c_new_device()
This provides partial support for new-style I2C driver binding. It builds
on "struct i2c_board_info" declarations that identify I2C devices on a given
board. This is needed on systems with I2C devices that can't be fully probed
and/or autoconfigured, such as many embedded Linux configurations where the
way a given I2C device is wired may affect how it must be used.
There are two models for declaring such devices:
* LATE -- using a public function i2c_new_device(). This lets modules
declare I2C devices found *AFTER* a given I2C adapter becomes available.
For example, a PCI card could create adapters giving access to utility
chips on that card, and this would be used to associate those chips with
those adapters.
* EARLY -- from arch_initcall() level code, using a non-exported function
i2c_register_board_info(). This copies the declarations *BEFORE* such
an i2c_adapter becomes available, arranging that i2c_new_device() will
be called later when i2c-core registers the relevant i2c_adapter.
For example, arch/.../.../board-*.c files would declare the I2C devices
along with their platform data, and I2C devices would behave much like
PNPACPI devices. (That is, both enumerate from board-specific tables.)
To match the exported i2c_new_device(), the previously-private function
i2c_unregister_device() is now exported.
Pending later patches using these new APIs, this is effectively a NOP.
Signed-off-by: David Brownell <dbrownell@users.sourceforge.net>
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2007-05-01 15:26:31 -06:00
|
|
|
list_for_each_entry(devinfo, &__i2c_board_list, list) {
|
|
|
|
if (devinfo->busnum == adapter->nr
|
|
|
|
&& !i2c_new_device(adapter,
|
|
|
|
&devinfo->board_info))
|
2009-03-28 14:34:46 -06:00
|
|
|
dev_err(&adapter->dev,
|
|
|
|
"Can't create device at 0x%02x\n",
|
i2c: Add i2c_board_info and i2c_new_device()
This provides partial support for new-style I2C driver binding. It builds
on "struct i2c_board_info" declarations that identify I2C devices on a given
board. This is needed on systems with I2C devices that can't be fully probed
and/or autoconfigured, such as many embedded Linux configurations where the
way a given I2C device is wired may affect how it must be used.
There are two models for declaring such devices:
* LATE -- using a public function i2c_new_device(). This lets modules
declare I2C devices found *AFTER* a given I2C adapter becomes available.
For example, a PCI card could create adapters giving access to utility
chips on that card, and this would be used to associate those chips with
those adapters.
* EARLY -- from arch_initcall() level code, using a non-exported function
i2c_register_board_info(). This copies the declarations *BEFORE* such
an i2c_adapter becomes available, arranging that i2c_new_device() will
be called later when i2c-core registers the relevant i2c_adapter.
For example, arch/.../.../board-*.c files would declare the I2C devices
along with their platform data, and I2C devices would behave much like
PNPACPI devices. (That is, both enumerate from board-specific tables.)
To match the exported i2c_new_device(), the previously-private function
i2c_unregister_device() is now exported.
Pending later patches using these new APIs, this is effectively a NOP.
Signed-off-by: David Brownell <dbrownell@users.sourceforge.net>
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2007-05-01 15:26:31 -06:00
|
|
|
devinfo->board_info.addr);
|
|
|
|
}
|
2009-06-19 08:58:20 -06:00
|
|
|
up_read(&__i2c_board_lock);
|
i2c: Add i2c_board_info and i2c_new_device()
This provides partial support for new-style I2C driver binding. It builds
on "struct i2c_board_info" declarations that identify I2C devices on a given
board. This is needed on systems with I2C devices that can't be fully probed
and/or autoconfigured, such as many embedded Linux configurations where the
way a given I2C device is wired may affect how it must be used.
There are two models for declaring such devices:
* LATE -- using a public function i2c_new_device(). This lets modules
declare I2C devices found *AFTER* a given I2C adapter becomes available.
For example, a PCI card could create adapters giving access to utility
chips on that card, and this would be used to associate those chips with
those adapters.
* EARLY -- from arch_initcall() level code, using a non-exported function
i2c_register_board_info(). This copies the declarations *BEFORE* such
an i2c_adapter becomes available, arranging that i2c_new_device() will
be called later when i2c-core registers the relevant i2c_adapter.
For example, arch/.../.../board-*.c files would declare the I2C devices
along with their platform data, and I2C devices would behave much like
PNPACPI devices. (That is, both enumerate from board-specific tables.)
To match the exported i2c_new_device(), the previously-private function
i2c_unregister_device() is now exported.
Pending later patches using these new APIs, this is effectively a NOP.
Signed-off-by: David Brownell <dbrownell@users.sourceforge.net>
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2007-05-01 15:26:31 -06:00
|
|
|
}
|
|
|
|
|
2013-07-11 05:56:15 -06:00
|
|
|
/* OF support code */
|
|
|
|
|
|
|
|
#if IS_ENABLED(CONFIG_OF)
|
2014-10-28 14:36:02 -06:00
|
|
|
static struct i2c_client *of_i2c_register_device(struct i2c_adapter *adap,
|
|
|
|
struct device_node *node)
|
2013-07-11 05:56:15 -06:00
|
|
|
{
|
2014-10-28 14:36:02 -06:00
|
|
|
struct i2c_client *result;
|
|
|
|
struct i2c_board_info info = {};
|
|
|
|
struct dev_archdata dev_ad = {};
|
2015-05-19 13:04:40 -06:00
|
|
|
const __be32 *addr_be;
|
|
|
|
u32 addr;
|
2014-10-28 14:36:02 -06:00
|
|
|
int len;
|
2013-07-11 05:56:15 -06:00
|
|
|
|
2014-10-28 14:36:02 -06:00
|
|
|
dev_dbg(&adap->dev, "of_i2c: register %s\n", node->full_name);
|
2013-07-11 05:56:15 -06:00
|
|
|
|
2014-10-28 14:36:02 -06:00
|
|
|
if (of_modalias_node(node, info.type, sizeof(info.type)) < 0) {
|
|
|
|
dev_err(&adap->dev, "of_i2c: modalias failure on %s\n",
|
|
|
|
node->full_name);
|
|
|
|
return ERR_PTR(-EINVAL);
|
|
|
|
}
|
2013-07-11 05:56:15 -06:00
|
|
|
|
2015-05-19 13:04:40 -06:00
|
|
|
addr_be = of_get_property(node, "reg", &len);
|
|
|
|
if (!addr_be || (len < sizeof(*addr_be))) {
|
2014-10-28 14:36:02 -06:00
|
|
|
dev_err(&adap->dev, "of_i2c: invalid reg on %s\n",
|
|
|
|
node->full_name);
|
|
|
|
return ERR_PTR(-EINVAL);
|
|
|
|
}
|
2013-07-11 05:56:15 -06:00
|
|
|
|
2015-05-19 13:04:40 -06:00
|
|
|
addr = be32_to_cpup(addr_be);
|
|
|
|
if (addr & I2C_TEN_BIT_ADDRESS) {
|
|
|
|
addr &= ~I2C_TEN_BIT_ADDRESS;
|
|
|
|
info.flags |= I2C_CLIENT_TEN;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (addr & I2C_OWN_SLAVE_ADDRESS) {
|
|
|
|
addr &= ~I2C_OWN_SLAVE_ADDRESS;
|
|
|
|
info.flags |= I2C_CLIENT_SLAVE;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (i2c_check_addr_validity(addr, info.flags)) {
|
2014-10-28 14:36:02 -06:00
|
|
|
dev_err(&adap->dev, "of_i2c: invalid addr=%x on %s\n",
|
|
|
|
info.addr, node->full_name);
|
|
|
|
return ERR_PTR(-EINVAL);
|
|
|
|
}
|
2013-07-11 05:56:15 -06:00
|
|
|
|
2015-05-19 13:04:40 -06:00
|
|
|
info.addr = addr;
|
2014-10-28 14:36:02 -06:00
|
|
|
info.of_node = of_node_get(node);
|
|
|
|
info.archdata = &dev_ad;
|
2013-07-11 05:56:15 -06:00
|
|
|
|
2014-10-28 14:36:02 -06:00
|
|
|
if (of_get_property(node, "wakeup-source", NULL))
|
|
|
|
info.flags |= I2C_CLIENT_WAKE;
|
2013-07-11 05:56:15 -06:00
|
|
|
|
2014-10-28 14:36:02 -06:00
|
|
|
result = i2c_new_device(adap, &info);
|
|
|
|
if (result == NULL) {
|
|
|
|
dev_err(&adap->dev, "of_i2c: Failure registering %s\n",
|
|
|
|
node->full_name);
|
|
|
|
of_node_put(node);
|
|
|
|
return ERR_PTR(-EINVAL);
|
|
|
|
}
|
|
|
|
return result;
|
|
|
|
}
|
2013-07-11 05:56:15 -06:00
|
|
|
|
2014-10-28 14:36:02 -06:00
|
|
|
static void of_i2c_register_devices(struct i2c_adapter *adap)
|
|
|
|
{
|
|
|
|
struct device_node *node;
|
2013-07-11 05:56:15 -06:00
|
|
|
|
2014-10-28 14:36:02 -06:00
|
|
|
/* Only register child devices if the adapter has a node pointer set */
|
|
|
|
if (!adap->dev.of_node)
|
|
|
|
return;
|
2013-07-11 05:56:15 -06:00
|
|
|
|
2014-10-28 14:36:02 -06:00
|
|
|
dev_dbg(&adap->dev, "of_i2c: walking child nodes\n");
|
|
|
|
|
2015-01-24 00:16:29 -07:00
|
|
|
for_each_available_child_of_node(adap->dev.of_node, node) {
|
|
|
|
if (of_node_test_and_set_flag(node, OF_POPULATED))
|
|
|
|
continue;
|
2014-10-28 14:36:02 -06:00
|
|
|
of_i2c_register_device(adap, node);
|
2015-01-24 00:16:29 -07:00
|
|
|
}
|
2013-07-11 05:56:15 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
static int of_dev_node_match(struct device *dev, void *data)
|
|
|
|
{
|
|
|
|
return dev->of_node == data;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* must call put_device() when done with returned i2c_client device */
|
|
|
|
struct i2c_client *of_find_i2c_device_by_node(struct device_node *node)
|
|
|
|
{
|
|
|
|
struct device *dev;
|
2015-07-27 08:30:48 -06:00
|
|
|
struct i2c_client *client;
|
2013-07-11 05:56:15 -06:00
|
|
|
|
2015-07-27 08:30:48 -06:00
|
|
|
dev = bus_find_device(&i2c_bus_type, NULL, node, of_dev_node_match);
|
2013-07-11 05:56:15 -06:00
|
|
|
if (!dev)
|
|
|
|
return NULL;
|
|
|
|
|
2015-07-27 08:30:48 -06:00
|
|
|
client = i2c_verify_client(dev);
|
|
|
|
if (!client)
|
|
|
|
put_device(dev);
|
|
|
|
|
|
|
|
return client;
|
2013-07-11 05:56:15 -06:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(of_find_i2c_device_by_node);
|
|
|
|
|
|
|
|
/* must call put_device() when done with returned i2c_adapter device */
|
|
|
|
struct i2c_adapter *of_find_i2c_adapter_by_node(struct device_node *node)
|
|
|
|
{
|
|
|
|
struct device *dev;
|
2015-07-27 08:30:48 -06:00
|
|
|
struct i2c_adapter *adapter;
|
2013-07-11 05:56:15 -06:00
|
|
|
|
2015-07-27 08:30:48 -06:00
|
|
|
dev = bus_find_device(&i2c_bus_type, NULL, node, of_dev_node_match);
|
2013-07-11 05:56:15 -06:00
|
|
|
if (!dev)
|
|
|
|
return NULL;
|
|
|
|
|
2015-07-27 08:30:48 -06:00
|
|
|
adapter = i2c_verify_adapter(dev);
|
|
|
|
if (!adapter)
|
|
|
|
put_device(dev);
|
|
|
|
|
|
|
|
return adapter;
|
2013-07-11 05:56:15 -06:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(of_find_i2c_adapter_by_node);
|
2015-07-27 08:30:50 -06:00
|
|
|
|
|
|
|
/* must call i2c_put_adapter() when done with returned i2c_adapter device */
|
|
|
|
struct i2c_adapter *of_get_i2c_adapter_by_node(struct device_node *node)
|
|
|
|
{
|
|
|
|
struct i2c_adapter *adapter;
|
|
|
|
|
|
|
|
adapter = of_find_i2c_adapter_by_node(node);
|
|
|
|
if (!adapter)
|
|
|
|
return NULL;
|
|
|
|
|
|
|
|
if (!try_module_get(adapter->owner)) {
|
|
|
|
put_device(&adapter->dev);
|
|
|
|
adapter = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
return adapter;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(of_get_i2c_adapter_by_node);
|
2013-07-11 05:56:15 -06:00
|
|
|
#else
|
|
|
|
static void of_i2c_register_devices(struct i2c_adapter *adap) { }
|
|
|
|
#endif /* CONFIG_OF */
|
|
|
|
|
2009-12-06 09:06:27 -07:00
|
|
|
static int i2c_do_add_adapter(struct i2c_driver *driver,
|
|
|
|
struct i2c_adapter *adap)
|
2008-01-27 10:14:49 -07:00
|
|
|
{
|
i2c: Add detection capability to new-style drivers
Add a mechanism to let new-style i2c drivers optionally autodetect
devices they would support on selected buses and ask i2c-core to
instantiate them. This is a replacement for legacy i2c drivers, much
cleaner.
Where drivers had to implement both a legacy i2c_driver and a
new-style i2c_driver so far, this mechanism makes it possible to get
rid of the legacy i2c_driver and implement both enumerated and
detected device support with just one (new-style) i2c_driver.
Here is a quick conversion guide for these drivers, step by step:
* Delete the legacy driver definition, registration and removal.
Delete the attach_adapter and detach_client methods of the legacy
driver.
* Change the prototype of the legacy detect function from
static int foo_detect(struct i2c_adapter *adapter, int address, int kind);
to
static int foo_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info);
* Set the new-style driver detect callback to this new function, and
set its address_data to &addr_data (addr_data is generally provided
by I2C_CLIENT_INSMOD.)
* Add the appropriate class to the new-style driver. This is
typically the class the legacy attach_adapter method was checking
for. Class checking is now mandatory (done by i2c-core.) See
<linux/i2c.h> for the list of available classes.
* Remove the i2c_client allocation and freeing from the detect
function. A pre-allocated client is now handed to you by i2c-core,
and is freed automatically.
* Make the detect function fill the type field of the i2c_board_info
structure it was passed as a parameter, and return 0, on success. If
the detection fails, return -ENODEV.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2008-07-14 14:38:36 -06:00
|
|
|
/* Detect supported devices on that bus, and instantiate them */
|
|
|
|
i2c_detect(adap, driver);
|
|
|
|
|
|
|
|
/* Let legacy drivers scan this bus for matching devices */
|
2008-01-27 10:14:49 -07:00
|
|
|
if (driver->attach_adapter) {
|
2011-04-17 02:20:19 -06:00
|
|
|
dev_warn(&adap->dev, "%s: attach_adapter method is deprecated\n",
|
|
|
|
driver->driver.name);
|
2011-03-20 07:50:53 -06:00
|
|
|
dev_warn(&adap->dev, "Please use another way to instantiate "
|
|
|
|
"your i2c_client\n");
|
2008-01-27 10:14:49 -07:00
|
|
|
/* We ignore the return code; if it fails, too bad */
|
|
|
|
driver->attach_adapter(adap);
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2009-12-06 09:06:27 -07:00
|
|
|
static int __process_new_adapter(struct device_driver *d, void *data)
|
|
|
|
{
|
|
|
|
return i2c_do_add_adapter(to_i2c_driver(d), data);
|
|
|
|
}
|
|
|
|
|
2007-05-01 15:26:31 -06:00
|
|
|
static int i2c_register_adapter(struct i2c_adapter *adap)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2010-08-11 10:20:59 -06:00
|
|
|
int res = 0;
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2008-10-14 09:30:05 -06:00
|
|
|
/* Can't register until after driver model init */
|
2016-03-07 04:49:17 -07:00
|
|
|
if (WARN_ON(!is_registered)) {
|
2009-06-19 08:58:19 -06:00
|
|
|
res = -EAGAIN;
|
|
|
|
goto out_list;
|
|
|
|
}
|
2008-10-14 09:30:05 -06:00
|
|
|
|
2010-11-15 14:40:38 -07:00
|
|
|
/* Sanity checks */
|
|
|
|
if (unlikely(adap->name[0] == '\0')) {
|
|
|
|
pr_err("i2c-core: Attempt to register an adapter with "
|
|
|
|
"no name!\n");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
if (unlikely(!adap->algo)) {
|
|
|
|
pr_err("i2c-core: Attempt to register adapter '%s' with "
|
|
|
|
"no algo!\n", adap->name);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2009-12-06 09:06:22 -07:00
|
|
|
rt_mutex_init(&adap->bus_lock);
|
2010-08-11 10:21:01 -06:00
|
|
|
mutex_init(&adap->userspace_clients_lock);
|
2010-05-04 03:09:28 -06:00
|
|
|
INIT_LIST_HEAD(&adap->userspace_clients);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2009-03-28 14:34:43 -06:00
|
|
|
/* Set default timeout to 1 second if not already set */
|
|
|
|
if (adap->timeout == 0)
|
|
|
|
adap->timeout = HZ;
|
|
|
|
|
i2c: Replace bus_id with dev_name(), dev_set_name()
This patch is part of a larger patch series which will remove
the "char bus_id[20]" name string from struct device. The device
name is managed in the kobject anyway, and without any size
limitation, and just needlessly copied into "struct device".
To set and read the device name dev_name(dev) and dev_set_name(dev)
must be used. If your code uses static kobjects, which it shouldn't
do, "const char *init_name" can be used to statically provide the
name the registered device should have. At registration time, the
init_name field is cleared, to enforce the use of dev_name(dev) to
access the device name at a later time.
We need to get rid of all occurrences of bus_id in the entire tree
to be able to enable the new interface. Please apply this patch,
and possibly convert any remaining remaining occurrences of bus_id.
We want to submit a patch to -next, which will remove bus_id from
"struct device", to find the remaining pieces to convert, and finally
switch over to the new api, which will remove the 20 bytes array
and does no longer have a size limitation.
Acked-by: Greg Kroah-Hartman <gregkh@suse.de>
Signed-off-by: Kay Sievers <kay.sievers@vrfy.org>
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2009-01-07 06:29:16 -07:00
|
|
|
dev_set_name(&adap->dev, "i2c-%d", adap->nr);
|
2009-09-18 14:45:46 -06:00
|
|
|
adap->dev.bus = &i2c_bus_type;
|
|
|
|
adap->dev.type = &i2c_adapter_type;
|
2006-08-15 10:26:30 -06:00
|
|
|
res = device_register(&adap->dev);
|
|
|
|
if (res)
|
|
|
|
goto out_list;
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2005-07-31 11:02:53 -06:00
|
|
|
dev_dbg(&adap->dev, "adapter [%s] registered\n", adap->name);
|
|
|
|
|
2015-04-16 06:05:19 -06:00
|
|
|
pm_runtime_no_callbacks(&adap->dev);
|
2015-12-23 10:19:28 -07:00
|
|
|
pm_runtime_enable(&adap->dev);
|
2015-04-16 06:05:19 -06:00
|
|
|
|
2009-09-18 14:45:46 -06:00
|
|
|
#ifdef CONFIG_I2C_COMPAT
|
|
|
|
res = class_compat_create_link(i2c_adapter_compat_class, &adap->dev,
|
|
|
|
adap->dev.parent);
|
|
|
|
if (res)
|
|
|
|
dev_warn(&adap->dev,
|
|
|
|
"Failed to create compatibility class link\n");
|
|
|
|
#endif
|
|
|
|
|
2012-02-28 05:56:31 -07:00
|
|
|
/* bus recovery specific initialization */
|
|
|
|
if (adap->bus_recovery_info) {
|
|
|
|
struct i2c_bus_recovery_info *bri = adap->bus_recovery_info;
|
|
|
|
|
|
|
|
if (!bri->recover_bus) {
|
|
|
|
dev_err(&adap->dev, "No recover_bus() found, not using recovery\n");
|
|
|
|
adap->bus_recovery_info = NULL;
|
|
|
|
goto exit_recovery;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Generic GPIO recovery */
|
|
|
|
if (bri->recover_bus == i2c_generic_gpio_recovery) {
|
|
|
|
if (!gpio_is_valid(bri->scl_gpio)) {
|
|
|
|
dev_err(&adap->dev, "Invalid SCL gpio, not using recovery\n");
|
|
|
|
adap->bus_recovery_info = NULL;
|
|
|
|
goto exit_recovery;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (gpio_is_valid(bri->sda_gpio))
|
|
|
|
bri->get_sda = get_sda_gpio_value;
|
|
|
|
else
|
|
|
|
bri->get_sda = NULL;
|
|
|
|
|
|
|
|
bri->get_scl = get_scl_gpio_value;
|
|
|
|
bri->set_scl = set_scl_gpio_value;
|
|
|
|
} else if (!bri->set_scl || !bri->get_scl) {
|
|
|
|
/* Generic SCL recovery */
|
|
|
|
dev_err(&adap->dev, "No {get|set}_gpio() found, not using recovery\n");
|
|
|
|
adap->bus_recovery_info = NULL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
exit_recovery:
|
2009-06-19 08:58:18 -06:00
|
|
|
/* create pre-declared device nodes */
|
2013-07-11 05:56:15 -06:00
|
|
|
of_i2c_register_devices(adap);
|
2013-08-21 08:28:23 -06:00
|
|
|
acpi_i2c_register_devices(adap);
|
I2C/ACPI: Add i2c ACPI operation region support
ACPI 5.0 spec(5.5.2.4.5) defines GenericSerialBus(i2c, spi, uart) operation region.
It allows ACPI aml code able to access such kind of devices to implement
some ACPI standard method.
ACPI Spec defines some access attribute to associate with i2c protocol.
AttribQuick Read/Write Quick Protocol
AttribSendReceive Send/Receive Byte Protocol
AttribByte Read/Write Byte Protocol
AttribWord Read/Write Word Protocol
AttribBlock Read/Write Block Protocol
AttribBytes Read/Write N-Bytes Protocol
AttribProcessCall Process Call Protocol
AttribBlockProcessCall Write Block-Read Block Process Call Protocol
AttribRawBytes Raw Read/Write N-BytesProtocol
AttribRawProcessBytes Raw Process Call Protocol
On the Asus T100TA, Bios use GenericSerialBus operation region to access
i2c device to get battery info.
Sample code From Asus T100TA
Scope (_SB.I2C1)
{
Name (UMPC, ResourceTemplate ()
{
I2cSerialBus (0x0066, ControllerInitiated, 0x00061A80,
AddressingMode7Bit, "\\_SB.I2C1",
0x00, ResourceConsumer, ,
)
})
...
OperationRegion (DVUM, GenericSerialBus, Zero, 0x0100)
Field (DVUM, BufferAcc, NoLock, Preserve)
{
Connection (UMPC),
Offset (0x81),
AccessAs (BufferAcc, AttribBytes (0x3E)),
FGC0, 8
}
...
}
Device (BATC)
{
Name (_HID, EisaId ("PNP0C0A")) // _HID: Hardware ID
Name (_UID, One) // _UID: Unique ID
...
Method (_BST, 0, NotSerialized) // _BST: Battery Status
{
If (LEqual (AVBL, One))
{
Store (FGC0, BFFG)
If (LNotEqual (STAT, One))
{
ShiftRight (CHST, 0x04, Local0)
And (Local0, 0x03, Local0)
If (LOr (LEqual (Local0, One), LEqual (Local0, 0x02)))
{
Store (0x02, Local1)
}
...
}
The i2c operation region is defined under I2C1 scope. _BST method under
battery device BATC read battery status from the field "FCG0". The request
would be sent to i2c operation region handler.
This patch is to add i2c ACPI operation region support. Due to there are
only "Byte" and "Bytes" protocol access on the Asus T100TA, other protocols
have not been tested.
About RawBytes and RawProcessBytes protocol, they needs specific drivers to interpret
reference data from AML code according ACPI 5.0 SPEC(5.5.2.4.5.3.9 and 5.5.2.4.5.3.10).
So far, not found such case and will add when find real case.
Signed-off-by: Lan Tianyu <tianyu.lan@intel.com>
Reviewed-by: Mika Westerberg <mika.westerberg@linux.intel.com>
Signed-off-by: Wolfram Sang <wsa@the-dreams.de>
2014-05-20 06:59:23 -06:00
|
|
|
acpi_i2c_install_space_handler(adap);
|
2013-07-11 05:56:15 -06:00
|
|
|
|
2007-05-01 15:26:31 -06:00
|
|
|
if (adap->nr < __i2c_first_dynamic_bus_num)
|
|
|
|
i2c_scan_static_board_info(adap);
|
|
|
|
|
i2c: Add detection capability to new-style drivers
Add a mechanism to let new-style i2c drivers optionally autodetect
devices they would support on selected buses and ask i2c-core to
instantiate them. This is a replacement for legacy i2c drivers, much
cleaner.
Where drivers had to implement both a legacy i2c_driver and a
new-style i2c_driver so far, this mechanism makes it possible to get
rid of the legacy i2c_driver and implement both enumerated and
detected device support with just one (new-style) i2c_driver.
Here is a quick conversion guide for these drivers, step by step:
* Delete the legacy driver definition, registration and removal.
Delete the attach_adapter and detach_client methods of the legacy
driver.
* Change the prototype of the legacy detect function from
static int foo_detect(struct i2c_adapter *adapter, int address, int kind);
to
static int foo_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info);
* Set the new-style driver detect callback to this new function, and
set its address_data to &addr_data (addr_data is generally provided
by I2C_CLIENT_INSMOD.)
* Add the appropriate class to the new-style driver. This is
typically the class the legacy attach_adapter method was checking
for. Class checking is now mandatory (done by i2c-core.) See
<linux/i2c.h> for the list of available classes.
* Remove the i2c_client allocation and freeing from the detect
function. A pre-allocated client is now handed to you by i2c-core,
and is freed automatically.
* Make the detect function fill the type field of the i2c_board_info
structure it was passed as a parameter, and return 0, on success. If
the detection fails, return -ENODEV.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2008-07-14 14:38:36 -06:00
|
|
|
/* Notify drivers */
|
2009-06-19 08:58:19 -06:00
|
|
|
mutex_lock(&core_lock);
|
2010-08-11 10:20:59 -06:00
|
|
|
bus_for_each_drv(&i2c_bus_type, NULL, adap, __process_new_adapter);
|
2008-01-27 10:14:49 -07:00
|
|
|
mutex_unlock(&core_lock);
|
2009-06-19 08:58:19 -06:00
|
|
|
|
|
|
|
return 0;
|
2006-08-15 10:26:30 -06:00
|
|
|
|
|
|
|
out_list:
|
2009-06-19 08:58:19 -06:00
|
|
|
mutex_lock(&core_lock);
|
2006-08-15 10:26:30 -06:00
|
|
|
idr_remove(&i2c_adapter_idr, adap->nr);
|
2009-06-19 08:58:19 -06:00
|
|
|
mutex_unlock(&core_lock);
|
|
|
|
return res;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
2013-03-01 09:57:31 -07:00
|
|
|
/**
|
|
|
|
* __i2c_add_numbered_adapter - i2c_add_numbered_adapter where nr is never -1
|
|
|
|
* @adap: the adapter to register (with adap->nr initialized)
|
|
|
|
* Context: can sleep
|
|
|
|
*
|
|
|
|
* See i2c_add_numbered_adapter() for details.
|
|
|
|
*/
|
|
|
|
static int __i2c_add_numbered_adapter(struct i2c_adapter *adap)
|
|
|
|
{
|
|
|
|
int id;
|
|
|
|
|
|
|
|
mutex_lock(&core_lock);
|
|
|
|
id = idr_alloc(&i2c_adapter_idr, adap, adap->nr, adap->nr + 1,
|
|
|
|
GFP_KERNEL);
|
|
|
|
mutex_unlock(&core_lock);
|
|
|
|
if (id < 0)
|
|
|
|
return id == -ENOSPC ? -EBUSY : id;
|
|
|
|
|
|
|
|
return i2c_register_adapter(adap);
|
|
|
|
}
|
|
|
|
|
2007-05-01 15:26:31 -06:00
|
|
|
/**
|
|
|
|
* i2c_add_adapter - declare i2c adapter, use dynamic bus number
|
|
|
|
* @adapter: the adapter to add
|
2007-07-12 06:12:28 -06:00
|
|
|
* Context: can sleep
|
2007-05-01 15:26:31 -06:00
|
|
|
*
|
|
|
|
* This routine is used to declare an I2C adapter when its bus number
|
2013-03-01 09:57:31 -07:00
|
|
|
* doesn't matter or when its bus number is specified by an dt alias.
|
|
|
|
* Examples of bases when the bus number doesn't matter: I2C adapters
|
|
|
|
* dynamically added by USB links or PCI plugin cards.
|
2007-05-01 15:26:31 -06:00
|
|
|
*
|
|
|
|
* When this returns zero, a new bus number was allocated and stored
|
|
|
|
* in adap->nr, and the specified adapter became available for clients.
|
|
|
|
* Otherwise, a negative errno value is returned.
|
|
|
|
*/
|
|
|
|
int i2c_add_adapter(struct i2c_adapter *adapter)
|
|
|
|
{
|
2013-03-01 09:57:31 -07:00
|
|
|
struct device *dev = &adapter->dev;
|
2013-02-27 18:04:15 -07:00
|
|
|
int id;
|
2007-05-01 15:26:31 -06:00
|
|
|
|
2013-03-01 09:57:31 -07:00
|
|
|
if (dev->of_node) {
|
|
|
|
id = of_alias_get_id(dev->of_node, "i2c");
|
|
|
|
if (id >= 0) {
|
|
|
|
adapter->nr = id;
|
|
|
|
return __i2c_add_numbered_adapter(adapter);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2008-01-27 10:14:49 -07:00
|
|
|
mutex_lock(&core_lock);
|
2013-02-27 18:04:15 -07:00
|
|
|
id = idr_alloc(&i2c_adapter_idr, adapter,
|
|
|
|
__i2c_first_dynamic_bus_num, 0, GFP_KERNEL);
|
2008-01-27 10:14:49 -07:00
|
|
|
mutex_unlock(&core_lock);
|
2013-02-27 18:04:15 -07:00
|
|
|
if (id < 0)
|
|
|
|
return id;
|
2007-05-01 15:26:31 -06:00
|
|
|
|
|
|
|
adapter->nr = id;
|
2013-02-27 18:04:15 -07:00
|
|
|
|
2007-05-01 15:26:31 -06:00
|
|
|
return i2c_register_adapter(adapter);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(i2c_add_adapter);
|
|
|
|
|
|
|
|
/**
|
|
|
|
* i2c_add_numbered_adapter - declare i2c adapter, use static bus number
|
|
|
|
* @adap: the adapter to register (with adap->nr initialized)
|
2007-07-12 06:12:28 -06:00
|
|
|
* Context: can sleep
|
2007-05-01 15:26:31 -06:00
|
|
|
*
|
|
|
|
* This routine is used to declare an I2C adapter when its bus number
|
2008-03-23 13:28:20 -06:00
|
|
|
* matters. For example, use it for I2C adapters from system-on-chip CPUs,
|
|
|
|
* or otherwise built in to the system's mainboard, and where i2c_board_info
|
2007-05-01 15:26:31 -06:00
|
|
|
* is used to properly configure I2C devices.
|
|
|
|
*
|
2011-07-25 09:49:43 -06:00
|
|
|
* If the requested bus number is set to -1, then this function will behave
|
|
|
|
* identically to i2c_add_adapter, and will dynamically assign a bus number.
|
|
|
|
*
|
2007-05-01 15:26:31 -06:00
|
|
|
* If no devices have pre-been declared for this bus, then be sure to
|
|
|
|
* register the adapter before any dynamically allocated ones. Otherwise
|
|
|
|
* the required bus ID may not be available.
|
|
|
|
*
|
|
|
|
* When this returns zero, the specified adapter became available for
|
|
|
|
* clients using the bus number provided in adap->nr. Also, the table
|
|
|
|
* of I2C devices pre-declared using i2c_register_board_info() is scanned,
|
|
|
|
* and the appropriate driver model device nodes are created. Otherwise, a
|
|
|
|
* negative errno value is returned.
|
|
|
|
*/
|
|
|
|
int i2c_add_numbered_adapter(struct i2c_adapter *adap)
|
|
|
|
{
|
2011-07-25 09:49:43 -06:00
|
|
|
if (adap->nr == -1) /* -1 means dynamically assign bus id */
|
|
|
|
return i2c_add_adapter(adap);
|
2007-05-01 15:26:31 -06:00
|
|
|
|
2013-03-01 09:57:31 -07:00
|
|
|
return __i2c_add_numbered_adapter(adap);
|
2007-05-01 15:26:31 -06:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(i2c_add_numbered_adapter);
|
|
|
|
|
2013-03-09 01:16:44 -07:00
|
|
|
static void i2c_do_del_adapter(struct i2c_driver *driver,
|
2009-12-06 09:06:27 -07:00
|
|
|
struct i2c_adapter *adapter)
|
2008-01-27 10:14:49 -07:00
|
|
|
{
|
i2c: Add detection capability to new-style drivers
Add a mechanism to let new-style i2c drivers optionally autodetect
devices they would support on selected buses and ask i2c-core to
instantiate them. This is a replacement for legacy i2c drivers, much
cleaner.
Where drivers had to implement both a legacy i2c_driver and a
new-style i2c_driver so far, this mechanism makes it possible to get
rid of the legacy i2c_driver and implement both enumerated and
detected device support with just one (new-style) i2c_driver.
Here is a quick conversion guide for these drivers, step by step:
* Delete the legacy driver definition, registration and removal.
Delete the attach_adapter and detach_client methods of the legacy
driver.
* Change the prototype of the legacy detect function from
static int foo_detect(struct i2c_adapter *adapter, int address, int kind);
to
static int foo_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info);
* Set the new-style driver detect callback to this new function, and
set its address_data to &addr_data (addr_data is generally provided
by I2C_CLIENT_INSMOD.)
* Add the appropriate class to the new-style driver. This is
typically the class the legacy attach_adapter method was checking
for. Class checking is now mandatory (done by i2c-core.) See
<linux/i2c.h> for the list of available classes.
* Remove the i2c_client allocation and freeing from the detect
function. A pre-allocated client is now handed to you by i2c-core,
and is freed automatically.
* Make the detect function fill the type field of the i2c_board_info
structure it was passed as a parameter, and return 0, on success. If
the detection fails, return -ENODEV.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2008-07-14 14:38:36 -06:00
|
|
|
struct i2c_client *client, *_n;
|
2008-01-27 10:14:49 -07:00
|
|
|
|
2009-03-28 14:34:40 -06:00
|
|
|
/* Remove the devices we created ourselves as the result of hardware
|
|
|
|
* probing (using a driver's detect method) */
|
i2c: Add detection capability to new-style drivers
Add a mechanism to let new-style i2c drivers optionally autodetect
devices they would support on selected buses and ask i2c-core to
instantiate them. This is a replacement for legacy i2c drivers, much
cleaner.
Where drivers had to implement both a legacy i2c_driver and a
new-style i2c_driver so far, this mechanism makes it possible to get
rid of the legacy i2c_driver and implement both enumerated and
detected device support with just one (new-style) i2c_driver.
Here is a quick conversion guide for these drivers, step by step:
* Delete the legacy driver definition, registration and removal.
Delete the attach_adapter and detach_client methods of the legacy
driver.
* Change the prototype of the legacy detect function from
static int foo_detect(struct i2c_adapter *adapter, int address, int kind);
to
static int foo_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info);
* Set the new-style driver detect callback to this new function, and
set its address_data to &addr_data (addr_data is generally provided
by I2C_CLIENT_INSMOD.)
* Add the appropriate class to the new-style driver. This is
typically the class the legacy attach_adapter method was checking
for. Class checking is now mandatory (done by i2c-core.) See
<linux/i2c.h> for the list of available classes.
* Remove the i2c_client allocation and freeing from the detect
function. A pre-allocated client is now handed to you by i2c-core,
and is freed automatically.
* Make the detect function fill the type field of the i2c_board_info
structure it was passed as a parameter, and return 0, on success. If
the detection fails, return -ENODEV.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2008-07-14 14:38:36 -06:00
|
|
|
list_for_each_entry_safe(client, _n, &driver->clients, detected) {
|
|
|
|
if (client->adapter == adapter) {
|
|
|
|
dev_dbg(&adapter->dev, "Removing %s at 0x%x\n",
|
|
|
|
client->name, client->addr);
|
|
|
|
list_del(&client->detected);
|
|
|
|
i2c_unregister_device(client);
|
|
|
|
}
|
|
|
|
}
|
2008-01-27 10:14:49 -07:00
|
|
|
}
|
|
|
|
|
2009-06-19 08:58:19 -06:00
|
|
|
static int __unregister_client(struct device *dev, void *dummy)
|
2011-01-14 14:03:49 -07:00
|
|
|
{
|
|
|
|
struct i2c_client *client = i2c_verify_client(dev);
|
|
|
|
if (client && strcmp(client->name, "dummy"))
|
|
|
|
i2c_unregister_device(client);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int __unregister_dummy(struct device *dev, void *dummy)
|
2009-06-19 08:58:19 -06:00
|
|
|
{
|
|
|
|
struct i2c_client *client = i2c_verify_client(dev);
|
|
|
|
if (client)
|
|
|
|
i2c_unregister_device(client);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2009-12-06 09:06:27 -07:00
|
|
|
static int __process_removed_adapter(struct device_driver *d, void *data)
|
|
|
|
{
|
2013-03-09 01:16:44 -07:00
|
|
|
i2c_do_del_adapter(to_i2c_driver(d), data);
|
|
|
|
return 0;
|
2009-12-06 09:06:27 -07:00
|
|
|
}
|
|
|
|
|
2007-07-12 06:12:28 -06:00
|
|
|
/**
|
|
|
|
* i2c_del_adapter - unregister I2C adapter
|
|
|
|
* @adap: the adapter being unregistered
|
|
|
|
* Context: can sleep
|
|
|
|
*
|
|
|
|
* This unregisters an I2C adapter which was previously registered
|
|
|
|
* by @i2c_add_adapter or @i2c_add_numbered_adapter.
|
|
|
|
*/
|
2013-03-09 01:16:47 -07:00
|
|
|
void i2c_del_adapter(struct i2c_adapter *adap)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2009-06-19 08:58:19 -06:00
|
|
|
struct i2c_adapter *found;
|
2009-11-26 01:22:33 -07:00
|
|
|
struct i2c_client *client, *next;
|
2005-04-16 16:20:36 -06:00
|
|
|
|
|
|
|
/* First make sure that this adapter was ever added */
|
2009-06-19 08:58:19 -06:00
|
|
|
mutex_lock(&core_lock);
|
|
|
|
found = idr_find(&i2c_adapter_idr, adap->nr);
|
|
|
|
mutex_unlock(&core_lock);
|
|
|
|
if (found != adap) {
|
2005-07-31 11:02:53 -06:00
|
|
|
pr_debug("i2c-core: attempting to delete unregistered "
|
|
|
|
"adapter [%s]\n", adap->name);
|
2013-03-09 01:16:47 -07:00
|
|
|
return;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
I2C/ACPI: Add i2c ACPI operation region support
ACPI 5.0 spec(5.5.2.4.5) defines GenericSerialBus(i2c, spi, uart) operation region.
It allows ACPI aml code able to access such kind of devices to implement
some ACPI standard method.
ACPI Spec defines some access attribute to associate with i2c protocol.
AttribQuick Read/Write Quick Protocol
AttribSendReceive Send/Receive Byte Protocol
AttribByte Read/Write Byte Protocol
AttribWord Read/Write Word Protocol
AttribBlock Read/Write Block Protocol
AttribBytes Read/Write N-Bytes Protocol
AttribProcessCall Process Call Protocol
AttribBlockProcessCall Write Block-Read Block Process Call Protocol
AttribRawBytes Raw Read/Write N-BytesProtocol
AttribRawProcessBytes Raw Process Call Protocol
On the Asus T100TA, Bios use GenericSerialBus operation region to access
i2c device to get battery info.
Sample code From Asus T100TA
Scope (_SB.I2C1)
{
Name (UMPC, ResourceTemplate ()
{
I2cSerialBus (0x0066, ControllerInitiated, 0x00061A80,
AddressingMode7Bit, "\\_SB.I2C1",
0x00, ResourceConsumer, ,
)
})
...
OperationRegion (DVUM, GenericSerialBus, Zero, 0x0100)
Field (DVUM, BufferAcc, NoLock, Preserve)
{
Connection (UMPC),
Offset (0x81),
AccessAs (BufferAcc, AttribBytes (0x3E)),
FGC0, 8
}
...
}
Device (BATC)
{
Name (_HID, EisaId ("PNP0C0A")) // _HID: Hardware ID
Name (_UID, One) // _UID: Unique ID
...
Method (_BST, 0, NotSerialized) // _BST: Battery Status
{
If (LEqual (AVBL, One))
{
Store (FGC0, BFFG)
If (LNotEqual (STAT, One))
{
ShiftRight (CHST, 0x04, Local0)
And (Local0, 0x03, Local0)
If (LOr (LEqual (Local0, One), LEqual (Local0, 0x02)))
{
Store (0x02, Local1)
}
...
}
The i2c operation region is defined under I2C1 scope. _BST method under
battery device BATC read battery status from the field "FCG0". The request
would be sent to i2c operation region handler.
This patch is to add i2c ACPI operation region support. Due to there are
only "Byte" and "Bytes" protocol access on the Asus T100TA, other protocols
have not been tested.
About RawBytes and RawProcessBytes protocol, they needs specific drivers to interpret
reference data from AML code according ACPI 5.0 SPEC(5.5.2.4.5.3.9 and 5.5.2.4.5.3.10).
So far, not found such case and will add when find real case.
Signed-off-by: Lan Tianyu <tianyu.lan@intel.com>
Reviewed-by: Mika Westerberg <mika.westerberg@linux.intel.com>
Signed-off-by: Wolfram Sang <wsa@the-dreams.de>
2014-05-20 06:59:23 -06:00
|
|
|
acpi_i2c_remove_space_handler(adap);
|
2008-01-27 10:14:49 -07:00
|
|
|
/* Tell drivers about this removal */
|
2009-06-19 08:58:19 -06:00
|
|
|
mutex_lock(&core_lock);
|
2013-03-09 01:16:44 -07:00
|
|
|
bus_for_each_drv(&i2c_bus_type, NULL, adap,
|
2009-12-06 09:06:27 -07:00
|
|
|
__process_removed_adapter);
|
2009-06-19 08:58:19 -06:00
|
|
|
mutex_unlock(&core_lock);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2009-11-26 01:22:33 -07:00
|
|
|
/* Remove devices instantiated from sysfs */
|
2012-09-10 02:14:02 -06:00
|
|
|
mutex_lock_nested(&adap->userspace_clients_lock,
|
|
|
|
i2c_adapter_depth(adap));
|
2010-05-04 03:09:28 -06:00
|
|
|
list_for_each_entry_safe(client, next, &adap->userspace_clients,
|
|
|
|
detected) {
|
|
|
|
dev_dbg(&adap->dev, "Removing %s at 0x%x\n", client->name,
|
|
|
|
client->addr);
|
|
|
|
list_del(&client->detected);
|
|
|
|
i2c_unregister_device(client);
|
2009-11-26 01:22:33 -07:00
|
|
|
}
|
2010-08-11 10:21:01 -06:00
|
|
|
mutex_unlock(&adap->userspace_clients_lock);
|
2009-11-26 01:22:33 -07:00
|
|
|
|
2009-06-19 08:58:19 -06:00
|
|
|
/* Detach any active clients. This can't fail, thus we do not
|
2011-01-14 14:03:49 -07:00
|
|
|
* check the returned value. This is a two-pass process, because
|
|
|
|
* we can't remove the dummy devices during the first pass: they
|
|
|
|
* could have been instantiated by real devices wishing to clean
|
|
|
|
* them up properly, so we give them a chance to do that first. */
|
2013-03-09 01:16:44 -07:00
|
|
|
device_for_each_child(&adap->dev, NULL, __unregister_client);
|
|
|
|
device_for_each_child(&adap->dev, NULL, __unregister_dummy);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2009-09-18 14:45:46 -06:00
|
|
|
#ifdef CONFIG_I2C_COMPAT
|
|
|
|
class_compat_remove_link(i2c_adapter_compat_class, &adap->dev,
|
|
|
|
adap->dev.parent);
|
|
|
|
#endif
|
|
|
|
|
2010-01-16 12:43:13 -07:00
|
|
|
/* device name is gone after device_unregister */
|
|
|
|
dev_dbg(&adap->dev, "adapter [%s] unregistered\n", adap->name);
|
|
|
|
|
2015-12-23 10:19:28 -07:00
|
|
|
pm_runtime_disable(&adap->dev);
|
|
|
|
|
2015-01-29 14:45:09 -07:00
|
|
|
/* wait until all references to the device are gone
|
|
|
|
*
|
|
|
|
* FIXME: This is old code and should ideally be replaced by an
|
|
|
|
* alternative which results in decoupling the lifetime of the struct
|
|
|
|
* device from the i2c_adapter, like spi or netdev do. Any solution
|
2015-05-18 10:54:01 -06:00
|
|
|
* should be thoroughly tested with DEBUG_KOBJECT_RELEASE enabled!
|
2015-01-29 14:45:09 -07:00
|
|
|
*/
|
2005-04-16 16:20:36 -06:00
|
|
|
init_completion(&adap->dev_released);
|
|
|
|
device_unregister(&adap->dev);
|
|
|
|
wait_for_completion(&adap->dev_released);
|
|
|
|
|
2007-05-01 15:26:31 -06:00
|
|
|
/* free bus id */
|
2009-06-19 08:58:19 -06:00
|
|
|
mutex_lock(&core_lock);
|
2005-04-16 16:20:36 -06:00
|
|
|
idr_remove(&i2c_adapter_idr, adap->nr);
|
2009-06-19 08:58:19 -06:00
|
|
|
mutex_unlock(&core_lock);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2008-07-16 11:30:05 -06:00
|
|
|
/* Clear the device structure in case this adapter is ever going to be
|
|
|
|
added again */
|
|
|
|
memset(&adap->dev, 0, sizeof(adap->dev));
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_del_adapter);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2015-12-17 05:32:36 -07:00
|
|
|
/**
|
|
|
|
* i2c_parse_fw_timings - get I2C related timing parameters from firmware
|
|
|
|
* @dev: The device to scan for I2C timing properties
|
|
|
|
* @t: the i2c_timings struct to be filled with values
|
|
|
|
* @use_defaults: bool to use sane defaults derived from the I2C specification
|
|
|
|
* when properties are not found, otherwise use 0
|
|
|
|
*
|
|
|
|
* Scan the device for the generic I2C properties describing timing parameters
|
|
|
|
* for the signal and fill the given struct with the results. If a property was
|
|
|
|
* not found and use_defaults was true, then maximum timings are assumed which
|
|
|
|
* are derived from the I2C specification. If use_defaults is not used, the
|
|
|
|
* results will be 0, so drivers can apply their own defaults later. The latter
|
|
|
|
* is mainly intended for avoiding regressions of existing drivers which want
|
|
|
|
* to switch to this function. New drivers almost always should use the defaults.
|
|
|
|
*/
|
|
|
|
|
|
|
|
void i2c_parse_fw_timings(struct device *dev, struct i2c_timings *t, bool use_defaults)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
memset(t, 0, sizeof(*t));
|
|
|
|
|
|
|
|
ret = device_property_read_u32(dev, "clock-frequency", &t->bus_freq_hz);
|
|
|
|
if (ret && use_defaults)
|
|
|
|
t->bus_freq_hz = 100000;
|
|
|
|
|
|
|
|
ret = device_property_read_u32(dev, "i2c-scl-rising-time-ns", &t->scl_rise_ns);
|
|
|
|
if (ret && use_defaults) {
|
|
|
|
if (t->bus_freq_hz <= 100000)
|
|
|
|
t->scl_rise_ns = 1000;
|
|
|
|
else if (t->bus_freq_hz <= 400000)
|
|
|
|
t->scl_rise_ns = 300;
|
|
|
|
else
|
|
|
|
t->scl_rise_ns = 120;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = device_property_read_u32(dev, "i2c-scl-falling-time-ns", &t->scl_fall_ns);
|
|
|
|
if (ret && use_defaults) {
|
|
|
|
if (t->bus_freq_hz <= 400000)
|
|
|
|
t->scl_fall_ns = 300;
|
|
|
|
else
|
|
|
|
t->scl_fall_ns = 120;
|
|
|
|
}
|
|
|
|
|
|
|
|
device_property_read_u32(dev, "i2c-scl-internal-delay-ns", &t->scl_int_delay_ns);
|
|
|
|
|
|
|
|
ret = device_property_read_u32(dev, "i2c-sda-falling-time-ns", &t->sda_fall_ns);
|
|
|
|
if (ret && use_defaults)
|
|
|
|
t->sda_fall_ns = t->scl_fall_ns;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(i2c_parse_fw_timings);
|
|
|
|
|
2007-05-01 15:26:30 -06:00
|
|
|
/* ------------------------------------------------------------------------- */
|
|
|
|
|
2011-03-20 07:50:52 -06:00
|
|
|
int i2c_for_each_dev(void *data, int (*fn)(struct device *, void *))
|
|
|
|
{
|
|
|
|
int res;
|
|
|
|
|
|
|
|
mutex_lock(&core_lock);
|
|
|
|
res = bus_for_each_dev(&i2c_bus_type, NULL, data, fn);
|
|
|
|
mutex_unlock(&core_lock);
|
|
|
|
|
|
|
|
return res;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(i2c_for_each_dev);
|
|
|
|
|
2009-12-06 09:06:27 -07:00
|
|
|
static int __process_new_driver(struct device *dev, void *data)
|
2008-07-14 14:38:19 -06:00
|
|
|
{
|
2009-09-18 14:45:46 -06:00
|
|
|
if (dev->type != &i2c_adapter_type)
|
|
|
|
return 0;
|
2009-12-06 09:06:27 -07:00
|
|
|
return i2c_do_add_adapter(data, to_i2c_adapter(dev));
|
2008-07-14 14:38:19 -06:00
|
|
|
}
|
|
|
|
|
2007-05-01 15:26:30 -06:00
|
|
|
/*
|
|
|
|
* An i2c_driver is used with one or more i2c_client (device) nodes to access
|
2009-06-19 08:58:18 -06:00
|
|
|
* i2c slave chips, on a bus instance associated with some i2c_adapter.
|
2005-04-16 16:20:36 -06:00
|
|
|
*/
|
|
|
|
|
2005-12-06 16:33:15 -07:00
|
|
|
int i2c_register_driver(struct module *owner, struct i2c_driver *driver)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2006-02-05 15:28:21 -07:00
|
|
|
int res;
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2008-10-14 09:30:05 -06:00
|
|
|
/* Can't register until after driver model init */
|
2016-03-07 04:49:17 -07:00
|
|
|
if (WARN_ON(!is_registered))
|
2008-10-14 09:30:05 -06:00
|
|
|
return -EAGAIN;
|
|
|
|
|
2005-04-16 16:20:36 -06:00
|
|
|
/* add the driver to the list of i2c drivers in the driver core */
|
2005-12-06 16:33:15 -07:00
|
|
|
driver->driver.owner = owner;
|
2005-04-16 16:20:36 -06:00
|
|
|
driver->driver.bus = &i2c_bus_type;
|
|
|
|
|
2009-06-19 08:58:18 -06:00
|
|
|
/* When registration returns, the driver core
|
2007-05-01 15:26:31 -06:00
|
|
|
* will have called probe() for all matching-but-unbound devices.
|
|
|
|
*/
|
2005-04-16 16:20:36 -06:00
|
|
|
res = driver_register(&driver->driver);
|
|
|
|
if (res)
|
2006-02-05 15:28:21 -07:00
|
|
|
return res;
|
2006-12-10 13:21:31 -07:00
|
|
|
|
2005-11-26 12:34:05 -07:00
|
|
|
pr_debug("i2c-core: driver [%s] registered\n", driver->driver.name);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
i2c: Add detection capability to new-style drivers
Add a mechanism to let new-style i2c drivers optionally autodetect
devices they would support on selected buses and ask i2c-core to
instantiate them. This is a replacement for legacy i2c drivers, much
cleaner.
Where drivers had to implement both a legacy i2c_driver and a
new-style i2c_driver so far, this mechanism makes it possible to get
rid of the legacy i2c_driver and implement both enumerated and
detected device support with just one (new-style) i2c_driver.
Here is a quick conversion guide for these drivers, step by step:
* Delete the legacy driver definition, registration and removal.
Delete the attach_adapter and detach_client methods of the legacy
driver.
* Change the prototype of the legacy detect function from
static int foo_detect(struct i2c_adapter *adapter, int address, int kind);
to
static int foo_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info);
* Set the new-style driver detect callback to this new function, and
set its address_data to &addr_data (addr_data is generally provided
by I2C_CLIENT_INSMOD.)
* Add the appropriate class to the new-style driver. This is
typically the class the legacy attach_adapter method was checking
for. Class checking is now mandatory (done by i2c-core.) See
<linux/i2c.h> for the list of available classes.
* Remove the i2c_client allocation and freeing from the detect
function. A pre-allocated client is now handed to you by i2c-core,
and is freed automatically.
* Make the detect function fill the type field of the i2c_board_info
structure it was passed as a parameter, and return 0, on success. If
the detection fails, return -ENODEV.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2008-07-14 14:38:36 -06:00
|
|
|
INIT_LIST_HEAD(&driver->clients);
|
|
|
|
/* Walk the adapters that are already present */
|
2011-03-20 07:50:52 -06:00
|
|
|
i2c_for_each_dev(driver, __process_new_driver);
|
2009-06-19 08:58:19 -06:00
|
|
|
|
2008-07-14 14:38:19 -06:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(i2c_register_driver);
|
|
|
|
|
2009-12-06 09:06:27 -07:00
|
|
|
static int __process_removed_driver(struct device *dev, void *data)
|
2008-07-14 14:38:19 -06:00
|
|
|
{
|
2013-03-09 01:16:44 -07:00
|
|
|
if (dev->type == &i2c_adapter_type)
|
|
|
|
i2c_do_del_adapter(data, to_i2c_adapter(dev));
|
|
|
|
return 0;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
2007-05-01 15:26:30 -06:00
|
|
|
/**
|
|
|
|
* i2c_del_driver - unregister I2C driver
|
|
|
|
* @driver: the driver being unregistered
|
2007-07-12 06:12:28 -06:00
|
|
|
* Context: can sleep
|
2007-05-01 15:26:30 -06:00
|
|
|
*/
|
2007-05-01 15:26:32 -06:00
|
|
|
void i2c_del_driver(struct i2c_driver *driver)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2011-03-20 07:50:52 -06:00
|
|
|
i2c_for_each_dev(driver, __process_removed_driver);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
|
|
|
driver_unregister(&driver->driver);
|
2005-11-26 12:34:05 -07:00
|
|
|
pr_debug("i2c-core: driver [%s] unregistered\n", driver->driver.name);
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_del_driver);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2007-05-01 15:26:30 -06:00
|
|
|
/* ------------------------------------------------------------------------- */
|
|
|
|
|
2008-01-27 10:14:48 -07:00
|
|
|
/**
|
|
|
|
* i2c_use_client - increments the reference count of the i2c client structure
|
|
|
|
* @client: the client being referenced
|
|
|
|
*
|
|
|
|
* Each live reference to a client should be refcounted. The driver model does
|
|
|
|
* that automatically as part of driver binding, so that most drivers don't
|
|
|
|
* need to do this explicitly: they hold a reference until they're unbound
|
|
|
|
* from the device.
|
|
|
|
*
|
|
|
|
* A pointer to the client with the incremented reference counter is returned.
|
|
|
|
*/
|
|
|
|
struct i2c_client *i2c_use_client(struct i2c_client *client)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2008-07-14 14:38:24 -06:00
|
|
|
if (client && get_device(&client->dev))
|
|
|
|
return client;
|
|
|
|
return NULL;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_use_client);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2008-01-27 10:14:48 -07:00
|
|
|
/**
|
|
|
|
* i2c_release_client - release a use of the i2c client structure
|
|
|
|
* @client: the client being no longer referenced
|
|
|
|
*
|
|
|
|
* Must be called when a user of a client is finished with it.
|
|
|
|
*/
|
|
|
|
void i2c_release_client(struct i2c_client *client)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2008-07-14 14:38:24 -06:00
|
|
|
if (client)
|
|
|
|
put_device(&client->dev);
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_release_client);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2008-01-27 10:14:51 -07:00
|
|
|
struct i2c_cmd_arg {
|
|
|
|
unsigned cmd;
|
|
|
|
void *arg;
|
|
|
|
};
|
|
|
|
|
|
|
|
static int i2c_cmd(struct device *dev, void *_arg)
|
|
|
|
{
|
|
|
|
struct i2c_client *client = i2c_verify_client(dev);
|
|
|
|
struct i2c_cmd_arg *arg = _arg;
|
2013-09-29 02:51:06 -06:00
|
|
|
struct i2c_driver *driver;
|
|
|
|
|
|
|
|
if (!client || !client->dev.driver)
|
|
|
|
return 0;
|
2008-01-27 10:14:51 -07:00
|
|
|
|
2013-09-29 02:51:06 -06:00
|
|
|
driver = to_i2c_driver(client->dev.driver);
|
|
|
|
if (driver->command)
|
|
|
|
driver->command(client, arg->cmd, arg->arg);
|
2008-01-27 10:14:51 -07:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2005-04-16 16:20:36 -06:00
|
|
|
void i2c_clients_command(struct i2c_adapter *adap, unsigned int cmd, void *arg)
|
|
|
|
{
|
2008-01-27 10:14:51 -07:00
|
|
|
struct i2c_cmd_arg cmd_arg;
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2008-01-27 10:14:51 -07:00
|
|
|
cmd_arg.cmd = cmd;
|
|
|
|
cmd_arg.arg = arg;
|
|
|
|
device_for_each_child(&adap->dev, &cmd_arg, i2c_cmd);
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_clients_command);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2014-10-28 14:36:03 -06:00
|
|
|
#if IS_ENABLED(CONFIG_OF_DYNAMIC)
|
|
|
|
static int of_i2c_notify(struct notifier_block *nb, unsigned long action,
|
|
|
|
void *arg)
|
|
|
|
{
|
|
|
|
struct of_reconfig_data *rd = arg;
|
|
|
|
struct i2c_adapter *adap;
|
|
|
|
struct i2c_client *client;
|
|
|
|
|
|
|
|
switch (of_reconfig_get_state_change(action, rd)) {
|
|
|
|
case OF_RECONFIG_CHANGE_ADD:
|
|
|
|
adap = of_find_i2c_adapter_by_node(rd->dn->parent);
|
|
|
|
if (adap == NULL)
|
|
|
|
return NOTIFY_OK; /* not for us */
|
|
|
|
|
2015-01-24 00:16:29 -07:00
|
|
|
if (of_node_test_and_set_flag(rd->dn, OF_POPULATED)) {
|
|
|
|
put_device(&adap->dev);
|
|
|
|
return NOTIFY_OK;
|
|
|
|
}
|
|
|
|
|
2014-10-28 14:36:03 -06:00
|
|
|
client = of_i2c_register_device(adap, rd->dn);
|
|
|
|
put_device(&adap->dev);
|
|
|
|
|
|
|
|
if (IS_ERR(client)) {
|
|
|
|
pr_err("%s: failed to create for '%s'\n",
|
|
|
|
__func__, rd->dn->full_name);
|
|
|
|
return notifier_from_errno(PTR_ERR(client));
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case OF_RECONFIG_CHANGE_REMOVE:
|
2015-01-24 00:16:29 -07:00
|
|
|
/* already depopulated? */
|
|
|
|
if (!of_node_check_flag(rd->dn, OF_POPULATED))
|
|
|
|
return NOTIFY_OK;
|
|
|
|
|
2014-10-28 14:36:03 -06:00
|
|
|
/* find our device by node */
|
|
|
|
client = of_find_i2c_device_by_node(rd->dn);
|
|
|
|
if (client == NULL)
|
|
|
|
return NOTIFY_OK; /* no? not meant for us */
|
|
|
|
|
|
|
|
/* unregister takes one ref away */
|
|
|
|
i2c_unregister_device(client);
|
|
|
|
|
|
|
|
/* and put the reference of the find */
|
|
|
|
put_device(&client->dev);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
return NOTIFY_OK;
|
|
|
|
}
|
|
|
|
static struct notifier_block i2c_of_notifier = {
|
|
|
|
.notifier_call = of_i2c_notify,
|
|
|
|
};
|
|
|
|
#else
|
|
|
|
extern struct notifier_block i2c_of_notifier;
|
|
|
|
#endif /* CONFIG_OF_DYNAMIC */
|
|
|
|
|
2005-04-16 16:20:36 -06:00
|
|
|
static int __init i2c_init(void)
|
|
|
|
{
|
|
|
|
int retval;
|
|
|
|
|
2015-03-12 10:17:59 -06:00
|
|
|
retval = of_alias_get_highest_id("i2c");
|
|
|
|
|
|
|
|
down_write(&__i2c_board_lock);
|
|
|
|
if (retval >= __i2c_first_dynamic_bus_num)
|
|
|
|
__i2c_first_dynamic_bus_num = retval + 1;
|
|
|
|
up_write(&__i2c_board_lock);
|
|
|
|
|
2005-04-16 16:20:36 -06:00
|
|
|
retval = bus_register(&i2c_bus_type);
|
|
|
|
if (retval)
|
|
|
|
return retval;
|
2016-03-14 03:41:52 -06:00
|
|
|
|
|
|
|
is_registered = true;
|
|
|
|
|
2009-09-18 14:45:46 -06:00
|
|
|
#ifdef CONFIG_I2C_COMPAT
|
|
|
|
i2c_adapter_compat_class = class_compat_register("i2c-adapter");
|
|
|
|
if (!i2c_adapter_compat_class) {
|
|
|
|
retval = -ENOMEM;
|
|
|
|
goto bus_err;
|
|
|
|
}
|
|
|
|
#endif
|
2008-01-27 10:14:52 -07:00
|
|
|
retval = i2c_add_driver(&dummy_driver);
|
|
|
|
if (retval)
|
2009-09-18 14:45:46 -06:00
|
|
|
goto class_err;
|
2014-10-28 14:36:03 -06:00
|
|
|
|
|
|
|
if (IS_ENABLED(CONFIG_OF_DYNAMIC))
|
|
|
|
WARN_ON(of_reconfig_notifier_register(&i2c_of_notifier));
|
|
|
|
|
2008-01-27 10:14:52 -07:00
|
|
|
return 0;
|
|
|
|
|
2009-09-18 14:45:46 -06:00
|
|
|
class_err:
|
|
|
|
#ifdef CONFIG_I2C_COMPAT
|
|
|
|
class_compat_unregister(i2c_adapter_compat_class);
|
2008-01-27 10:14:52 -07:00
|
|
|
bus_err:
|
2009-09-18 14:45:46 -06:00
|
|
|
#endif
|
2016-03-14 03:41:52 -06:00
|
|
|
is_registered = false;
|
2008-01-27 10:14:52 -07:00
|
|
|
bus_unregister(&i2c_bus_type);
|
|
|
|
return retval;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
static void __exit i2c_exit(void)
|
|
|
|
{
|
2014-10-28 14:36:03 -06:00
|
|
|
if (IS_ENABLED(CONFIG_OF_DYNAMIC))
|
|
|
|
WARN_ON(of_reconfig_notifier_unregister(&i2c_of_notifier));
|
2008-01-27 10:14:52 -07:00
|
|
|
i2c_del_driver(&dummy_driver);
|
2009-09-18 14:45:46 -06:00
|
|
|
#ifdef CONFIG_I2C_COMPAT
|
|
|
|
class_compat_unregister(i2c_adapter_compat_class);
|
|
|
|
#endif
|
2005-04-16 16:20:36 -06:00
|
|
|
bus_unregister(&i2c_bus_type);
|
2014-03-06 06:35:59 -07:00
|
|
|
tracepoint_synchronize_unregister();
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
2008-10-14 09:30:06 -06:00
|
|
|
/* We must initialize early, because some subsystems register i2c drivers
|
|
|
|
* in subsys_initcall() code, but are linked (and initialized) before i2c.
|
|
|
|
*/
|
|
|
|
postcore_initcall(i2c_init);
|
2005-04-16 16:20:36 -06:00
|
|
|
module_exit(i2c_exit);
|
|
|
|
|
|
|
|
/* ----------------------------------------------------
|
|
|
|
* the functional interface to the i2c busses.
|
|
|
|
* ----------------------------------------------------
|
|
|
|
*/
|
|
|
|
|
2015-01-05 15:45:59 -07:00
|
|
|
/* Check if val is exceeding the quirk IFF quirk is non 0 */
|
|
|
|
#define i2c_quirk_exceeded(val, quirk) ((quirk) && ((val) > (quirk)))
|
|
|
|
|
|
|
|
static int i2c_quirk_error(struct i2c_adapter *adap, struct i2c_msg *msg, char *err_msg)
|
|
|
|
{
|
|
|
|
dev_err_ratelimited(&adap->dev, "adapter quirk: %s (addr 0x%04x, size %u, %s)\n",
|
|
|
|
err_msg, msg->addr, msg->len,
|
|
|
|
msg->flags & I2C_M_RD ? "read" : "write");
|
|
|
|
return -EOPNOTSUPP;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int i2c_check_for_quirks(struct i2c_adapter *adap, struct i2c_msg *msgs, int num)
|
|
|
|
{
|
|
|
|
const struct i2c_adapter_quirks *q = adap->quirks;
|
|
|
|
int max_num = q->max_num_msgs, i;
|
|
|
|
bool do_len_check = true;
|
|
|
|
|
|
|
|
if (q->flags & I2C_AQ_COMB) {
|
|
|
|
max_num = 2;
|
|
|
|
|
|
|
|
/* special checks for combined messages */
|
|
|
|
if (num == 2) {
|
|
|
|
if (q->flags & I2C_AQ_COMB_WRITE_FIRST && msgs[0].flags & I2C_M_RD)
|
|
|
|
return i2c_quirk_error(adap, &msgs[0], "1st comb msg must be write");
|
|
|
|
|
|
|
|
if (q->flags & I2C_AQ_COMB_READ_SECOND && !(msgs[1].flags & I2C_M_RD))
|
|
|
|
return i2c_quirk_error(adap, &msgs[1], "2nd comb msg must be read");
|
|
|
|
|
|
|
|
if (q->flags & I2C_AQ_COMB_SAME_ADDR && msgs[0].addr != msgs[1].addr)
|
|
|
|
return i2c_quirk_error(adap, &msgs[0], "comb msg only to same addr");
|
|
|
|
|
|
|
|
if (i2c_quirk_exceeded(msgs[0].len, q->max_comb_1st_msg_len))
|
|
|
|
return i2c_quirk_error(adap, &msgs[0], "msg too long");
|
|
|
|
|
|
|
|
if (i2c_quirk_exceeded(msgs[1].len, q->max_comb_2nd_msg_len))
|
|
|
|
return i2c_quirk_error(adap, &msgs[1], "msg too long");
|
|
|
|
|
|
|
|
do_len_check = false;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (i2c_quirk_exceeded(num, max_num))
|
|
|
|
return i2c_quirk_error(adap, &msgs[0], "too many messages");
|
|
|
|
|
|
|
|
for (i = 0; i < num; i++) {
|
|
|
|
u16 len = msgs[i].len;
|
|
|
|
|
|
|
|
if (msgs[i].flags & I2C_M_RD) {
|
|
|
|
if (do_len_check && i2c_quirk_exceeded(len, q->max_read_len))
|
|
|
|
return i2c_quirk_error(adap, &msgs[i], "msg too long");
|
|
|
|
} else {
|
|
|
|
if (do_len_check && i2c_quirk_exceeded(len, q->max_write_len))
|
|
|
|
return i2c_quirk_error(adap, &msgs[i], "msg too long");
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2012-06-29 04:47:19 -06:00
|
|
|
/**
|
|
|
|
* __i2c_transfer - unlocked flavor of i2c_transfer
|
|
|
|
* @adap: Handle to I2C bus
|
|
|
|
* @msgs: One or more messages to execute before STOP is issued to
|
|
|
|
* terminate the operation; each message begins with a START.
|
|
|
|
* @num: Number of messages to be executed.
|
|
|
|
*
|
|
|
|
* Returns negative errno, else the number of messages executed.
|
|
|
|
*
|
|
|
|
* Adapter lock must be held when calling this function. No debug logging
|
|
|
|
* takes place. adap->algo->master_xfer existence isn't checked.
|
|
|
|
*/
|
|
|
|
int __i2c_transfer(struct i2c_adapter *adap, struct i2c_msg *msgs, int num)
|
|
|
|
{
|
|
|
|
unsigned long orig_jiffies;
|
|
|
|
int ret, try;
|
|
|
|
|
2015-01-05 15:45:59 -07:00
|
|
|
if (adap->quirks && i2c_check_for_quirks(adap, msgs, num))
|
|
|
|
return -EOPNOTSUPP;
|
|
|
|
|
2014-03-06 06:35:59 -07:00
|
|
|
/* i2c_trace_msg gets enabled when tracepoint i2c_transfer gets
|
|
|
|
* enabled. This is an efficient way of keeping the for-loop from
|
|
|
|
* being executed when not needed.
|
|
|
|
*/
|
|
|
|
if (static_key_false(&i2c_trace_msg)) {
|
|
|
|
int i;
|
|
|
|
for (i = 0; i < num; i++)
|
|
|
|
if (msgs[i].flags & I2C_M_RD)
|
|
|
|
trace_i2c_read(adap, &msgs[i], i);
|
|
|
|
else
|
|
|
|
trace_i2c_write(adap, &msgs[i], i);
|
|
|
|
}
|
|
|
|
|
2012-06-29 04:47:19 -06:00
|
|
|
/* Retry automatically on arbitration loss */
|
|
|
|
orig_jiffies = jiffies;
|
|
|
|
for (ret = 0, try = 0; try <= adap->retries; try++) {
|
|
|
|
ret = adap->algo->master_xfer(adap, msgs, num);
|
|
|
|
if (ret != -EAGAIN)
|
|
|
|
break;
|
|
|
|
if (time_after(jiffies, orig_jiffies + adap->timeout))
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
2014-03-06 06:35:59 -07:00
|
|
|
if (static_key_false(&i2c_trace_msg)) {
|
|
|
|
int i;
|
|
|
|
for (i = 0; i < ret; i++)
|
|
|
|
if (msgs[i].flags & I2C_M_RD)
|
|
|
|
trace_i2c_reply(adap, &msgs[i], i);
|
|
|
|
trace_i2c_result(adap, i, ret);
|
|
|
|
}
|
|
|
|
|
2012-06-29 04:47:19 -06:00
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(__i2c_transfer);
|
|
|
|
|
2008-07-14 14:38:24 -06:00
|
|
|
/**
|
|
|
|
* i2c_transfer - execute a single or combined I2C message
|
|
|
|
* @adap: Handle to I2C bus
|
|
|
|
* @msgs: One or more messages to execute before STOP is issued to
|
|
|
|
* terminate the operation; each message begins with a START.
|
|
|
|
* @num: Number of messages to be executed.
|
|
|
|
*
|
|
|
|
* Returns negative errno, else the number of messages executed.
|
|
|
|
*
|
|
|
|
* Note that there is no requirement that each message be sent to
|
|
|
|
* the same slave address, although that is the most common model.
|
|
|
|
*/
|
2009-03-28 14:34:46 -06:00
|
|
|
int i2c_transfer(struct i2c_adapter *adap, struct i2c_msg *msgs, int num)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2012-06-29 04:47:19 -06:00
|
|
|
int ret;
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2008-07-14 14:38:24 -06:00
|
|
|
/* REVISIT the fault reporting model here is weak:
|
|
|
|
*
|
|
|
|
* - When we get an error after receiving N bytes from a slave,
|
|
|
|
* there is no way to report "N".
|
|
|
|
*
|
|
|
|
* - When we get a NAK after transmitting N bytes to a slave,
|
|
|
|
* there is no way to report "N" ... or to let the master
|
|
|
|
* continue executing the rest of this combined message, if
|
|
|
|
* that's the appropriate response.
|
|
|
|
*
|
|
|
|
* - When for example "num" is two and we successfully complete
|
|
|
|
* the first message but get an error part way through the
|
|
|
|
* second, it's unclear whether that should be reported as
|
|
|
|
* one (discarding status on the second message) or errno
|
|
|
|
* (discarding status on the first one).
|
|
|
|
*/
|
|
|
|
|
2005-04-16 16:20:36 -06:00
|
|
|
if (adap->algo->master_xfer) {
|
|
|
|
#ifdef DEBUG
|
|
|
|
for (ret = 0; ret < num; ret++) {
|
|
|
|
dev_dbg(&adap->dev, "master_xfer[%d] %c, addr=0x%02x, "
|
2007-05-01 15:26:29 -06:00
|
|
|
"len=%d%s\n", ret, (msgs[ret].flags & I2C_M_RD)
|
|
|
|
? 'R' : 'W', msgs[ret].addr, msgs[ret].len,
|
|
|
|
(msgs[ret].flags & I2C_M_RECV_LEN) ? "+" : "");
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2008-01-27 10:14:50 -07:00
|
|
|
if (in_atomic() || irqs_disabled()) {
|
2010-08-11 10:20:58 -06:00
|
|
|
ret = i2c_trylock_adapter(adap);
|
2008-01-27 10:14:50 -07:00
|
|
|
if (!ret)
|
|
|
|
/* I2C activity is ongoing. */
|
|
|
|
return -EAGAIN;
|
|
|
|
} else {
|
2010-08-11 10:20:58 -06:00
|
|
|
i2c_lock_adapter(adap);
|
2008-01-27 10:14:50 -07:00
|
|
|
}
|
|
|
|
|
2012-06-29 04:47:19 -06:00
|
|
|
ret = __i2c_transfer(adap, msgs, num);
|
2010-08-11 10:20:58 -06:00
|
|
|
i2c_unlock_adapter(adap);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
|
|
|
return ret;
|
|
|
|
} else {
|
|
|
|
dev_dbg(&adap->dev, "I2C level transfers not supported\n");
|
2008-07-14 14:38:23 -06:00
|
|
|
return -EOPNOTSUPP;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_transfer);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2008-07-14 14:38:24 -06:00
|
|
|
/**
|
|
|
|
* i2c_master_send - issue a single I2C message in master transmit mode
|
|
|
|
* @client: Handle to slave device
|
|
|
|
* @buf: Data that will be written to the slave
|
2010-03-02 04:23:49 -07:00
|
|
|
* @count: How many bytes to write, must be less than 64k since msg.len is u16
|
2008-07-14 14:38:24 -06:00
|
|
|
*
|
|
|
|
* Returns negative errno, or else the number of bytes written.
|
|
|
|
*/
|
2011-01-10 14:11:23 -07:00
|
|
|
int i2c_master_send(const struct i2c_client *client, const char *buf, int count)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
|
|
|
int ret;
|
2010-05-21 10:40:58 -06:00
|
|
|
struct i2c_adapter *adap = client->adapter;
|
2005-04-16 16:20:36 -06:00
|
|
|
struct i2c_msg msg;
|
|
|
|
|
2005-05-07 14:58:46 -06:00
|
|
|
msg.addr = client->addr;
|
|
|
|
msg.flags = client->flags & I2C_M_TEN;
|
|
|
|
msg.len = count;
|
|
|
|
msg.buf = (char *)buf;
|
2006-12-10 13:21:31 -07:00
|
|
|
|
2005-05-07 14:58:46 -06:00
|
|
|
ret = i2c_transfer(adap, &msg, 1);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2012-03-15 11:11:05 -06:00
|
|
|
/*
|
|
|
|
* If everything went ok (i.e. 1 msg transmitted), return #bytes
|
|
|
|
* transmitted, else error code.
|
|
|
|
*/
|
2005-05-07 14:58:46 -06:00
|
|
|
return (ret == 1) ? count : ret;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_master_send);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2008-07-14 14:38:24 -06:00
|
|
|
/**
|
|
|
|
* i2c_master_recv - issue a single I2C message in master receive mode
|
|
|
|
* @client: Handle to slave device
|
|
|
|
* @buf: Where to store data read from slave
|
2010-03-02 04:23:49 -07:00
|
|
|
* @count: How many bytes to read, must be less than 64k since msg.len is u16
|
2008-07-14 14:38:24 -06:00
|
|
|
*
|
|
|
|
* Returns negative errno, or else the number of bytes read.
|
|
|
|
*/
|
2011-01-10 14:11:23 -07:00
|
|
|
int i2c_master_recv(const struct i2c_client *client, char *buf, int count)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2010-05-21 10:40:58 -06:00
|
|
|
struct i2c_adapter *adap = client->adapter;
|
2005-04-16 16:20:36 -06:00
|
|
|
struct i2c_msg msg;
|
|
|
|
int ret;
|
2005-05-07 14:58:46 -06:00
|
|
|
|
|
|
|
msg.addr = client->addr;
|
|
|
|
msg.flags = client->flags & I2C_M_TEN;
|
|
|
|
msg.flags |= I2C_M_RD;
|
|
|
|
msg.len = count;
|
|
|
|
msg.buf = buf;
|
|
|
|
|
|
|
|
ret = i2c_transfer(adap, &msg, 1);
|
|
|
|
|
2012-03-15 11:11:05 -06:00
|
|
|
/*
|
|
|
|
* If everything went ok (i.e. 1 msg received), return #bytes received,
|
|
|
|
* else error code.
|
|
|
|
*/
|
2005-05-07 14:58:46 -06:00
|
|
|
return (ret == 1) ? count : ret;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_master_recv);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
|
|
|
/* ----------------------------------------------------
|
|
|
|
* the i2c address scanning function
|
|
|
|
* Will not work for 10-bit addresses!
|
|
|
|
* ----------------------------------------------------
|
|
|
|
*/
|
|
|
|
|
2010-06-03 03:33:51 -06:00
|
|
|
/*
|
|
|
|
* Legacy default probe function, mostly relevant for SMBus. The default
|
|
|
|
* probe method is a quick write, but it is known to corrupt the 24RF08
|
|
|
|
* EEPROMs due to a state machine bug, and could also irreversibly
|
|
|
|
* write-protect some EEPROMs, so for address ranges 0x30-0x37 and 0x50-0x5f,
|
|
|
|
* we use a short byte read instead. Also, some bus drivers don't implement
|
|
|
|
* quick write, so we fallback to a byte read in that case too.
|
|
|
|
* On x86, there is another special case for FSC hardware monitoring chips,
|
|
|
|
* which want regular byte reads (address 0x73.) Fortunately, these are the
|
|
|
|
* only known chips using this I2C address on PC hardware.
|
|
|
|
* Returns 1 if probe succeeded, 0 if not.
|
|
|
|
*/
|
|
|
|
static int i2c_default_probe(struct i2c_adapter *adap, unsigned short addr)
|
|
|
|
{
|
|
|
|
int err;
|
|
|
|
union i2c_smbus_data dummy;
|
|
|
|
|
|
|
|
#ifdef CONFIG_X86
|
|
|
|
if (addr == 0x73 && (adap->class & I2C_CLASS_HWMON)
|
|
|
|
&& i2c_check_functionality(adap, I2C_FUNC_SMBUS_READ_BYTE_DATA))
|
|
|
|
err = i2c_smbus_xfer(adap, addr, 0, I2C_SMBUS_READ, 0,
|
|
|
|
I2C_SMBUS_BYTE_DATA, &dummy);
|
|
|
|
else
|
|
|
|
#endif
|
2010-08-11 10:21:00 -06:00
|
|
|
if (!((addr & ~0x07) == 0x30 || (addr & ~0x0f) == 0x50)
|
|
|
|
&& i2c_check_functionality(adap, I2C_FUNC_SMBUS_QUICK))
|
2010-06-03 03:33:51 -06:00
|
|
|
err = i2c_smbus_xfer(adap, addr, 0, I2C_SMBUS_WRITE, 0,
|
|
|
|
I2C_SMBUS_QUICK, NULL);
|
2010-08-11 10:21:00 -06:00
|
|
|
else if (i2c_check_functionality(adap, I2C_FUNC_SMBUS_READ_BYTE))
|
|
|
|
err = i2c_smbus_xfer(adap, addr, 0, I2C_SMBUS_READ, 0,
|
|
|
|
I2C_SMBUS_BYTE, &dummy);
|
|
|
|
else {
|
2013-07-17 14:27:59 -06:00
|
|
|
dev_warn(&adap->dev, "No suitable probing method supported for address 0x%02X\n",
|
|
|
|
addr);
|
2010-08-11 10:21:00 -06:00
|
|
|
err = -EOPNOTSUPP;
|
|
|
|
}
|
2010-06-03 03:33:51 -06:00
|
|
|
|
|
|
|
return err >= 0;
|
|
|
|
}
|
|
|
|
|
2009-12-06 09:06:25 -07:00
|
|
|
static int i2c_detect_address(struct i2c_client *temp_client,
|
i2c: Add detection capability to new-style drivers
Add a mechanism to let new-style i2c drivers optionally autodetect
devices they would support on selected buses and ask i2c-core to
instantiate them. This is a replacement for legacy i2c drivers, much
cleaner.
Where drivers had to implement both a legacy i2c_driver and a
new-style i2c_driver so far, this mechanism makes it possible to get
rid of the legacy i2c_driver and implement both enumerated and
detected device support with just one (new-style) i2c_driver.
Here is a quick conversion guide for these drivers, step by step:
* Delete the legacy driver definition, registration and removal.
Delete the attach_adapter and detach_client methods of the legacy
driver.
* Change the prototype of the legacy detect function from
static int foo_detect(struct i2c_adapter *adapter, int address, int kind);
to
static int foo_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info);
* Set the new-style driver detect callback to this new function, and
set its address_data to &addr_data (addr_data is generally provided
by I2C_CLIENT_INSMOD.)
* Add the appropriate class to the new-style driver. This is
typically the class the legacy attach_adapter method was checking
for. Class checking is now mandatory (done by i2c-core.) See
<linux/i2c.h> for the list of available classes.
* Remove the i2c_client allocation and freeing from the detect
function. A pre-allocated client is now handed to you by i2c-core,
and is freed automatically.
* Make the detect function fill the type field of the i2c_board_info
structure it was passed as a parameter, and return 0, on success. If
the detection fails, return -ENODEV.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2008-07-14 14:38:36 -06:00
|
|
|
struct i2c_driver *driver)
|
|
|
|
{
|
|
|
|
struct i2c_board_info info;
|
|
|
|
struct i2c_adapter *adapter = temp_client->adapter;
|
|
|
|
int addr = temp_client->addr;
|
|
|
|
int err;
|
|
|
|
|
|
|
|
/* Make sure the address is valid */
|
2015-07-17 04:43:22 -06:00
|
|
|
err = i2c_check_7bit_addr_validity_strict(addr);
|
2010-06-03 03:33:53 -06:00
|
|
|
if (err) {
|
i2c: Add detection capability to new-style drivers
Add a mechanism to let new-style i2c drivers optionally autodetect
devices they would support on selected buses and ask i2c-core to
instantiate them. This is a replacement for legacy i2c drivers, much
cleaner.
Where drivers had to implement both a legacy i2c_driver and a
new-style i2c_driver so far, this mechanism makes it possible to get
rid of the legacy i2c_driver and implement both enumerated and
detected device support with just one (new-style) i2c_driver.
Here is a quick conversion guide for these drivers, step by step:
* Delete the legacy driver definition, registration and removal.
Delete the attach_adapter and detach_client methods of the legacy
driver.
* Change the prototype of the legacy detect function from
static int foo_detect(struct i2c_adapter *adapter, int address, int kind);
to
static int foo_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info);
* Set the new-style driver detect callback to this new function, and
set its address_data to &addr_data (addr_data is generally provided
by I2C_CLIENT_INSMOD.)
* Add the appropriate class to the new-style driver. This is
typically the class the legacy attach_adapter method was checking
for. Class checking is now mandatory (done by i2c-core.) See
<linux/i2c.h> for the list of available classes.
* Remove the i2c_client allocation and freeing from the detect
function. A pre-allocated client is now handed to you by i2c-core,
and is freed automatically.
* Make the detect function fill the type field of the i2c_board_info
structure it was passed as a parameter, and return 0, on success. If
the detection fails, return -ENODEV.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2008-07-14 14:38:36 -06:00
|
|
|
dev_warn(&adapter->dev, "Invalid probe address 0x%02x\n",
|
|
|
|
addr);
|
2010-06-03 03:33:53 -06:00
|
|
|
return err;
|
i2c: Add detection capability to new-style drivers
Add a mechanism to let new-style i2c drivers optionally autodetect
devices they would support on selected buses and ask i2c-core to
instantiate them. This is a replacement for legacy i2c drivers, much
cleaner.
Where drivers had to implement both a legacy i2c_driver and a
new-style i2c_driver so far, this mechanism makes it possible to get
rid of the legacy i2c_driver and implement both enumerated and
detected device support with just one (new-style) i2c_driver.
Here is a quick conversion guide for these drivers, step by step:
* Delete the legacy driver definition, registration and removal.
Delete the attach_adapter and detach_client methods of the legacy
driver.
* Change the prototype of the legacy detect function from
static int foo_detect(struct i2c_adapter *adapter, int address, int kind);
to
static int foo_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info);
* Set the new-style driver detect callback to this new function, and
set its address_data to &addr_data (addr_data is generally provided
by I2C_CLIENT_INSMOD.)
* Add the appropriate class to the new-style driver. This is
typically the class the legacy attach_adapter method was checking
for. Class checking is now mandatory (done by i2c-core.) See
<linux/i2c.h> for the list of available classes.
* Remove the i2c_client allocation and freeing from the detect
function. A pre-allocated client is now handed to you by i2c-core,
and is freed automatically.
* Make the detect function fill the type field of the i2c_board_info
structure it was passed as a parameter, and return 0, on success. If
the detection fails, return -ENODEV.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2008-07-14 14:38:36 -06:00
|
|
|
}
|
|
|
|
|
2015-07-17 06:48:56 -06:00
|
|
|
/* Skip if already in use (7 bit, no need to encode flags) */
|
2010-06-03 03:33:55 -06:00
|
|
|
if (i2c_check_addr_busy(adapter, addr))
|
i2c: Add detection capability to new-style drivers
Add a mechanism to let new-style i2c drivers optionally autodetect
devices they would support on selected buses and ask i2c-core to
instantiate them. This is a replacement for legacy i2c drivers, much
cleaner.
Where drivers had to implement both a legacy i2c_driver and a
new-style i2c_driver so far, this mechanism makes it possible to get
rid of the legacy i2c_driver and implement both enumerated and
detected device support with just one (new-style) i2c_driver.
Here is a quick conversion guide for these drivers, step by step:
* Delete the legacy driver definition, registration and removal.
Delete the attach_adapter and detach_client methods of the legacy
driver.
* Change the prototype of the legacy detect function from
static int foo_detect(struct i2c_adapter *adapter, int address, int kind);
to
static int foo_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info);
* Set the new-style driver detect callback to this new function, and
set its address_data to &addr_data (addr_data is generally provided
by I2C_CLIENT_INSMOD.)
* Add the appropriate class to the new-style driver. This is
typically the class the legacy attach_adapter method was checking
for. Class checking is now mandatory (done by i2c-core.) See
<linux/i2c.h> for the list of available classes.
* Remove the i2c_client allocation and freeing from the detect
function. A pre-allocated client is now handed to you by i2c-core,
and is freed automatically.
* Make the detect function fill the type field of the i2c_board_info
structure it was passed as a parameter, and return 0, on success. If
the detection fails, return -ENODEV.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2008-07-14 14:38:36 -06:00
|
|
|
return 0;
|
|
|
|
|
2009-12-06 09:06:25 -07:00
|
|
|
/* Make sure there is something at this address */
|
2010-06-03 03:33:51 -06:00
|
|
|
if (!i2c_default_probe(adapter, addr))
|
|
|
|
return 0;
|
i2c: Add detection capability to new-style drivers
Add a mechanism to let new-style i2c drivers optionally autodetect
devices they would support on selected buses and ask i2c-core to
instantiate them. This is a replacement for legacy i2c drivers, much
cleaner.
Where drivers had to implement both a legacy i2c_driver and a
new-style i2c_driver so far, this mechanism makes it possible to get
rid of the legacy i2c_driver and implement both enumerated and
detected device support with just one (new-style) i2c_driver.
Here is a quick conversion guide for these drivers, step by step:
* Delete the legacy driver definition, registration and removal.
Delete the attach_adapter and detach_client methods of the legacy
driver.
* Change the prototype of the legacy detect function from
static int foo_detect(struct i2c_adapter *adapter, int address, int kind);
to
static int foo_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info);
* Set the new-style driver detect callback to this new function, and
set its address_data to &addr_data (addr_data is generally provided
by I2C_CLIENT_INSMOD.)
* Add the appropriate class to the new-style driver. This is
typically the class the legacy attach_adapter method was checking
for. Class checking is now mandatory (done by i2c-core.) See
<linux/i2c.h> for the list of available classes.
* Remove the i2c_client allocation and freeing from the detect
function. A pre-allocated client is now handed to you by i2c-core,
and is freed automatically.
* Make the detect function fill the type field of the i2c_board_info
structure it was passed as a parameter, and return 0, on success. If
the detection fails, return -ENODEV.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2008-07-14 14:38:36 -06:00
|
|
|
|
|
|
|
/* Finally call the custom detection function */
|
|
|
|
memset(&info, 0, sizeof(struct i2c_board_info));
|
|
|
|
info.addr = addr;
|
2009-12-14 13:17:23 -07:00
|
|
|
err = driver->detect(temp_client, &info);
|
i2c: Add detection capability to new-style drivers
Add a mechanism to let new-style i2c drivers optionally autodetect
devices they would support on selected buses and ask i2c-core to
instantiate them. This is a replacement for legacy i2c drivers, much
cleaner.
Where drivers had to implement both a legacy i2c_driver and a
new-style i2c_driver so far, this mechanism makes it possible to get
rid of the legacy i2c_driver and implement both enumerated and
detected device support with just one (new-style) i2c_driver.
Here is a quick conversion guide for these drivers, step by step:
* Delete the legacy driver definition, registration and removal.
Delete the attach_adapter and detach_client methods of the legacy
driver.
* Change the prototype of the legacy detect function from
static int foo_detect(struct i2c_adapter *adapter, int address, int kind);
to
static int foo_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info);
* Set the new-style driver detect callback to this new function, and
set its address_data to &addr_data (addr_data is generally provided
by I2C_CLIENT_INSMOD.)
* Add the appropriate class to the new-style driver. This is
typically the class the legacy attach_adapter method was checking
for. Class checking is now mandatory (done by i2c-core.) See
<linux/i2c.h> for the list of available classes.
* Remove the i2c_client allocation and freeing from the detect
function. A pre-allocated client is now handed to you by i2c-core,
and is freed automatically.
* Make the detect function fill the type field of the i2c_board_info
structure it was passed as a parameter, and return 0, on success. If
the detection fails, return -ENODEV.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2008-07-14 14:38:36 -06:00
|
|
|
if (err) {
|
|
|
|
/* -ENODEV is returned if the detection fails. We catch it
|
|
|
|
here as this isn't an error. */
|
|
|
|
return err == -ENODEV ? 0 : err;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Consistency check */
|
|
|
|
if (info.type[0] == '\0') {
|
|
|
|
dev_err(&adapter->dev, "%s detection function provided "
|
|
|
|
"no name for 0x%x\n", driver->driver.name,
|
|
|
|
addr);
|
|
|
|
} else {
|
|
|
|
struct i2c_client *client;
|
|
|
|
|
|
|
|
/* Detection succeeded, instantiate the device */
|
2014-02-10 03:03:56 -07:00
|
|
|
if (adapter->class & I2C_CLASS_DEPRECATED)
|
|
|
|
dev_warn(&adapter->dev,
|
|
|
|
"This adapter will soon drop class based instantiation of devices. "
|
|
|
|
"Please make sure client 0x%02x gets instantiated by other means. "
|
|
|
|
"Check 'Documentation/i2c/instantiating-devices' for details.\n",
|
|
|
|
info.addr);
|
|
|
|
|
i2c: Add detection capability to new-style drivers
Add a mechanism to let new-style i2c drivers optionally autodetect
devices they would support on selected buses and ask i2c-core to
instantiate them. This is a replacement for legacy i2c drivers, much
cleaner.
Where drivers had to implement both a legacy i2c_driver and a
new-style i2c_driver so far, this mechanism makes it possible to get
rid of the legacy i2c_driver and implement both enumerated and
detected device support with just one (new-style) i2c_driver.
Here is a quick conversion guide for these drivers, step by step:
* Delete the legacy driver definition, registration and removal.
Delete the attach_adapter and detach_client methods of the legacy
driver.
* Change the prototype of the legacy detect function from
static int foo_detect(struct i2c_adapter *adapter, int address, int kind);
to
static int foo_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info);
* Set the new-style driver detect callback to this new function, and
set its address_data to &addr_data (addr_data is generally provided
by I2C_CLIENT_INSMOD.)
* Add the appropriate class to the new-style driver. This is
typically the class the legacy attach_adapter method was checking
for. Class checking is now mandatory (done by i2c-core.) See
<linux/i2c.h> for the list of available classes.
* Remove the i2c_client allocation and freeing from the detect
function. A pre-allocated client is now handed to you by i2c-core,
and is freed automatically.
* Make the detect function fill the type field of the i2c_board_info
structure it was passed as a parameter, and return 0, on success. If
the detection fails, return -ENODEV.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2008-07-14 14:38:36 -06:00
|
|
|
dev_dbg(&adapter->dev, "Creating %s at 0x%02x\n",
|
|
|
|
info.type, info.addr);
|
|
|
|
client = i2c_new_device(adapter, &info);
|
|
|
|
if (client)
|
|
|
|
list_add_tail(&client->detected, &driver->clients);
|
|
|
|
else
|
|
|
|
dev_err(&adapter->dev, "Failed creating %s at 0x%02x\n",
|
|
|
|
info.type, info.addr);
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int i2c_detect(struct i2c_adapter *adapter, struct i2c_driver *driver)
|
|
|
|
{
|
2009-12-14 13:17:25 -07:00
|
|
|
const unsigned short *address_list;
|
i2c: Add detection capability to new-style drivers
Add a mechanism to let new-style i2c drivers optionally autodetect
devices they would support on selected buses and ask i2c-core to
instantiate them. This is a replacement for legacy i2c drivers, much
cleaner.
Where drivers had to implement both a legacy i2c_driver and a
new-style i2c_driver so far, this mechanism makes it possible to get
rid of the legacy i2c_driver and implement both enumerated and
detected device support with just one (new-style) i2c_driver.
Here is a quick conversion guide for these drivers, step by step:
* Delete the legacy driver definition, registration and removal.
Delete the attach_adapter and detach_client methods of the legacy
driver.
* Change the prototype of the legacy detect function from
static int foo_detect(struct i2c_adapter *adapter, int address, int kind);
to
static int foo_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info);
* Set the new-style driver detect callback to this new function, and
set its address_data to &addr_data (addr_data is generally provided
by I2C_CLIENT_INSMOD.)
* Add the appropriate class to the new-style driver. This is
typically the class the legacy attach_adapter method was checking
for. Class checking is now mandatory (done by i2c-core.) See
<linux/i2c.h> for the list of available classes.
* Remove the i2c_client allocation and freeing from the detect
function. A pre-allocated client is now handed to you by i2c-core,
and is freed automatically.
* Make the detect function fill the type field of the i2c_board_info
structure it was passed as a parameter, and return 0, on success. If
the detection fails, return -ENODEV.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2008-07-14 14:38:36 -06:00
|
|
|
struct i2c_client *temp_client;
|
|
|
|
int i, err = 0;
|
|
|
|
int adap_id = i2c_adapter_id(adapter);
|
|
|
|
|
2009-12-14 13:17:25 -07:00
|
|
|
address_list = driver->address_list;
|
|
|
|
if (!driver->detect || !address_list)
|
i2c: Add detection capability to new-style drivers
Add a mechanism to let new-style i2c drivers optionally autodetect
devices they would support on selected buses and ask i2c-core to
instantiate them. This is a replacement for legacy i2c drivers, much
cleaner.
Where drivers had to implement both a legacy i2c_driver and a
new-style i2c_driver so far, this mechanism makes it possible to get
rid of the legacy i2c_driver and implement both enumerated and
detected device support with just one (new-style) i2c_driver.
Here is a quick conversion guide for these drivers, step by step:
* Delete the legacy driver definition, registration and removal.
Delete the attach_adapter and detach_client methods of the legacy
driver.
* Change the prototype of the legacy detect function from
static int foo_detect(struct i2c_adapter *adapter, int address, int kind);
to
static int foo_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info);
* Set the new-style driver detect callback to this new function, and
set its address_data to &addr_data (addr_data is generally provided
by I2C_CLIENT_INSMOD.)
* Add the appropriate class to the new-style driver. This is
typically the class the legacy attach_adapter method was checking
for. Class checking is now mandatory (done by i2c-core.) See
<linux/i2c.h> for the list of available classes.
* Remove the i2c_client allocation and freeing from the detect
function. A pre-allocated client is now handed to you by i2c-core,
and is freed automatically.
* Make the detect function fill the type field of the i2c_board_info
structure it was passed as a parameter, and return 0, on success. If
the detection fails, return -ENODEV.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2008-07-14 14:38:36 -06:00
|
|
|
return 0;
|
|
|
|
|
2014-07-10 05:46:21 -06:00
|
|
|
/* Warn that the adapter lost class based instantiation */
|
|
|
|
if (adapter->class == I2C_CLASS_DEPRECATED) {
|
|
|
|
dev_dbg(&adapter->dev,
|
|
|
|
"This adapter dropped support for I2C classes and "
|
|
|
|
"won't auto-detect %s devices anymore. If you need it, check "
|
|
|
|
"'Documentation/i2c/instantiating-devices' for alternatives.\n",
|
|
|
|
driver->driver.name);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2010-10-24 10:16:58 -06:00
|
|
|
/* Stop here if the classes do not match */
|
|
|
|
if (!(adapter->class & driver->class))
|
|
|
|
return 0;
|
|
|
|
|
i2c: Add detection capability to new-style drivers
Add a mechanism to let new-style i2c drivers optionally autodetect
devices they would support on selected buses and ask i2c-core to
instantiate them. This is a replacement for legacy i2c drivers, much
cleaner.
Where drivers had to implement both a legacy i2c_driver and a
new-style i2c_driver so far, this mechanism makes it possible to get
rid of the legacy i2c_driver and implement both enumerated and
detected device support with just one (new-style) i2c_driver.
Here is a quick conversion guide for these drivers, step by step:
* Delete the legacy driver definition, registration and removal.
Delete the attach_adapter and detach_client methods of the legacy
driver.
* Change the prototype of the legacy detect function from
static int foo_detect(struct i2c_adapter *adapter, int address, int kind);
to
static int foo_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info);
* Set the new-style driver detect callback to this new function, and
set its address_data to &addr_data (addr_data is generally provided
by I2C_CLIENT_INSMOD.)
* Add the appropriate class to the new-style driver. This is
typically the class the legacy attach_adapter method was checking
for. Class checking is now mandatory (done by i2c-core.) See
<linux/i2c.h> for the list of available classes.
* Remove the i2c_client allocation and freeing from the detect
function. A pre-allocated client is now handed to you by i2c-core,
and is freed automatically.
* Make the detect function fill the type field of the i2c_board_info
structure it was passed as a parameter, and return 0, on success. If
the detection fails, return -ENODEV.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2008-07-14 14:38:36 -06:00
|
|
|
/* Set up a temporary client to help detect callback */
|
|
|
|
temp_client = kzalloc(sizeof(struct i2c_client), GFP_KERNEL);
|
|
|
|
if (!temp_client)
|
|
|
|
return -ENOMEM;
|
|
|
|
temp_client->adapter = adapter;
|
|
|
|
|
2009-12-14 13:17:25 -07:00
|
|
|
for (i = 0; address_list[i] != I2C_CLIENT_END; i += 1) {
|
i2c: Add detection capability to new-style drivers
Add a mechanism to let new-style i2c drivers optionally autodetect
devices they would support on selected buses and ask i2c-core to
instantiate them. This is a replacement for legacy i2c drivers, much
cleaner.
Where drivers had to implement both a legacy i2c_driver and a
new-style i2c_driver so far, this mechanism makes it possible to get
rid of the legacy i2c_driver and implement both enumerated and
detected device support with just one (new-style) i2c_driver.
Here is a quick conversion guide for these drivers, step by step:
* Delete the legacy driver definition, registration and removal.
Delete the attach_adapter and detach_client methods of the legacy
driver.
* Change the prototype of the legacy detect function from
static int foo_detect(struct i2c_adapter *adapter, int address, int kind);
to
static int foo_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info);
* Set the new-style driver detect callback to this new function, and
set its address_data to &addr_data (addr_data is generally provided
by I2C_CLIENT_INSMOD.)
* Add the appropriate class to the new-style driver. This is
typically the class the legacy attach_adapter method was checking
for. Class checking is now mandatory (done by i2c-core.) See
<linux/i2c.h> for the list of available classes.
* Remove the i2c_client allocation and freeing from the detect
function. A pre-allocated client is now handed to you by i2c-core,
and is freed automatically.
* Make the detect function fill the type field of the i2c_board_info
structure it was passed as a parameter, and return 0, on success. If
the detection fails, return -ENODEV.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2008-07-14 14:38:36 -06:00
|
|
|
dev_dbg(&adapter->dev, "found normal entry for adapter %d, "
|
2009-12-14 13:17:25 -07:00
|
|
|
"addr 0x%02x\n", adap_id, address_list[i]);
|
|
|
|
temp_client->addr = address_list[i];
|
2009-12-06 09:06:25 -07:00
|
|
|
err = i2c_detect_address(temp_client, driver);
|
2010-10-24 10:16:58 -06:00
|
|
|
if (unlikely(err))
|
|
|
|
break;
|
i2c: Add detection capability to new-style drivers
Add a mechanism to let new-style i2c drivers optionally autodetect
devices they would support on selected buses and ask i2c-core to
instantiate them. This is a replacement for legacy i2c drivers, much
cleaner.
Where drivers had to implement both a legacy i2c_driver and a
new-style i2c_driver so far, this mechanism makes it possible to get
rid of the legacy i2c_driver and implement both enumerated and
detected device support with just one (new-style) i2c_driver.
Here is a quick conversion guide for these drivers, step by step:
* Delete the legacy driver definition, registration and removal.
Delete the attach_adapter and detach_client methods of the legacy
driver.
* Change the prototype of the legacy detect function from
static int foo_detect(struct i2c_adapter *adapter, int address, int kind);
to
static int foo_detect(struct i2c_client *client, int kind,
struct i2c_board_info *info);
* Set the new-style driver detect callback to this new function, and
set its address_data to &addr_data (addr_data is generally provided
by I2C_CLIENT_INSMOD.)
* Add the appropriate class to the new-style driver. This is
typically the class the legacy attach_adapter method was checking
for. Class checking is now mandatory (done by i2c-core.) See
<linux/i2c.h> for the list of available classes.
* Remove the i2c_client allocation and freeing from the detect
function. A pre-allocated client is now handed to you by i2c-core,
and is freed automatically.
* Make the detect function fill the type field of the i2c_board_info
structure it was passed as a parameter, and return 0, on success. If
the detection fails, return -ENODEV.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2008-07-14 14:38:36 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
kfree(temp_client);
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2010-08-11 10:20:57 -06:00
|
|
|
int i2c_probe_func_quick_read(struct i2c_adapter *adap, unsigned short addr)
|
|
|
|
{
|
|
|
|
return i2c_smbus_xfer(adap, addr, 0, I2C_SMBUS_READ, 0,
|
|
|
|
I2C_SMBUS_QUICK, NULL) >= 0;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(i2c_probe_func_quick_read);
|
|
|
|
|
2007-05-01 15:26:31 -06:00
|
|
|
struct i2c_client *
|
|
|
|
i2c_new_probed_device(struct i2c_adapter *adap,
|
|
|
|
struct i2c_board_info *info,
|
2010-08-11 10:20:56 -06:00
|
|
|
unsigned short const *addr_list,
|
|
|
|
int (*probe)(struct i2c_adapter *, unsigned short addr))
|
2007-05-01 15:26:31 -06:00
|
|
|
{
|
|
|
|
int i;
|
|
|
|
|
2010-08-11 10:21:00 -06:00
|
|
|
if (!probe)
|
2010-08-11 10:20:56 -06:00
|
|
|
probe = i2c_default_probe;
|
2007-05-01 15:26:31 -06:00
|
|
|
|
|
|
|
for (i = 0; addr_list[i] != I2C_CLIENT_END; i++) {
|
|
|
|
/* Check address validity */
|
2015-07-17 04:43:22 -06:00
|
|
|
if (i2c_check_7bit_addr_validity_strict(addr_list[i]) < 0) {
|
2007-05-01 15:26:31 -06:00
|
|
|
dev_warn(&adap->dev, "Invalid 7-bit address "
|
|
|
|
"0x%02x\n", addr_list[i]);
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
|
2015-07-17 06:48:56 -06:00
|
|
|
/* Check address availability (7 bit, no need to encode flags) */
|
2010-06-03 03:33:55 -06:00
|
|
|
if (i2c_check_addr_busy(adap, addr_list[i])) {
|
2007-05-01 15:26:31 -06:00
|
|
|
dev_dbg(&adap->dev, "Address 0x%02x already in "
|
|
|
|
"use, not probing\n", addr_list[i]);
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
|
2010-06-03 03:33:51 -06:00
|
|
|
/* Test address responsiveness */
|
2010-08-11 10:20:56 -06:00
|
|
|
if (probe(adap, addr_list[i]))
|
2010-06-03 03:33:51 -06:00
|
|
|
break;
|
2007-05-01 15:26:31 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
if (addr_list[i] == I2C_CLIENT_END) {
|
|
|
|
dev_dbg(&adap->dev, "Probing failed, no device found\n");
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
info->addr = addr_list[i];
|
|
|
|
return i2c_new_device(adap, info);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(i2c_new_probed_device);
|
|
|
|
|
2011-03-20 07:50:52 -06:00
|
|
|
struct i2c_adapter *i2c_get_adapter(int nr)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
|
|
|
struct i2c_adapter *adapter;
|
2006-12-10 13:21:31 -07:00
|
|
|
|
2008-01-27 10:14:49 -07:00
|
|
|
mutex_lock(&core_lock);
|
2011-03-20 07:50:52 -06:00
|
|
|
adapter = idr_find(&i2c_adapter_idr, nr);
|
2015-07-27 08:30:49 -06:00
|
|
|
if (!adapter)
|
|
|
|
goto exit;
|
|
|
|
|
|
|
|
if (try_module_get(adapter->owner))
|
|
|
|
get_device(&adapter->dev);
|
|
|
|
else
|
2005-06-27 22:21:30 -06:00
|
|
|
adapter = NULL;
|
|
|
|
|
2015-07-27 08:30:49 -06:00
|
|
|
exit:
|
2008-01-27 10:14:49 -07:00
|
|
|
mutex_unlock(&core_lock);
|
2005-06-27 22:21:30 -06:00
|
|
|
return adapter;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_get_adapter);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
|
|
|
void i2c_put_adapter(struct i2c_adapter *adap)
|
|
|
|
{
|
2015-07-27 08:30:49 -06:00
|
|
|
if (!adap)
|
|
|
|
return;
|
|
|
|
|
|
|
|
put_device(&adap->dev);
|
|
|
|
module_put(adap->owner);
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_put_adapter);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
|
|
|
/* The SMBus parts */
|
|
|
|
|
2006-12-10 13:21:31 -07:00
|
|
|
#define POLY (0x1070U << 3)
|
2009-03-28 14:34:46 -06:00
|
|
|
static u8 crc8(u16 data)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
|
|
|
int i;
|
2006-12-10 13:21:31 -07:00
|
|
|
|
2010-05-21 10:40:58 -06:00
|
|
|
for (i = 0; i < 8; i++) {
|
2006-12-10 13:21:31 -07:00
|
|
|
if (data & 0x8000)
|
2005-04-16 16:20:36 -06:00
|
|
|
data = data ^ POLY;
|
|
|
|
data = data << 1;
|
|
|
|
}
|
|
|
|
return (u8)(data >> 8);
|
|
|
|
}
|
|
|
|
|
[PATCH] i2c: SMBus PEC support rewrite, 2 of 3
This is my rewrite of the SMBus PEC support. The original
implementation was known to have bugs (credits go to Hideki Iwamoto
for reporting many of them recently), and was incomplete due to a
conceptual limitation.
The rewrite affects only software PEC. Hardware PEC needs very little
code and is mostly untouched.
Technically, both implementations differ in that the original one
was emulating PEC in software by modifying the contents of an
i2c_smbus_data union (changing the transaction to a different type),
while the new one works one level lower, on i2c_msg structures (working
on message contents). Due to the definition of the i2c_smbus_data union,
not all SMBus transactions could be handled (at least not without
changing the definition of this union, which would break user-space
compatibility), and those which could had to be implemented
individually. At the opposite, adding PEC to an i2c_msg structure
can be done on any SMBus transaction with common code.
Advantages of the new implementation:
* It's about twice as small (from ~136 lines before to ~70 now, only
counting i2c-core, including blank and comment lines). The memory
used by i2c-core is down by ~640 bytes (~3.5%).
* Easier to validate, less tricky code. The code being common to all
transactions by design, the risk that a bug can stay uncovered is
lower.
* All SMBus transactions have PEC support in I2C emulation mode
(providing the non-PEC transaction is also implemented). Transactions
which have no emulation code right now will get PEC support for free
when they finally get implemented.
* Allows for code simplifications in header files and bus drivers
(patch follows).
Drawbacks (I guess there had to be at least one):
* PEC emulation for non-PEC capable non-I2C SMBus masters was dropped.
It was based on SMBus tricks and doesn't quite fit in the new design.
I don't think it's really a problem, as the benefit was certainly
not worth the additional complexity, but it's only fair that I at
least mention it.
Lastly, let's note that the new implementation does slightly affect
compatibility (both in kernel and user-space), but doesn't actually
break it. Some defines will be dropped, but the code can always be
changed in a way that will work with both the old and the new
implementations. It shouldn't be a problem as there doesn't seem to be
many users of SMBus PEC to date anyway.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2005-10-26 13:28:55 -06:00
|
|
|
/* Incremental CRC8 over count bytes in the array pointed to by p */
|
|
|
|
static u8 i2c_smbus_pec(u8 crc, u8 *p, size_t count)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
|
|
|
int i;
|
|
|
|
|
2010-05-21 10:40:58 -06:00
|
|
|
for (i = 0; i < count; i++)
|
[PATCH] i2c: SMBus PEC support rewrite, 2 of 3
This is my rewrite of the SMBus PEC support. The original
implementation was known to have bugs (credits go to Hideki Iwamoto
for reporting many of them recently), and was incomplete due to a
conceptual limitation.
The rewrite affects only software PEC. Hardware PEC needs very little
code and is mostly untouched.
Technically, both implementations differ in that the original one
was emulating PEC in software by modifying the contents of an
i2c_smbus_data union (changing the transaction to a different type),
while the new one works one level lower, on i2c_msg structures (working
on message contents). Due to the definition of the i2c_smbus_data union,
not all SMBus transactions could be handled (at least not without
changing the definition of this union, which would break user-space
compatibility), and those which could had to be implemented
individually. At the opposite, adding PEC to an i2c_msg structure
can be done on any SMBus transaction with common code.
Advantages of the new implementation:
* It's about twice as small (from ~136 lines before to ~70 now, only
counting i2c-core, including blank and comment lines). The memory
used by i2c-core is down by ~640 bytes (~3.5%).
* Easier to validate, less tricky code. The code being common to all
transactions by design, the risk that a bug can stay uncovered is
lower.
* All SMBus transactions have PEC support in I2C emulation mode
(providing the non-PEC transaction is also implemented). Transactions
which have no emulation code right now will get PEC support for free
when they finally get implemented.
* Allows for code simplifications in header files and bus drivers
(patch follows).
Drawbacks (I guess there had to be at least one):
* PEC emulation for non-PEC capable non-I2C SMBus masters was dropped.
It was based on SMBus tricks and doesn't quite fit in the new design.
I don't think it's really a problem, as the benefit was certainly
not worth the additional complexity, but it's only fair that I at
least mention it.
Lastly, let's note that the new implementation does slightly affect
compatibility (both in kernel and user-space), but doesn't actually
break it. Some defines will be dropped, but the code can always be
changed in a way that will work with both the old and the new
implementations. It shouldn't be a problem as there doesn't seem to be
many users of SMBus PEC to date anyway.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2005-10-26 13:28:55 -06:00
|
|
|
crc = crc8((crc ^ p[i]) << 8);
|
2005-04-16 16:20:36 -06:00
|
|
|
return crc;
|
|
|
|
}
|
|
|
|
|
[PATCH] i2c: SMBus PEC support rewrite, 2 of 3
This is my rewrite of the SMBus PEC support. The original
implementation was known to have bugs (credits go to Hideki Iwamoto
for reporting many of them recently), and was incomplete due to a
conceptual limitation.
The rewrite affects only software PEC. Hardware PEC needs very little
code and is mostly untouched.
Technically, both implementations differ in that the original one
was emulating PEC in software by modifying the contents of an
i2c_smbus_data union (changing the transaction to a different type),
while the new one works one level lower, on i2c_msg structures (working
on message contents). Due to the definition of the i2c_smbus_data union,
not all SMBus transactions could be handled (at least not without
changing the definition of this union, which would break user-space
compatibility), and those which could had to be implemented
individually. At the opposite, adding PEC to an i2c_msg structure
can be done on any SMBus transaction with common code.
Advantages of the new implementation:
* It's about twice as small (from ~136 lines before to ~70 now, only
counting i2c-core, including blank and comment lines). The memory
used by i2c-core is down by ~640 bytes (~3.5%).
* Easier to validate, less tricky code. The code being common to all
transactions by design, the risk that a bug can stay uncovered is
lower.
* All SMBus transactions have PEC support in I2C emulation mode
(providing the non-PEC transaction is also implemented). Transactions
which have no emulation code right now will get PEC support for free
when they finally get implemented.
* Allows for code simplifications in header files and bus drivers
(patch follows).
Drawbacks (I guess there had to be at least one):
* PEC emulation for non-PEC capable non-I2C SMBus masters was dropped.
It was based on SMBus tricks and doesn't quite fit in the new design.
I don't think it's really a problem, as the benefit was certainly
not worth the additional complexity, but it's only fair that I at
least mention it.
Lastly, let's note that the new implementation does slightly affect
compatibility (both in kernel and user-space), but doesn't actually
break it. Some defines will be dropped, but the code can always be
changed in a way that will work with both the old and the new
implementations. It shouldn't be a problem as there doesn't seem to be
many users of SMBus PEC to date anyway.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2005-10-26 13:28:55 -06:00
|
|
|
/* Assume a 7-bit address, which is reasonable for SMBus */
|
|
|
|
static u8 i2c_smbus_msg_pec(u8 pec, struct i2c_msg *msg)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
[PATCH] i2c: SMBus PEC support rewrite, 2 of 3
This is my rewrite of the SMBus PEC support. The original
implementation was known to have bugs (credits go to Hideki Iwamoto
for reporting many of them recently), and was incomplete due to a
conceptual limitation.
The rewrite affects only software PEC. Hardware PEC needs very little
code and is mostly untouched.
Technically, both implementations differ in that the original one
was emulating PEC in software by modifying the contents of an
i2c_smbus_data union (changing the transaction to a different type),
while the new one works one level lower, on i2c_msg structures (working
on message contents). Due to the definition of the i2c_smbus_data union,
not all SMBus transactions could be handled (at least not without
changing the definition of this union, which would break user-space
compatibility), and those which could had to be implemented
individually. At the opposite, adding PEC to an i2c_msg structure
can be done on any SMBus transaction with common code.
Advantages of the new implementation:
* It's about twice as small (from ~136 lines before to ~70 now, only
counting i2c-core, including blank and comment lines). The memory
used by i2c-core is down by ~640 bytes (~3.5%).
* Easier to validate, less tricky code. The code being common to all
transactions by design, the risk that a bug can stay uncovered is
lower.
* All SMBus transactions have PEC support in I2C emulation mode
(providing the non-PEC transaction is also implemented). Transactions
which have no emulation code right now will get PEC support for free
when they finally get implemented.
* Allows for code simplifications in header files and bus drivers
(patch follows).
Drawbacks (I guess there had to be at least one):
* PEC emulation for non-PEC capable non-I2C SMBus masters was dropped.
It was based on SMBus tricks and doesn't quite fit in the new design.
I don't think it's really a problem, as the benefit was certainly
not worth the additional complexity, but it's only fair that I at
least mention it.
Lastly, let's note that the new implementation does slightly affect
compatibility (both in kernel and user-space), but doesn't actually
break it. Some defines will be dropped, but the code can always be
changed in a way that will work with both the old and the new
implementations. It shouldn't be a problem as there doesn't seem to be
many users of SMBus PEC to date anyway.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2005-10-26 13:28:55 -06:00
|
|
|
/* The address will be sent first */
|
|
|
|
u8 addr = (msg->addr << 1) | !!(msg->flags & I2C_M_RD);
|
|
|
|
pec = i2c_smbus_pec(pec, &addr, 1);
|
|
|
|
|
|
|
|
/* The data buffer follows */
|
|
|
|
return i2c_smbus_pec(pec, msg->buf, msg->len);
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
[PATCH] i2c: SMBus PEC support rewrite, 2 of 3
This is my rewrite of the SMBus PEC support. The original
implementation was known to have bugs (credits go to Hideki Iwamoto
for reporting many of them recently), and was incomplete due to a
conceptual limitation.
The rewrite affects only software PEC. Hardware PEC needs very little
code and is mostly untouched.
Technically, both implementations differ in that the original one
was emulating PEC in software by modifying the contents of an
i2c_smbus_data union (changing the transaction to a different type),
while the new one works one level lower, on i2c_msg structures (working
on message contents). Due to the definition of the i2c_smbus_data union,
not all SMBus transactions could be handled (at least not without
changing the definition of this union, which would break user-space
compatibility), and those which could had to be implemented
individually. At the opposite, adding PEC to an i2c_msg structure
can be done on any SMBus transaction with common code.
Advantages of the new implementation:
* It's about twice as small (from ~136 lines before to ~70 now, only
counting i2c-core, including blank and comment lines). The memory
used by i2c-core is down by ~640 bytes (~3.5%).
* Easier to validate, less tricky code. The code being common to all
transactions by design, the risk that a bug can stay uncovered is
lower.
* All SMBus transactions have PEC support in I2C emulation mode
(providing the non-PEC transaction is also implemented). Transactions
which have no emulation code right now will get PEC support for free
when they finally get implemented.
* Allows for code simplifications in header files and bus drivers
(patch follows).
Drawbacks (I guess there had to be at least one):
* PEC emulation for non-PEC capable non-I2C SMBus masters was dropped.
It was based on SMBus tricks and doesn't quite fit in the new design.
I don't think it's really a problem, as the benefit was certainly
not worth the additional complexity, but it's only fair that I at
least mention it.
Lastly, let's note that the new implementation does slightly affect
compatibility (both in kernel and user-space), but doesn't actually
break it. Some defines will be dropped, but the code can always be
changed in a way that will work with both the old and the new
implementations. It shouldn't be a problem as there doesn't seem to be
many users of SMBus PEC to date anyway.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2005-10-26 13:28:55 -06:00
|
|
|
/* Used for write only transactions */
|
|
|
|
static inline void i2c_smbus_add_pec(struct i2c_msg *msg)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
[PATCH] i2c: SMBus PEC support rewrite, 2 of 3
This is my rewrite of the SMBus PEC support. The original
implementation was known to have bugs (credits go to Hideki Iwamoto
for reporting many of them recently), and was incomplete due to a
conceptual limitation.
The rewrite affects only software PEC. Hardware PEC needs very little
code and is mostly untouched.
Technically, both implementations differ in that the original one
was emulating PEC in software by modifying the contents of an
i2c_smbus_data union (changing the transaction to a different type),
while the new one works one level lower, on i2c_msg structures (working
on message contents). Due to the definition of the i2c_smbus_data union,
not all SMBus transactions could be handled (at least not without
changing the definition of this union, which would break user-space
compatibility), and those which could had to be implemented
individually. At the opposite, adding PEC to an i2c_msg structure
can be done on any SMBus transaction with common code.
Advantages of the new implementation:
* It's about twice as small (from ~136 lines before to ~70 now, only
counting i2c-core, including blank and comment lines). The memory
used by i2c-core is down by ~640 bytes (~3.5%).
* Easier to validate, less tricky code. The code being common to all
transactions by design, the risk that a bug can stay uncovered is
lower.
* All SMBus transactions have PEC support in I2C emulation mode
(providing the non-PEC transaction is also implemented). Transactions
which have no emulation code right now will get PEC support for free
when they finally get implemented.
* Allows for code simplifications in header files and bus drivers
(patch follows).
Drawbacks (I guess there had to be at least one):
* PEC emulation for non-PEC capable non-I2C SMBus masters was dropped.
It was based on SMBus tricks and doesn't quite fit in the new design.
I don't think it's really a problem, as the benefit was certainly
not worth the additional complexity, but it's only fair that I at
least mention it.
Lastly, let's note that the new implementation does slightly affect
compatibility (both in kernel and user-space), but doesn't actually
break it. Some defines will be dropped, but the code can always be
changed in a way that will work with both the old and the new
implementations. It shouldn't be a problem as there doesn't seem to be
many users of SMBus PEC to date anyway.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2005-10-26 13:28:55 -06:00
|
|
|
msg->buf[msg->len] = i2c_smbus_msg_pec(0, msg);
|
|
|
|
msg->len++;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
[PATCH] i2c: SMBus PEC support rewrite, 2 of 3
This is my rewrite of the SMBus PEC support. The original
implementation was known to have bugs (credits go to Hideki Iwamoto
for reporting many of them recently), and was incomplete due to a
conceptual limitation.
The rewrite affects only software PEC. Hardware PEC needs very little
code and is mostly untouched.
Technically, both implementations differ in that the original one
was emulating PEC in software by modifying the contents of an
i2c_smbus_data union (changing the transaction to a different type),
while the new one works one level lower, on i2c_msg structures (working
on message contents). Due to the definition of the i2c_smbus_data union,
not all SMBus transactions could be handled (at least not without
changing the definition of this union, which would break user-space
compatibility), and those which could had to be implemented
individually. At the opposite, adding PEC to an i2c_msg structure
can be done on any SMBus transaction with common code.
Advantages of the new implementation:
* It's about twice as small (from ~136 lines before to ~70 now, only
counting i2c-core, including blank and comment lines). The memory
used by i2c-core is down by ~640 bytes (~3.5%).
* Easier to validate, less tricky code. The code being common to all
transactions by design, the risk that a bug can stay uncovered is
lower.
* All SMBus transactions have PEC support in I2C emulation mode
(providing the non-PEC transaction is also implemented). Transactions
which have no emulation code right now will get PEC support for free
when they finally get implemented.
* Allows for code simplifications in header files and bus drivers
(patch follows).
Drawbacks (I guess there had to be at least one):
* PEC emulation for non-PEC capable non-I2C SMBus masters was dropped.
It was based on SMBus tricks and doesn't quite fit in the new design.
I don't think it's really a problem, as the benefit was certainly
not worth the additional complexity, but it's only fair that I at
least mention it.
Lastly, let's note that the new implementation does slightly affect
compatibility (both in kernel and user-space), but doesn't actually
break it. Some defines will be dropped, but the code can always be
changed in a way that will work with both the old and the new
implementations. It shouldn't be a problem as there doesn't seem to be
many users of SMBus PEC to date anyway.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2005-10-26 13:28:55 -06:00
|
|
|
/* Return <0 on CRC error
|
|
|
|
If there was a write before this read (most cases) we need to take the
|
|
|
|
partial CRC from the write part into account.
|
|
|
|
Note that this function does modify the message (we need to decrease the
|
|
|
|
message length to hide the CRC byte from the caller). */
|
|
|
|
static int i2c_smbus_check_pec(u8 cpec, struct i2c_msg *msg)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
[PATCH] i2c: SMBus PEC support rewrite, 2 of 3
This is my rewrite of the SMBus PEC support. The original
implementation was known to have bugs (credits go to Hideki Iwamoto
for reporting many of them recently), and was incomplete due to a
conceptual limitation.
The rewrite affects only software PEC. Hardware PEC needs very little
code and is mostly untouched.
Technically, both implementations differ in that the original one
was emulating PEC in software by modifying the contents of an
i2c_smbus_data union (changing the transaction to a different type),
while the new one works one level lower, on i2c_msg structures (working
on message contents). Due to the definition of the i2c_smbus_data union,
not all SMBus transactions could be handled (at least not without
changing the definition of this union, which would break user-space
compatibility), and those which could had to be implemented
individually. At the opposite, adding PEC to an i2c_msg structure
can be done on any SMBus transaction with common code.
Advantages of the new implementation:
* It's about twice as small (from ~136 lines before to ~70 now, only
counting i2c-core, including blank and comment lines). The memory
used by i2c-core is down by ~640 bytes (~3.5%).
* Easier to validate, less tricky code. The code being common to all
transactions by design, the risk that a bug can stay uncovered is
lower.
* All SMBus transactions have PEC support in I2C emulation mode
(providing the non-PEC transaction is also implemented). Transactions
which have no emulation code right now will get PEC support for free
when they finally get implemented.
* Allows for code simplifications in header files and bus drivers
(patch follows).
Drawbacks (I guess there had to be at least one):
* PEC emulation for non-PEC capable non-I2C SMBus masters was dropped.
It was based on SMBus tricks and doesn't quite fit in the new design.
I don't think it's really a problem, as the benefit was certainly
not worth the additional complexity, but it's only fair that I at
least mention it.
Lastly, let's note that the new implementation does slightly affect
compatibility (both in kernel and user-space), but doesn't actually
break it. Some defines will be dropped, but the code can always be
changed in a way that will work with both the old and the new
implementations. It shouldn't be a problem as there doesn't seem to be
many users of SMBus PEC to date anyway.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2005-10-26 13:28:55 -06:00
|
|
|
u8 rpec = msg->buf[--msg->len];
|
|
|
|
cpec = i2c_smbus_msg_pec(cpec, msg);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
|
|
|
if (rpec != cpec) {
|
|
|
|
pr_debug("i2c-core: Bad PEC 0x%02x vs. 0x%02x\n",
|
|
|
|
rpec, cpec);
|
2008-07-14 14:38:23 -06:00
|
|
|
return -EBADMSG;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2006-12-10 13:21:31 -07:00
|
|
|
return 0;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
2008-07-14 14:38:24 -06:00
|
|
|
/**
|
|
|
|
* i2c_smbus_read_byte - SMBus "receive byte" protocol
|
|
|
|
* @client: Handle to slave device
|
|
|
|
*
|
|
|
|
* This executes the SMBus "receive byte" protocol, returning negative errno
|
|
|
|
* else the byte received from the device.
|
|
|
|
*/
|
2011-01-10 14:11:23 -07:00
|
|
|
s32 i2c_smbus_read_byte(const struct i2c_client *client)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
|
|
|
union i2c_smbus_data data;
|
2008-07-14 14:38:23 -06:00
|
|
|
int status;
|
|
|
|
|
|
|
|
status = i2c_smbus_xfer(client->adapter, client->addr, client->flags,
|
|
|
|
I2C_SMBUS_READ, 0,
|
|
|
|
I2C_SMBUS_BYTE, &data);
|
|
|
|
return (status < 0) ? status : data.byte;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_smbus_read_byte);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2008-07-14 14:38:24 -06:00
|
|
|
/**
|
|
|
|
* i2c_smbus_write_byte - SMBus "send byte" protocol
|
|
|
|
* @client: Handle to slave device
|
|
|
|
* @value: Byte to be sent
|
|
|
|
*
|
|
|
|
* This executes the SMBus "send byte" protocol, returning negative errno
|
|
|
|
* else zero on success.
|
|
|
|
*/
|
2011-01-10 14:11:23 -07:00
|
|
|
s32 i2c_smbus_write_byte(const struct i2c_client *client, u8 value)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2010-05-21 10:40:58 -06:00
|
|
|
return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
|
[PATCH] i2c: SMBus PEC support rewrite, 2 of 3
This is my rewrite of the SMBus PEC support. The original
implementation was known to have bugs (credits go to Hideki Iwamoto
for reporting many of them recently), and was incomplete due to a
conceptual limitation.
The rewrite affects only software PEC. Hardware PEC needs very little
code and is mostly untouched.
Technically, both implementations differ in that the original one
was emulating PEC in software by modifying the contents of an
i2c_smbus_data union (changing the transaction to a different type),
while the new one works one level lower, on i2c_msg structures (working
on message contents). Due to the definition of the i2c_smbus_data union,
not all SMBus transactions could be handled (at least not without
changing the definition of this union, which would break user-space
compatibility), and those which could had to be implemented
individually. At the opposite, adding PEC to an i2c_msg structure
can be done on any SMBus transaction with common code.
Advantages of the new implementation:
* It's about twice as small (from ~136 lines before to ~70 now, only
counting i2c-core, including blank and comment lines). The memory
used by i2c-core is down by ~640 bytes (~3.5%).
* Easier to validate, less tricky code. The code being common to all
transactions by design, the risk that a bug can stay uncovered is
lower.
* All SMBus transactions have PEC support in I2C emulation mode
(providing the non-PEC transaction is also implemented). Transactions
which have no emulation code right now will get PEC support for free
when they finally get implemented.
* Allows for code simplifications in header files and bus drivers
(patch follows).
Drawbacks (I guess there had to be at least one):
* PEC emulation for non-PEC capable non-I2C SMBus masters was dropped.
It was based on SMBus tricks and doesn't quite fit in the new design.
I don't think it's really a problem, as the benefit was certainly
not worth the additional complexity, but it's only fair that I at
least mention it.
Lastly, let's note that the new implementation does slightly affect
compatibility (both in kernel and user-space), but doesn't actually
break it. Some defines will be dropped, but the code can always be
changed in a way that will work with both the old and the new
implementations. It shouldn't be a problem as there doesn't seem to be
many users of SMBus PEC to date anyway.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2005-10-26 13:28:55 -06:00
|
|
|
I2C_SMBUS_WRITE, value, I2C_SMBUS_BYTE, NULL);
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_smbus_write_byte);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2008-07-14 14:38:24 -06:00
|
|
|
/**
|
|
|
|
* i2c_smbus_read_byte_data - SMBus "read byte" protocol
|
|
|
|
* @client: Handle to slave device
|
|
|
|
* @command: Byte interpreted by slave
|
|
|
|
*
|
|
|
|
* This executes the SMBus "read byte" protocol, returning negative errno
|
|
|
|
* else a data byte received from the device.
|
|
|
|
*/
|
2011-01-10 14:11:23 -07:00
|
|
|
s32 i2c_smbus_read_byte_data(const struct i2c_client *client, u8 command)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
|
|
|
union i2c_smbus_data data;
|
2008-07-14 14:38:23 -06:00
|
|
|
int status;
|
|
|
|
|
|
|
|
status = i2c_smbus_xfer(client->adapter, client->addr, client->flags,
|
|
|
|
I2C_SMBUS_READ, command,
|
|
|
|
I2C_SMBUS_BYTE_DATA, &data);
|
|
|
|
return (status < 0) ? status : data.byte;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_smbus_read_byte_data);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2008-07-14 14:38:24 -06:00
|
|
|
/**
|
|
|
|
* i2c_smbus_write_byte_data - SMBus "write byte" protocol
|
|
|
|
* @client: Handle to slave device
|
|
|
|
* @command: Byte interpreted by slave
|
|
|
|
* @value: Byte being written
|
|
|
|
*
|
|
|
|
* This executes the SMBus "write byte" protocol, returning negative errno
|
|
|
|
* else zero on success.
|
|
|
|
*/
|
2011-01-10 14:11:23 -07:00
|
|
|
s32 i2c_smbus_write_byte_data(const struct i2c_client *client, u8 command,
|
|
|
|
u8 value)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
|
|
|
union i2c_smbus_data data;
|
|
|
|
data.byte = value;
|
2010-05-21 10:40:58 -06:00
|
|
|
return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
|
|
|
|
I2C_SMBUS_WRITE, command,
|
|
|
|
I2C_SMBUS_BYTE_DATA, &data);
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_smbus_write_byte_data);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2008-07-14 14:38:24 -06:00
|
|
|
/**
|
|
|
|
* i2c_smbus_read_word_data - SMBus "read word" protocol
|
|
|
|
* @client: Handle to slave device
|
|
|
|
* @command: Byte interpreted by slave
|
|
|
|
*
|
|
|
|
* This executes the SMBus "read word" protocol, returning negative errno
|
|
|
|
* else a 16-bit unsigned "word" received from the device.
|
|
|
|
*/
|
2011-01-10 14:11:23 -07:00
|
|
|
s32 i2c_smbus_read_word_data(const struct i2c_client *client, u8 command)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
|
|
|
union i2c_smbus_data data;
|
2008-07-14 14:38:23 -06:00
|
|
|
int status;
|
|
|
|
|
|
|
|
status = i2c_smbus_xfer(client->adapter, client->addr, client->flags,
|
|
|
|
I2C_SMBUS_READ, command,
|
|
|
|
I2C_SMBUS_WORD_DATA, &data);
|
|
|
|
return (status < 0) ? status : data.word;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_smbus_read_word_data);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2008-07-14 14:38:24 -06:00
|
|
|
/**
|
|
|
|
* i2c_smbus_write_word_data - SMBus "write word" protocol
|
|
|
|
* @client: Handle to slave device
|
|
|
|
* @command: Byte interpreted by slave
|
|
|
|
* @value: 16-bit "word" being written
|
|
|
|
*
|
|
|
|
* This executes the SMBus "write word" protocol, returning negative errno
|
|
|
|
* else zero on success.
|
|
|
|
*/
|
2011-01-10 14:11:23 -07:00
|
|
|
s32 i2c_smbus_write_word_data(const struct i2c_client *client, u8 command,
|
|
|
|
u16 value)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
|
|
|
union i2c_smbus_data data;
|
|
|
|
data.word = value;
|
2010-05-21 10:40:58 -06:00
|
|
|
return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
|
|
|
|
I2C_SMBUS_WRITE, command,
|
|
|
|
I2C_SMBUS_WORD_DATA, &data);
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_smbus_write_word_data);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2007-10-13 15:56:31 -06:00
|
|
|
/**
|
2008-07-14 14:38:24 -06:00
|
|
|
* i2c_smbus_read_block_data - SMBus "block read" protocol
|
2007-10-13 15:56:31 -06:00
|
|
|
* @client: Handle to slave device
|
2008-07-14 14:38:24 -06:00
|
|
|
* @command: Byte interpreted by slave
|
2007-10-13 15:56:31 -06:00
|
|
|
* @values: Byte array into which data will be read; big enough to hold
|
|
|
|
* the data returned by the slave. SMBus allows at most 32 bytes.
|
|
|
|
*
|
2008-07-14 14:38:24 -06:00
|
|
|
* This executes the SMBus "block read" protocol, returning negative errno
|
|
|
|
* else the number of data bytes in the slave's response.
|
2007-10-13 15:56:31 -06:00
|
|
|
*
|
|
|
|
* Note that using this function requires that the client's adapter support
|
|
|
|
* the I2C_FUNC_SMBUS_READ_BLOCK_DATA functionality. Not all adapter drivers
|
|
|
|
* support this; its emulation through I2C messaging relies on a specific
|
|
|
|
* mechanism (I2C_M_RECV_LEN) which may not be implemented.
|
|
|
|
*/
|
2011-01-10 14:11:23 -07:00
|
|
|
s32 i2c_smbus_read_block_data(const struct i2c_client *client, u8 command,
|
2007-05-01 15:26:34 -06:00
|
|
|
u8 *values)
|
|
|
|
{
|
|
|
|
union i2c_smbus_data data;
|
2008-07-14 14:38:23 -06:00
|
|
|
int status;
|
2007-05-01 15:26:34 -06:00
|
|
|
|
2008-07-14 14:38:23 -06:00
|
|
|
status = i2c_smbus_xfer(client->adapter, client->addr, client->flags,
|
|
|
|
I2C_SMBUS_READ, command,
|
|
|
|
I2C_SMBUS_BLOCK_DATA, &data);
|
|
|
|
if (status)
|
|
|
|
return status;
|
2007-05-01 15:26:34 -06:00
|
|
|
|
|
|
|
memcpy(values, &data.block[1], data.block[0]);
|
|
|
|
return data.block[0];
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(i2c_smbus_read_block_data);
|
|
|
|
|
2008-07-14 14:38:24 -06:00
|
|
|
/**
|
|
|
|
* i2c_smbus_write_block_data - SMBus "block write" protocol
|
|
|
|
* @client: Handle to slave device
|
|
|
|
* @command: Byte interpreted by slave
|
|
|
|
* @length: Size of data block; SMBus allows at most 32 bytes
|
|
|
|
* @values: Byte array which will be written.
|
|
|
|
*
|
|
|
|
* This executes the SMBus "block write" protocol, returning negative errno
|
|
|
|
* else zero on success.
|
|
|
|
*/
|
2011-01-10 14:11:23 -07:00
|
|
|
s32 i2c_smbus_write_block_data(const struct i2c_client *client, u8 command,
|
2006-06-12 13:42:20 -06:00
|
|
|
u8 length, const u8 *values)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
|
|
|
union i2c_smbus_data data;
|
2006-01-18 15:14:55 -07:00
|
|
|
|
2005-04-16 16:20:36 -06:00
|
|
|
if (length > I2C_SMBUS_BLOCK_MAX)
|
|
|
|
length = I2C_SMBUS_BLOCK_MAX;
|
|
|
|
data.block[0] = length;
|
2006-01-18 15:14:55 -07:00
|
|
|
memcpy(&data.block[1], values, length);
|
2010-05-21 10:40:58 -06:00
|
|
|
return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
|
|
|
|
I2C_SMBUS_WRITE, command,
|
|
|
|
I2C_SMBUS_BLOCK_DATA, &data);
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_smbus_write_block_data);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
|
|
|
/* Returns the number of read bytes */
|
2011-01-10 14:11:23 -07:00
|
|
|
s32 i2c_smbus_read_i2c_block_data(const struct i2c_client *client, u8 command,
|
i2c: Fix the i2c_smbus_read_i2c_block_data() prototype
Let the drivers specify how many bytes they want to read with
i2c_smbus_read_i2c_block_data(). So far, the block count was
hard-coded to I2C_SMBUS_BLOCK_MAX (32), which did not make much sense.
Many driver authors complained about this before, and I believe it's
about time to fix it. Right now, authors have to do technically stupid
things, such as individual byte reads or full-fledged I2C messaging,
to work around the problem. We do not want to encourage that.
I even found that some bus drivers (e.g. i2c-amd8111) already
implemented I2C block read the "right" way, that is, they didn't
follow the old, broken standard. The fact that it was never noticed
before just shows how little i2c_smbus_read_i2c_block_data() was used,
which isn't that surprising given how broken its prototype was so far.
There are some obvious compatiblity considerations:
* This changes the i2c_smbus_read_i2c_block_data() prototype. Users
outside the kernel tree will notice at compilation time, and will
have to update their code.
* User-space has access to i2c_smbus_xfer() directly using i2c-dev, so
the changed expectations would affect tools such as i2cdump. In order
to preserve binary compatibility, we give I2C_SMBUS_I2C_BLOCK_DATA
a new numeric value, and define I2C_SMBUS_I2C_BLOCK_BROKEN with the
old numeric value. When i2c-dev receives a transaction with the
old value, it can convert it to the new format on the fly.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2007-07-12 06:12:29 -06:00
|
|
|
u8 length, u8 *values)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
|
|
|
union i2c_smbus_data data;
|
2008-07-14 14:38:23 -06:00
|
|
|
int status;
|
2006-01-18 15:14:55 -07:00
|
|
|
|
i2c: Fix the i2c_smbus_read_i2c_block_data() prototype
Let the drivers specify how many bytes they want to read with
i2c_smbus_read_i2c_block_data(). So far, the block count was
hard-coded to I2C_SMBUS_BLOCK_MAX (32), which did not make much sense.
Many driver authors complained about this before, and I believe it's
about time to fix it. Right now, authors have to do technically stupid
things, such as individual byte reads or full-fledged I2C messaging,
to work around the problem. We do not want to encourage that.
I even found that some bus drivers (e.g. i2c-amd8111) already
implemented I2C block read the "right" way, that is, they didn't
follow the old, broken standard. The fact that it was never noticed
before just shows how little i2c_smbus_read_i2c_block_data() was used,
which isn't that surprising given how broken its prototype was so far.
There are some obvious compatiblity considerations:
* This changes the i2c_smbus_read_i2c_block_data() prototype. Users
outside the kernel tree will notice at compilation time, and will
have to update their code.
* User-space has access to i2c_smbus_xfer() directly using i2c-dev, so
the changed expectations would affect tools such as i2cdump. In order
to preserve binary compatibility, we give I2C_SMBUS_I2C_BLOCK_DATA
a new numeric value, and define I2C_SMBUS_I2C_BLOCK_BROKEN with the
old numeric value. When i2c-dev receives a transaction with the
old value, it can convert it to the new format on the fly.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2007-07-12 06:12:29 -06:00
|
|
|
if (length > I2C_SMBUS_BLOCK_MAX)
|
|
|
|
length = I2C_SMBUS_BLOCK_MAX;
|
|
|
|
data.block[0] = length;
|
2008-07-14 14:38:23 -06:00
|
|
|
status = i2c_smbus_xfer(client->adapter, client->addr, client->flags,
|
|
|
|
I2C_SMBUS_READ, command,
|
|
|
|
I2C_SMBUS_I2C_BLOCK_DATA, &data);
|
|
|
|
if (status < 0)
|
|
|
|
return status;
|
2006-01-18 15:14:55 -07:00
|
|
|
|
|
|
|
memcpy(values, &data.block[1], data.block[0]);
|
|
|
|
return data.block[0];
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_smbus_read_i2c_block_data);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2011-01-10 14:11:23 -07:00
|
|
|
s32 i2c_smbus_write_i2c_block_data(const struct i2c_client *client, u8 command,
|
2006-06-12 13:42:20 -06:00
|
|
|
u8 length, const u8 *values)
|
2006-01-08 21:19:18 -07:00
|
|
|
{
|
|
|
|
union i2c_smbus_data data;
|
|
|
|
|
|
|
|
if (length > I2C_SMBUS_BLOCK_MAX)
|
|
|
|
length = I2C_SMBUS_BLOCK_MAX;
|
|
|
|
data.block[0] = length;
|
|
|
|
memcpy(data.block + 1, values, length);
|
|
|
|
return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
|
|
|
|
I2C_SMBUS_WRITE, command,
|
|
|
|
I2C_SMBUS_I2C_BLOCK_DATA, &data);
|
|
|
|
}
|
2007-05-01 15:26:31 -06:00
|
|
|
EXPORT_SYMBOL(i2c_smbus_write_i2c_block_data);
|
2006-01-08 21:19:18 -07:00
|
|
|
|
2006-12-10 13:21:31 -07:00
|
|
|
/* Simulate a SMBus command using the i2c protocol
|
2005-04-16 16:20:36 -06:00
|
|
|
No checking of parameters is done! */
|
2010-05-21 10:40:58 -06:00
|
|
|
static s32 i2c_smbus_xfer_emulated(struct i2c_adapter *adapter, u16 addr,
|
|
|
|
unsigned short flags,
|
|
|
|
char read_write, u8 command, int size,
|
|
|
|
union i2c_smbus_data *data)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
|
|
|
/* So we need to generate a series of msgs. In the case of writing, we
|
|
|
|
need to use only one message; when reading, we need two. We initialize
|
|
|
|
most things with sane defaults, to keep the code below somewhat
|
|
|
|
simpler. */
|
2005-09-25 09:01:11 -06:00
|
|
|
unsigned char msgbuf0[I2C_SMBUS_BLOCK_MAX+3];
|
|
|
|
unsigned char msgbuf1[I2C_SMBUS_BLOCK_MAX+2];
|
2010-05-21 10:40:58 -06:00
|
|
|
int num = read_write == I2C_SMBUS_READ ? 2 : 1;
|
2005-04-16 16:20:36 -06:00
|
|
|
int i;
|
[PATCH] i2c: SMBus PEC support rewrite, 2 of 3
This is my rewrite of the SMBus PEC support. The original
implementation was known to have bugs (credits go to Hideki Iwamoto
for reporting many of them recently), and was incomplete due to a
conceptual limitation.
The rewrite affects only software PEC. Hardware PEC needs very little
code and is mostly untouched.
Technically, both implementations differ in that the original one
was emulating PEC in software by modifying the contents of an
i2c_smbus_data union (changing the transaction to a different type),
while the new one works one level lower, on i2c_msg structures (working
on message contents). Due to the definition of the i2c_smbus_data union,
not all SMBus transactions could be handled (at least not without
changing the definition of this union, which would break user-space
compatibility), and those which could had to be implemented
individually. At the opposite, adding PEC to an i2c_msg structure
can be done on any SMBus transaction with common code.
Advantages of the new implementation:
* It's about twice as small (from ~136 lines before to ~70 now, only
counting i2c-core, including blank and comment lines). The memory
used by i2c-core is down by ~640 bytes (~3.5%).
* Easier to validate, less tricky code. The code being common to all
transactions by design, the risk that a bug can stay uncovered is
lower.
* All SMBus transactions have PEC support in I2C emulation mode
(providing the non-PEC transaction is also implemented). Transactions
which have no emulation code right now will get PEC support for free
when they finally get implemented.
* Allows for code simplifications in header files and bus drivers
(patch follows).
Drawbacks (I guess there had to be at least one):
* PEC emulation for non-PEC capable non-I2C SMBus masters was dropped.
It was based on SMBus tricks and doesn't quite fit in the new design.
I don't think it's really a problem, as the benefit was certainly
not worth the additional complexity, but it's only fair that I at
least mention it.
Lastly, let's note that the new implementation does slightly affect
compatibility (both in kernel and user-space), but doesn't actually
break it. Some defines will be dropped, but the code can always be
changed in a way that will work with both the old and the new
implementations. It shouldn't be a problem as there doesn't seem to be
many users of SMBus PEC to date anyway.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2005-10-26 13:28:55 -06:00
|
|
|
u8 partial_pec = 0;
|
2008-07-14 14:38:23 -06:00
|
|
|
int status;
|
2012-10-05 14:23:52 -06:00
|
|
|
struct i2c_msg msg[2] = {
|
|
|
|
{
|
|
|
|
.addr = addr,
|
|
|
|
.flags = flags,
|
|
|
|
.len = 1,
|
|
|
|
.buf = msgbuf0,
|
|
|
|
}, {
|
|
|
|
.addr = addr,
|
|
|
|
.flags = flags | I2C_M_RD,
|
|
|
|
.len = 0,
|
|
|
|
.buf = msgbuf1,
|
|
|
|
},
|
|
|
|
};
|
2005-04-16 16:20:36 -06:00
|
|
|
|
|
|
|
msgbuf0[0] = command;
|
2010-05-21 10:40:58 -06:00
|
|
|
switch (size) {
|
2005-04-16 16:20:36 -06:00
|
|
|
case I2C_SMBUS_QUICK:
|
|
|
|
msg[0].len = 0;
|
|
|
|
/* Special case: The read/write field is used as data */
|
2009-02-24 11:19:48 -07:00
|
|
|
msg[0].flags = flags | (read_write == I2C_SMBUS_READ ?
|
|
|
|
I2C_M_RD : 0);
|
2005-04-16 16:20:36 -06:00
|
|
|
num = 1;
|
|
|
|
break;
|
|
|
|
case I2C_SMBUS_BYTE:
|
|
|
|
if (read_write == I2C_SMBUS_READ) {
|
|
|
|
/* Special case: only a read! */
|
|
|
|
msg[0].flags = I2C_M_RD | flags;
|
|
|
|
num = 1;
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case I2C_SMBUS_BYTE_DATA:
|
|
|
|
if (read_write == I2C_SMBUS_READ)
|
|
|
|
msg[1].len = 1;
|
|
|
|
else {
|
|
|
|
msg[0].len = 2;
|
|
|
|
msgbuf0[1] = data->byte;
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case I2C_SMBUS_WORD_DATA:
|
|
|
|
if (read_write == I2C_SMBUS_READ)
|
|
|
|
msg[1].len = 2;
|
|
|
|
else {
|
2010-05-21 10:40:58 -06:00
|
|
|
msg[0].len = 3;
|
2005-04-16 16:20:36 -06:00
|
|
|
msgbuf0[1] = data->word & 0xff;
|
2006-09-03 14:24:00 -06:00
|
|
|
msgbuf0[2] = data->word >> 8;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
break;
|
|
|
|
case I2C_SMBUS_PROC_CALL:
|
|
|
|
num = 2; /* Special case */
|
|
|
|
read_write = I2C_SMBUS_READ;
|
|
|
|
msg[0].len = 3;
|
|
|
|
msg[1].len = 2;
|
|
|
|
msgbuf0[1] = data->word & 0xff;
|
2006-09-03 14:24:00 -06:00
|
|
|
msgbuf0[2] = data->word >> 8;
|
2005-04-16 16:20:36 -06:00
|
|
|
break;
|
|
|
|
case I2C_SMBUS_BLOCK_DATA:
|
|
|
|
if (read_write == I2C_SMBUS_READ) {
|
2007-05-01 15:26:29 -06:00
|
|
|
msg[1].flags |= I2C_M_RECV_LEN;
|
|
|
|
msg[1].len = 1; /* block length will be added by
|
|
|
|
the underlying bus driver */
|
2005-04-16 16:20:36 -06:00
|
|
|
} else {
|
|
|
|
msg[0].len = data->block[0] + 2;
|
|
|
|
if (msg[0].len > I2C_SMBUS_BLOCK_MAX + 2) {
|
2008-07-14 14:38:23 -06:00
|
|
|
dev_err(&adapter->dev,
|
|
|
|
"Invalid block write size %d\n",
|
|
|
|
data->block[0]);
|
|
|
|
return -EINVAL;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2005-09-25 09:01:11 -06:00
|
|
|
for (i = 1; i < msg[0].len; i++)
|
2005-04-16 16:20:36 -06:00
|
|
|
msgbuf0[i] = data->block[i-1];
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case I2C_SMBUS_BLOCK_PROC_CALL:
|
2007-05-01 15:26:29 -06:00
|
|
|
num = 2; /* Another special case */
|
|
|
|
read_write = I2C_SMBUS_READ;
|
|
|
|
if (data->block[0] > I2C_SMBUS_BLOCK_MAX) {
|
2008-07-14 14:38:23 -06:00
|
|
|
dev_err(&adapter->dev,
|
|
|
|
"Invalid block write size %d\n",
|
2007-05-01 15:26:29 -06:00
|
|
|
data->block[0]);
|
2008-07-14 14:38:23 -06:00
|
|
|
return -EINVAL;
|
2007-05-01 15:26:29 -06:00
|
|
|
}
|
|
|
|
msg[0].len = data->block[0] + 2;
|
|
|
|
for (i = 1; i < msg[0].len; i++)
|
|
|
|
msgbuf0[i] = data->block[i-1];
|
|
|
|
msg[1].flags |= I2C_M_RECV_LEN;
|
|
|
|
msg[1].len = 1; /* block length will be added by
|
|
|
|
the underlying bus driver */
|
|
|
|
break;
|
2005-04-16 16:20:36 -06:00
|
|
|
case I2C_SMBUS_I2C_BLOCK_DATA:
|
|
|
|
if (read_write == I2C_SMBUS_READ) {
|
i2c: Fix the i2c_smbus_read_i2c_block_data() prototype
Let the drivers specify how many bytes they want to read with
i2c_smbus_read_i2c_block_data(). So far, the block count was
hard-coded to I2C_SMBUS_BLOCK_MAX (32), which did not make much sense.
Many driver authors complained about this before, and I believe it's
about time to fix it. Right now, authors have to do technically stupid
things, such as individual byte reads or full-fledged I2C messaging,
to work around the problem. We do not want to encourage that.
I even found that some bus drivers (e.g. i2c-amd8111) already
implemented I2C block read the "right" way, that is, they didn't
follow the old, broken standard. The fact that it was never noticed
before just shows how little i2c_smbus_read_i2c_block_data() was used,
which isn't that surprising given how broken its prototype was so far.
There are some obvious compatiblity considerations:
* This changes the i2c_smbus_read_i2c_block_data() prototype. Users
outside the kernel tree will notice at compilation time, and will
have to update their code.
* User-space has access to i2c_smbus_xfer() directly using i2c-dev, so
the changed expectations would affect tools such as i2cdump. In order
to preserve binary compatibility, we give I2C_SMBUS_I2C_BLOCK_DATA
a new numeric value, and define I2C_SMBUS_I2C_BLOCK_BROKEN with the
old numeric value. When i2c-dev receives a transaction with the
old value, it can convert it to the new format on the fly.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
2007-07-12 06:12:29 -06:00
|
|
|
msg[1].len = data->block[0];
|
2005-04-16 16:20:36 -06:00
|
|
|
} else {
|
|
|
|
msg[0].len = data->block[0] + 1;
|
2005-10-07 16:15:59 -06:00
|
|
|
if (msg[0].len > I2C_SMBUS_BLOCK_MAX + 1) {
|
2008-07-14 14:38:23 -06:00
|
|
|
dev_err(&adapter->dev,
|
|
|
|
"Invalid block write size %d\n",
|
|
|
|
data->block[0]);
|
|
|
|
return -EINVAL;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
for (i = 1; i <= data->block[0]; i++)
|
|
|
|
msgbuf0[i] = data->block[i];
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
default:
|
2008-07-14 14:38:23 -06:00
|
|
|
dev_err(&adapter->dev, "Unsupported transaction %d\n", size);
|
|
|
|
return -EOPNOTSUPP;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
[PATCH] i2c: SMBus PEC support rewrite, 2 of 3
This is my rewrite of the SMBus PEC support. The original
implementation was known to have bugs (credits go to Hideki Iwamoto
for reporting many of them recently), and was incomplete due to a
conceptual limitation.
The rewrite affects only software PEC. Hardware PEC needs very little
code and is mostly untouched.
Technically, both implementations differ in that the original one
was emulating PEC in software by modifying the contents of an
i2c_smbus_data union (changing the transaction to a different type),
while the new one works one level lower, on i2c_msg structures (working
on message contents). Due to the definition of the i2c_smbus_data union,
not all SMBus transactions could be handled (at least not without
changing the definition of this union, which would break user-space
compatibility), and those which could had to be implemented
individually. At the opposite, adding PEC to an i2c_msg structure
can be done on any SMBus transaction with common code.
Advantages of the new implementation:
* It's about twice as small (from ~136 lines before to ~70 now, only
counting i2c-core, including blank and comment lines). The memory
used by i2c-core is down by ~640 bytes (~3.5%).
* Easier to validate, less tricky code. The code being common to all
transactions by design, the risk that a bug can stay uncovered is
lower.
* All SMBus transactions have PEC support in I2C emulation mode
(providing the non-PEC transaction is also implemented). Transactions
which have no emulation code right now will get PEC support for free
when they finally get implemented.
* Allows for code simplifications in header files and bus drivers
(patch follows).
Drawbacks (I guess there had to be at least one):
* PEC emulation for non-PEC capable non-I2C SMBus masters was dropped.
It was based on SMBus tricks and doesn't quite fit in the new design.
I don't think it's really a problem, as the benefit was certainly
not worth the additional complexity, but it's only fair that I at
least mention it.
Lastly, let's note that the new implementation does slightly affect
compatibility (both in kernel and user-space), but doesn't actually
break it. Some defines will be dropped, but the code can always be
changed in a way that will work with both the old and the new
implementations. It shouldn't be a problem as there doesn't seem to be
many users of SMBus PEC to date anyway.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2005-10-26 13:28:55 -06:00
|
|
|
i = ((flags & I2C_CLIENT_PEC) && size != I2C_SMBUS_QUICK
|
|
|
|
&& size != I2C_SMBUS_I2C_BLOCK_DATA);
|
|
|
|
if (i) {
|
|
|
|
/* Compute PEC if first message is a write */
|
|
|
|
if (!(msg[0].flags & I2C_M_RD)) {
|
2006-12-10 13:21:31 -07:00
|
|
|
if (num == 1) /* Write only */
|
[PATCH] i2c: SMBus PEC support rewrite, 2 of 3
This is my rewrite of the SMBus PEC support. The original
implementation was known to have bugs (credits go to Hideki Iwamoto
for reporting many of them recently), and was incomplete due to a
conceptual limitation.
The rewrite affects only software PEC. Hardware PEC needs very little
code and is mostly untouched.
Technically, both implementations differ in that the original one
was emulating PEC in software by modifying the contents of an
i2c_smbus_data union (changing the transaction to a different type),
while the new one works one level lower, on i2c_msg structures (working
on message contents). Due to the definition of the i2c_smbus_data union,
not all SMBus transactions could be handled (at least not without
changing the definition of this union, which would break user-space
compatibility), and those which could had to be implemented
individually. At the opposite, adding PEC to an i2c_msg structure
can be done on any SMBus transaction with common code.
Advantages of the new implementation:
* It's about twice as small (from ~136 lines before to ~70 now, only
counting i2c-core, including blank and comment lines). The memory
used by i2c-core is down by ~640 bytes (~3.5%).
* Easier to validate, less tricky code. The code being common to all
transactions by design, the risk that a bug can stay uncovered is
lower.
* All SMBus transactions have PEC support in I2C emulation mode
(providing the non-PEC transaction is also implemented). Transactions
which have no emulation code right now will get PEC support for free
when they finally get implemented.
* Allows for code simplifications in header files and bus drivers
(patch follows).
Drawbacks (I guess there had to be at least one):
* PEC emulation for non-PEC capable non-I2C SMBus masters was dropped.
It was based on SMBus tricks and doesn't quite fit in the new design.
I don't think it's really a problem, as the benefit was certainly
not worth the additional complexity, but it's only fair that I at
least mention it.
Lastly, let's note that the new implementation does slightly affect
compatibility (both in kernel and user-space), but doesn't actually
break it. Some defines will be dropped, but the code can always be
changed in a way that will work with both the old and the new
implementations. It shouldn't be a problem as there doesn't seem to be
many users of SMBus PEC to date anyway.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2005-10-26 13:28:55 -06:00
|
|
|
i2c_smbus_add_pec(&msg[0]);
|
|
|
|
else /* Write followed by read */
|
|
|
|
partial_pec = i2c_smbus_msg_pec(0, &msg[0]);
|
|
|
|
}
|
|
|
|
/* Ask for PEC if last message is a read */
|
|
|
|
if (msg[num-1].flags & I2C_M_RD)
|
2006-12-10 13:21:31 -07:00
|
|
|
msg[num-1].len++;
|
[PATCH] i2c: SMBus PEC support rewrite, 2 of 3
This is my rewrite of the SMBus PEC support. The original
implementation was known to have bugs (credits go to Hideki Iwamoto
for reporting many of them recently), and was incomplete due to a
conceptual limitation.
The rewrite affects only software PEC. Hardware PEC needs very little
code and is mostly untouched.
Technically, both implementations differ in that the original one
was emulating PEC in software by modifying the contents of an
i2c_smbus_data union (changing the transaction to a different type),
while the new one works one level lower, on i2c_msg structures (working
on message contents). Due to the definition of the i2c_smbus_data union,
not all SMBus transactions could be handled (at least not without
changing the definition of this union, which would break user-space
compatibility), and those which could had to be implemented
individually. At the opposite, adding PEC to an i2c_msg structure
can be done on any SMBus transaction with common code.
Advantages of the new implementation:
* It's about twice as small (from ~136 lines before to ~70 now, only
counting i2c-core, including blank and comment lines). The memory
used by i2c-core is down by ~640 bytes (~3.5%).
* Easier to validate, less tricky code. The code being common to all
transactions by design, the risk that a bug can stay uncovered is
lower.
* All SMBus transactions have PEC support in I2C emulation mode
(providing the non-PEC transaction is also implemented). Transactions
which have no emulation code right now will get PEC support for free
when they finally get implemented.
* Allows for code simplifications in header files and bus drivers
(patch follows).
Drawbacks (I guess there had to be at least one):
* PEC emulation for non-PEC capable non-I2C SMBus masters was dropped.
It was based on SMBus tricks and doesn't quite fit in the new design.
I don't think it's really a problem, as the benefit was certainly
not worth the additional complexity, but it's only fair that I at
least mention it.
Lastly, let's note that the new implementation does slightly affect
compatibility (both in kernel and user-space), but doesn't actually
break it. Some defines will be dropped, but the code can always be
changed in a way that will work with both the old and the new
implementations. It shouldn't be a problem as there doesn't seem to be
many users of SMBus PEC to date anyway.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2005-10-26 13:28:55 -06:00
|
|
|
}
|
|
|
|
|
2008-07-14 14:38:23 -06:00
|
|
|
status = i2c_transfer(adapter, msg, num);
|
|
|
|
if (status < 0)
|
|
|
|
return status;
|
2005-04-16 16:20:36 -06:00
|
|
|
|
[PATCH] i2c: SMBus PEC support rewrite, 2 of 3
This is my rewrite of the SMBus PEC support. The original
implementation was known to have bugs (credits go to Hideki Iwamoto
for reporting many of them recently), and was incomplete due to a
conceptual limitation.
The rewrite affects only software PEC. Hardware PEC needs very little
code and is mostly untouched.
Technically, both implementations differ in that the original one
was emulating PEC in software by modifying the contents of an
i2c_smbus_data union (changing the transaction to a different type),
while the new one works one level lower, on i2c_msg structures (working
on message contents). Due to the definition of the i2c_smbus_data union,
not all SMBus transactions could be handled (at least not without
changing the definition of this union, which would break user-space
compatibility), and those which could had to be implemented
individually. At the opposite, adding PEC to an i2c_msg structure
can be done on any SMBus transaction with common code.
Advantages of the new implementation:
* It's about twice as small (from ~136 lines before to ~70 now, only
counting i2c-core, including blank and comment lines). The memory
used by i2c-core is down by ~640 bytes (~3.5%).
* Easier to validate, less tricky code. The code being common to all
transactions by design, the risk that a bug can stay uncovered is
lower.
* All SMBus transactions have PEC support in I2C emulation mode
(providing the non-PEC transaction is also implemented). Transactions
which have no emulation code right now will get PEC support for free
when they finally get implemented.
* Allows for code simplifications in header files and bus drivers
(patch follows).
Drawbacks (I guess there had to be at least one):
* PEC emulation for non-PEC capable non-I2C SMBus masters was dropped.
It was based on SMBus tricks and doesn't quite fit in the new design.
I don't think it's really a problem, as the benefit was certainly
not worth the additional complexity, but it's only fair that I at
least mention it.
Lastly, let's note that the new implementation does slightly affect
compatibility (both in kernel and user-space), but doesn't actually
break it. Some defines will be dropped, but the code can always be
changed in a way that will work with both the old and the new
implementations. It shouldn't be a problem as there doesn't seem to be
many users of SMBus PEC to date anyway.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2005-10-26 13:28:55 -06:00
|
|
|
/* Check PEC if last message is a read */
|
|
|
|
if (i && (msg[num-1].flags & I2C_M_RD)) {
|
2008-07-14 14:38:23 -06:00
|
|
|
status = i2c_smbus_check_pec(partial_pec, &msg[num-1]);
|
|
|
|
if (status < 0)
|
|
|
|
return status;
|
[PATCH] i2c: SMBus PEC support rewrite, 2 of 3
This is my rewrite of the SMBus PEC support. The original
implementation was known to have bugs (credits go to Hideki Iwamoto
for reporting many of them recently), and was incomplete due to a
conceptual limitation.
The rewrite affects only software PEC. Hardware PEC needs very little
code and is mostly untouched.
Technically, both implementations differ in that the original one
was emulating PEC in software by modifying the contents of an
i2c_smbus_data union (changing the transaction to a different type),
while the new one works one level lower, on i2c_msg structures (working
on message contents). Due to the definition of the i2c_smbus_data union,
not all SMBus transactions could be handled (at least not without
changing the definition of this union, which would break user-space
compatibility), and those which could had to be implemented
individually. At the opposite, adding PEC to an i2c_msg structure
can be done on any SMBus transaction with common code.
Advantages of the new implementation:
* It's about twice as small (from ~136 lines before to ~70 now, only
counting i2c-core, including blank and comment lines). The memory
used by i2c-core is down by ~640 bytes (~3.5%).
* Easier to validate, less tricky code. The code being common to all
transactions by design, the risk that a bug can stay uncovered is
lower.
* All SMBus transactions have PEC support in I2C emulation mode
(providing the non-PEC transaction is also implemented). Transactions
which have no emulation code right now will get PEC support for free
when they finally get implemented.
* Allows for code simplifications in header files and bus drivers
(patch follows).
Drawbacks (I guess there had to be at least one):
* PEC emulation for non-PEC capable non-I2C SMBus masters was dropped.
It was based on SMBus tricks and doesn't quite fit in the new design.
I don't think it's really a problem, as the benefit was certainly
not worth the additional complexity, but it's only fair that I at
least mention it.
Lastly, let's note that the new implementation does slightly affect
compatibility (both in kernel and user-space), but doesn't actually
break it. Some defines will be dropped, but the code can always be
changed in a way that will work with both the old and the new
implementations. It shouldn't be a problem as there doesn't seem to be
many users of SMBus PEC to date anyway.
Signed-off-by: Jean Delvare <khali@linux-fr.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2005-10-26 13:28:55 -06:00
|
|
|
}
|
|
|
|
|
2005-04-16 16:20:36 -06:00
|
|
|
if (read_write == I2C_SMBUS_READ)
|
2010-05-21 10:40:58 -06:00
|
|
|
switch (size) {
|
|
|
|
case I2C_SMBUS_BYTE:
|
|
|
|
data->byte = msgbuf0[0];
|
|
|
|
break;
|
|
|
|
case I2C_SMBUS_BYTE_DATA:
|
|
|
|
data->byte = msgbuf1[0];
|
|
|
|
break;
|
|
|
|
case I2C_SMBUS_WORD_DATA:
|
|
|
|
case I2C_SMBUS_PROC_CALL:
|
|
|
|
data->word = msgbuf1[0] | (msgbuf1[1] << 8);
|
|
|
|
break;
|
|
|
|
case I2C_SMBUS_I2C_BLOCK_DATA:
|
|
|
|
for (i = 0; i < data->block[0]; i++)
|
|
|
|
data->block[i+1] = msgbuf1[i];
|
|
|
|
break;
|
|
|
|
case I2C_SMBUS_BLOCK_DATA:
|
|
|
|
case I2C_SMBUS_BLOCK_PROC_CALL:
|
|
|
|
for (i = 0; i < msgbuf1[0] + 1; i++)
|
|
|
|
data->block[i] = msgbuf1[i];
|
|
|
|
break;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2008-07-14 14:38:24 -06:00
|
|
|
/**
|
|
|
|
* i2c_smbus_xfer - execute SMBus protocol operations
|
|
|
|
* @adapter: Handle to I2C bus
|
|
|
|
* @addr: Address of SMBus slave on that bus
|
|
|
|
* @flags: I2C_CLIENT_* flags (usually zero or I2C_CLIENT_PEC)
|
|
|
|
* @read_write: I2C_SMBUS_READ or I2C_SMBUS_WRITE
|
|
|
|
* @command: Byte interpreted by slave, for protocols which use such bytes
|
|
|
|
* @protocol: SMBus protocol operation to execute, such as I2C_SMBUS_PROC_CALL
|
|
|
|
* @data: Data to be read or written
|
|
|
|
*
|
|
|
|
* This executes an SMBus protocol operation, and returns a negative
|
|
|
|
* errno code else zero on success.
|
|
|
|
*/
|
2009-03-28 14:34:46 -06:00
|
|
|
s32 i2c_smbus_xfer(struct i2c_adapter *adapter, u16 addr, unsigned short flags,
|
2008-07-14 14:38:24 -06:00
|
|
|
char read_write, u8 command, int protocol,
|
2009-03-28 14:34:46 -06:00
|
|
|
union i2c_smbus_data *data)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2009-06-15 10:01:46 -06:00
|
|
|
unsigned long orig_jiffies;
|
|
|
|
int try;
|
2005-04-16 16:20:36 -06:00
|
|
|
s32 res;
|
|
|
|
|
2014-03-06 06:36:06 -07:00
|
|
|
/* If enabled, the following two tracepoints are conditional on
|
|
|
|
* read_write and protocol.
|
|
|
|
*/
|
|
|
|
trace_smbus_write(adapter, addr, flags, read_write,
|
|
|
|
command, protocol, data);
|
|
|
|
trace_smbus_read(adapter, addr, flags, read_write,
|
|
|
|
command, protocol);
|
|
|
|
|
2012-07-24 06:13:59 -06:00
|
|
|
flags &= I2C_M_TEN | I2C_CLIENT_PEC | I2C_CLIENT_SCCB;
|
2005-04-16 16:20:36 -06:00
|
|
|
|
|
|
|
if (adapter->algo->smbus_xfer) {
|
2010-08-11 10:20:58 -06:00
|
|
|
i2c_lock_adapter(adapter);
|
2009-06-15 10:01:46 -06:00
|
|
|
|
|
|
|
/* Retry automatically on arbitration loss */
|
|
|
|
orig_jiffies = jiffies;
|
|
|
|
for (res = 0, try = 0; try <= adapter->retries; try++) {
|
|
|
|
res = adapter->algo->smbus_xfer(adapter, addr, flags,
|
|
|
|
read_write, command,
|
|
|
|
protocol, data);
|
|
|
|
if (res != -EAGAIN)
|
|
|
|
break;
|
|
|
|
if (time_after(jiffies,
|
|
|
|
orig_jiffies + adapter->timeout))
|
|
|
|
break;
|
|
|
|
}
|
2010-08-11 10:20:58 -06:00
|
|
|
i2c_unlock_adapter(adapter);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2012-07-24 06:13:59 -06:00
|
|
|
if (res != -EOPNOTSUPP || !adapter->algo->master_xfer)
|
2014-03-06 06:36:06 -07:00
|
|
|
goto trace;
|
2012-07-24 06:13:59 -06:00
|
|
|
/*
|
|
|
|
* Fall back to i2c_smbus_xfer_emulated if the adapter doesn't
|
|
|
|
* implement native support for the SMBus operation.
|
|
|
|
*/
|
|
|
|
}
|
|
|
|
|
2014-03-06 06:36:06 -07:00
|
|
|
res = i2c_smbus_xfer_emulated(adapter, addr, flags, read_write,
|
|
|
|
command, protocol, data);
|
|
|
|
|
|
|
|
trace:
|
|
|
|
/* If enabled, the reply tracepoint is conditional on read_write. */
|
|
|
|
trace_smbus_reply(adapter, addr, flags, read_write,
|
|
|
|
command, protocol, data);
|
|
|
|
trace_smbus_result(adapter, addr, flags, read_write,
|
|
|
|
command, protocol, res);
|
|
|
|
|
|
|
|
return res;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(i2c_smbus_xfer);
|
|
|
|
|
2015-08-12 08:31:33 -06:00
|
|
|
/**
|
|
|
|
* i2c_smbus_read_i2c_block_data_or_emulated - read block or emulate
|
|
|
|
* @client: Handle to slave device
|
|
|
|
* @command: Byte interpreted by slave
|
|
|
|
* @length: Size of data block; SMBus allows at most I2C_SMBUS_BLOCK_MAX bytes
|
|
|
|
* @values: Byte array into which data will be read; big enough to hold
|
|
|
|
* the data returned by the slave. SMBus allows at most
|
|
|
|
* I2C_SMBUS_BLOCK_MAX bytes.
|
|
|
|
*
|
|
|
|
* This executes the SMBus "block read" protocol if supported by the adapter.
|
|
|
|
* If block read is not supported, it emulates it using either word or byte
|
|
|
|
* read protocols depending on availability.
|
|
|
|
*
|
|
|
|
* The addresses of the I2C slave device that are accessed with this function
|
|
|
|
* must be mapped to a linear region, so that a block read will have the same
|
|
|
|
* effect as a byte read. Before using this function you must double-check
|
|
|
|
* if the I2C slave does support exchanging a block transfer with a byte
|
|
|
|
* transfer.
|
|
|
|
*/
|
|
|
|
s32 i2c_smbus_read_i2c_block_data_or_emulated(const struct i2c_client *client,
|
|
|
|
u8 command, u8 length, u8 *values)
|
|
|
|
{
|
|
|
|
u8 i = 0;
|
|
|
|
int status;
|
|
|
|
|
|
|
|
if (length > I2C_SMBUS_BLOCK_MAX)
|
|
|
|
length = I2C_SMBUS_BLOCK_MAX;
|
|
|
|
|
|
|
|
if (i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_READ_I2C_BLOCK))
|
|
|
|
return i2c_smbus_read_i2c_block_data(client, command, length, values);
|
|
|
|
|
|
|
|
if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_READ_BYTE_DATA))
|
|
|
|
return -EOPNOTSUPP;
|
|
|
|
|
|
|
|
if (i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_READ_WORD_DATA)) {
|
|
|
|
while ((i + 2) <= length) {
|
|
|
|
status = i2c_smbus_read_word_data(client, command + i);
|
|
|
|
if (status < 0)
|
|
|
|
return status;
|
|
|
|
values[i] = status & 0xff;
|
|
|
|
values[i + 1] = status >> 8;
|
|
|
|
i += 2;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
while (i < length) {
|
|
|
|
status = i2c_smbus_read_byte_data(client, command + i);
|
|
|
|
if (status < 0)
|
|
|
|
return status;
|
|
|
|
values[i] = status;
|
|
|
|
i++;
|
|
|
|
}
|
|
|
|
|
|
|
|
return i;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(i2c_smbus_read_i2c_block_data_or_emulated);
|
|
|
|
|
2015-01-26 12:59:31 -07:00
|
|
|
#if IS_ENABLED(CONFIG_I2C_SLAVE)
|
2014-11-18 09:04:53 -07:00
|
|
|
int i2c_slave_register(struct i2c_client *client, i2c_slave_cb_t slave_cb)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
|
2015-05-14 06:40:05 -06:00
|
|
|
if (!client || !slave_cb) {
|
|
|
|
WARN(1, "insufficent data\n");
|
2014-11-18 09:04:53 -07:00
|
|
|
return -EINVAL;
|
2015-05-14 06:40:05 -06:00
|
|
|
}
|
2014-11-18 09:04:53 -07:00
|
|
|
|
2015-08-05 13:12:54 -06:00
|
|
|
if (!(client->flags & I2C_CLIENT_SLAVE))
|
|
|
|
dev_warn(&client->dev, "%s: client slave flag not set. You might see address collisions\n",
|
|
|
|
__func__);
|
|
|
|
|
2014-11-18 09:04:53 -07:00
|
|
|
if (!(client->flags & I2C_CLIENT_TEN)) {
|
|
|
|
/* Enforce stricter address checking */
|
2015-07-17 04:43:22 -06:00
|
|
|
ret = i2c_check_7bit_addr_validity_strict(client->addr);
|
2015-05-14 06:40:05 -06:00
|
|
|
if (ret) {
|
|
|
|
dev_err(&client->dev, "%s: invalid address\n", __func__);
|
2014-11-18 09:04:53 -07:00
|
|
|
return ret;
|
2015-05-14 06:40:05 -06:00
|
|
|
}
|
2014-11-18 09:04:53 -07:00
|
|
|
}
|
|
|
|
|
2015-05-14 06:40:05 -06:00
|
|
|
if (!client->adapter->algo->reg_slave) {
|
|
|
|
dev_err(&client->dev, "%s: not supported by adapter\n", __func__);
|
2014-11-18 09:04:53 -07:00
|
|
|
return -EOPNOTSUPP;
|
2015-05-14 06:40:05 -06:00
|
|
|
}
|
2014-11-18 09:04:53 -07:00
|
|
|
|
|
|
|
client->slave_cb = slave_cb;
|
|
|
|
|
|
|
|
i2c_lock_adapter(client->adapter);
|
|
|
|
ret = client->adapter->algo->reg_slave(client);
|
|
|
|
i2c_unlock_adapter(client->adapter);
|
|
|
|
|
2015-05-14 06:40:05 -06:00
|
|
|
if (ret) {
|
2014-11-18 09:04:53 -07:00
|
|
|
client->slave_cb = NULL;
|
2015-05-14 06:40:05 -06:00
|
|
|
dev_err(&client->dev, "%s: adapter returned error %d\n", __func__, ret);
|
|
|
|
}
|
2014-11-18 09:04:53 -07:00
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(i2c_slave_register);
|
|
|
|
|
|
|
|
int i2c_slave_unregister(struct i2c_client *client)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
|
2015-05-14 06:40:05 -06:00
|
|
|
if (!client->adapter->algo->unreg_slave) {
|
|
|
|
dev_err(&client->dev, "%s: not supported by adapter\n", __func__);
|
2014-11-18 09:04:53 -07:00
|
|
|
return -EOPNOTSUPP;
|
2015-05-14 06:40:05 -06:00
|
|
|
}
|
2014-11-18 09:04:53 -07:00
|
|
|
|
|
|
|
i2c_lock_adapter(client->adapter);
|
|
|
|
ret = client->adapter->algo->unreg_slave(client);
|
|
|
|
i2c_unlock_adapter(client->adapter);
|
|
|
|
|
|
|
|
if (ret == 0)
|
|
|
|
client->slave_cb = NULL;
|
2015-05-14 06:40:05 -06:00
|
|
|
else
|
|
|
|
dev_err(&client->dev, "%s: adapter returned error %d\n", __func__, ret);
|
2014-11-18 09:04:53 -07:00
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(i2c_slave_unregister);
|
2015-01-26 12:59:31 -07:00
|
|
|
#endif
|
2014-11-18 09:04:53 -07:00
|
|
|
|
2005-04-16 16:20:36 -06:00
|
|
|
MODULE_AUTHOR("Simon G. Vogl <simon@tk.uni-linz.ac.at>");
|
|
|
|
MODULE_DESCRIPTION("I2C-Bus main module");
|
|
|
|
MODULE_LICENSE("GPL");
|