2 * Copyright (c) 2016-2019 François Tigeot <ftigeot@wolfpond.org>
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice unmodified, this list of conditions, and the following
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 #include <linux/i2c.h>
28 #include <linux/i2c-algo-bit.h>
30 #include <linux/slab.h>
32 static struct lock i2c_lock;
33 LOCK_SYSINIT(i2c_lock, &i2c_lock, "i2cl", LK_CANRECURSE);
36 i2c_add_adapter(struct i2c_adapter *adapter)
38 /* Linux registers a unique bus number here */
43 i2c_del_adapter(struct i2c_adapter *adapter)
45 /* Linux deletes a unique bus number here */
50 * The original Linux implementation does:
51 * 1. return -EOPNOTSUPP if adapter->algo->master_xfer is NULL
52 * 2. try to transfer msgs by calling adapter->algo->master_xfer()
53 * 3. if it took more ticks than adapter->timeout, fail
54 * 4. if the transfer failed, retry up to adapter->retries times
55 * 5. return the result of the last call of adapter->algo->master_xfer()
58 i2c_transfer(struct i2c_adapter *adapter, struct i2c_msg *msgs, int num)
63 if (adapter->algo->master_xfer == NULL)
66 lockmgr(&i2c_lock, LK_EXCLUSIVE);
69 ret = adapter->algo->master_xfer(adapter, msgs, num);
70 if (ticks > start_ticks + adapter->timeout)
75 } while (tries < adapter->retries);
76 lockmgr(&i2c_lock, LK_RELEASE);
82 bit_xfer(struct i2c_adapter *i2c_adap, struct i2c_msg msgs[], int num)
84 /* XXX Linux really does try to transfer some data here */
89 bit_func(struct i2c_adapter *adap)
91 return (I2C_FUNC_I2C | I2C_FUNC_NOSTART | I2C_FUNC_SMBUS_EMUL |
92 I2C_FUNC_SMBUS_READ_BLOCK_DATA |
93 I2C_FUNC_SMBUS_BLOCK_PROC_CALL |
94 I2C_FUNC_10BIT_ADDR | I2C_FUNC_PROTOCOL_MANGLING);
97 const struct i2c_algorithm i2c_bit_algo = {
98 .master_xfer = bit_xfer,
99 .functionality = bit_func,
103 i2c_bit_add_bus(struct i2c_adapter *adapter)
105 adapter->algo = &i2c_bit_algo;
106 adapter->retries = 2;
112 i2c_new_device(struct i2c_adapter *adap, struct i2c_board_info const *info)
114 struct i2c_client *client;
116 client = kzalloc(sizeof(*client), GFP_KERNEL);
120 client->adapter = adap;
122 strlcpy(client->name, info->type, sizeof(client->name));
123 client->addr = info->addr;