Loading...
1/*
2 * CBUS I2C driver for Nokia Internet Tablets.
3 *
4 * Copyright (C) 2004-2010 Nokia Corporation
5 *
6 * Based on code written by Juha Yrjölä, David Weinehall, Mikko Ylinen and
7 * Felipe Balbi. Converted to I2C driver by Aaro Koskinen.
8 *
9 * This file is subject to the terms and conditions of the GNU General
10 * Public License. See the file "COPYING" in the main directory of this
11 * archive for more details.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 */
18
19#include <linux/io.h>
20#include <linux/i2c.h>
21#include <linux/slab.h>
22#include <linux/delay.h>
23#include <linux/errno.h>
24#include <linux/kernel.h>
25#include <linux/module.h>
26#include <linux/gpio/consumer.h>
27#include <linux/interrupt.h>
28#include <linux/platform_device.h>
29
30/*
31 * Bit counts are derived from Nokia implementation. These should be checked
32 * if other CBUS implementations appear.
33 */
34#define CBUS_ADDR_BITS 3
35#define CBUS_REG_BITS 5
36
37struct cbus_host {
38 spinlock_t lock; /* host lock */
39 struct device *dev;
40 struct gpio_desc *clk;
41 struct gpio_desc *dat;
42 struct gpio_desc *sel;
43};
44
45/**
46 * cbus_send_bit - sends one bit over the bus
47 * @host: the host we're using
48 * @bit: one bit of information to send
49 */
50static void cbus_send_bit(struct cbus_host *host, unsigned bit)
51{
52 gpiod_set_value(host->dat, bit ? 1 : 0);
53 gpiod_set_value(host->clk, 1);
54 gpiod_set_value(host->clk, 0);
55}
56
57/**
58 * cbus_send_data - sends @len amount of data over the bus
59 * @host: the host we're using
60 * @data: the data to send
61 * @len: size of the transfer
62 */
63static void cbus_send_data(struct cbus_host *host, unsigned data, unsigned len)
64{
65 int i;
66
67 for (i = len; i > 0; i--)
68 cbus_send_bit(host, data & (1 << (i - 1)));
69}
70
71/**
72 * cbus_receive_bit - receives one bit from the bus
73 * @host: the host we're using
74 */
75static int cbus_receive_bit(struct cbus_host *host)
76{
77 int ret;
78
79 gpiod_set_value(host->clk, 1);
80 ret = gpiod_get_value(host->dat);
81 gpiod_set_value(host->clk, 0);
82 return ret;
83}
84
85/**
86 * cbus_receive_word - receives 16-bit word from the bus
87 * @host: the host we're using
88 */
89static int cbus_receive_word(struct cbus_host *host)
90{
91 int ret = 0;
92 int i;
93
94 for (i = 16; i > 0; i--) {
95 int bit = cbus_receive_bit(host);
96
97 if (bit < 0)
98 return bit;
99
100 if (bit)
101 ret |= 1 << (i - 1);
102 }
103 return ret;
104}
105
106/**
107 * cbus_transfer - transfers data over the bus
108 * @host: the host we're using
109 * @rw: read/write flag
110 * @dev: device address
111 * @reg: register address
112 * @data: if @rw == I2C_SBUS_WRITE data to send otherwise 0
113 */
114static int cbus_transfer(struct cbus_host *host, char rw, unsigned dev,
115 unsigned reg, unsigned data)
116{
117 unsigned long flags;
118 int ret;
119
120 /* We don't want interrupts disturbing our transfer */
121 spin_lock_irqsave(&host->lock, flags);
122
123 /* Reset state and start of transfer, SEL stays down during transfer */
124 gpiod_set_value(host->sel, 0);
125
126 /* Set the DAT pin to output */
127 gpiod_direction_output(host->dat, 1);
128
129 /* Send the device address */
130 cbus_send_data(host, dev, CBUS_ADDR_BITS);
131
132 /* Send the rw flag */
133 cbus_send_bit(host, rw == I2C_SMBUS_READ);
134
135 /* Send the register address */
136 cbus_send_data(host, reg, CBUS_REG_BITS);
137
138 if (rw == I2C_SMBUS_WRITE) {
139 cbus_send_data(host, data, 16);
140 ret = 0;
141 } else {
142 ret = gpiod_direction_input(host->dat);
143 if (ret) {
144 dev_dbg(host->dev, "failed setting direction\n");
145 goto out;
146 }
147 gpiod_set_value(host->clk, 1);
148
149 ret = cbus_receive_word(host);
150 if (ret < 0) {
151 dev_dbg(host->dev, "failed receiving data\n");
152 goto out;
153 }
154 }
155
156 /* Indicate end of transfer, SEL goes up until next transfer */
157 gpiod_set_value(host->sel, 1);
158 gpiod_set_value(host->clk, 1);
159 gpiod_set_value(host->clk, 0);
160
161out:
162 spin_unlock_irqrestore(&host->lock, flags);
163
164 return ret;
165}
166
167static int cbus_i2c_smbus_xfer(struct i2c_adapter *adapter,
168 u16 addr,
169 unsigned short flags,
170 char read_write,
171 u8 command,
172 int size,
173 union i2c_smbus_data *data)
174{
175 struct cbus_host *chost = i2c_get_adapdata(adapter);
176 int ret;
177
178 if (size != I2C_SMBUS_WORD_DATA)
179 return -EINVAL;
180
181 ret = cbus_transfer(chost, read_write == I2C_SMBUS_READ, addr,
182 command, data->word);
183 if (ret < 0)
184 return ret;
185
186 if (read_write == I2C_SMBUS_READ)
187 data->word = ret;
188
189 return 0;
190}
191
192static u32 cbus_i2c_func(struct i2c_adapter *adapter)
193{
194 return I2C_FUNC_SMBUS_READ_WORD_DATA | I2C_FUNC_SMBUS_WRITE_WORD_DATA;
195}
196
197static const struct i2c_algorithm cbus_i2c_algo = {
198 .smbus_xfer = cbus_i2c_smbus_xfer,
199 .smbus_xfer_atomic = cbus_i2c_smbus_xfer,
200 .functionality = cbus_i2c_func,
201};
202
203static void cbus_i2c_remove(struct platform_device *pdev)
204{
205 struct i2c_adapter *adapter = platform_get_drvdata(pdev);
206
207 i2c_del_adapter(adapter);
208}
209
210static int cbus_i2c_probe(struct platform_device *pdev)
211{
212 struct i2c_adapter *adapter;
213 struct cbus_host *chost;
214
215 adapter = devm_kzalloc(&pdev->dev, sizeof(struct i2c_adapter),
216 GFP_KERNEL);
217 if (!adapter)
218 return -ENOMEM;
219
220 chost = devm_kzalloc(&pdev->dev, sizeof(*chost), GFP_KERNEL);
221 if (!chost)
222 return -ENOMEM;
223
224 if (gpiod_count(&pdev->dev, NULL) != 3)
225 return -ENODEV;
226 chost->clk = devm_gpiod_get_index(&pdev->dev, NULL, 0, GPIOD_OUT_LOW);
227 if (IS_ERR(chost->clk))
228 return PTR_ERR(chost->clk);
229 chost->dat = devm_gpiod_get_index(&pdev->dev, NULL, 1, GPIOD_IN);
230 if (IS_ERR(chost->dat))
231 return PTR_ERR(chost->dat);
232 chost->sel = devm_gpiod_get_index(&pdev->dev, NULL, 2, GPIOD_OUT_HIGH);
233 if (IS_ERR(chost->sel))
234 return PTR_ERR(chost->sel);
235 gpiod_set_consumer_name(chost->clk, "CBUS clk");
236 gpiod_set_consumer_name(chost->dat, "CBUS dat");
237 gpiod_set_consumer_name(chost->sel, "CBUS sel");
238
239 adapter->owner = THIS_MODULE;
240 adapter->class = I2C_CLASS_HWMON;
241 adapter->dev.parent = &pdev->dev;
242 adapter->dev.of_node = pdev->dev.of_node;
243 adapter->nr = pdev->id;
244 adapter->timeout = HZ;
245 adapter->algo = &cbus_i2c_algo;
246 strscpy(adapter->name, "CBUS I2C adapter", sizeof(adapter->name));
247
248 spin_lock_init(&chost->lock);
249 chost->dev = &pdev->dev;
250
251 i2c_set_adapdata(adapter, chost);
252 platform_set_drvdata(pdev, adapter);
253
254 return i2c_add_numbered_adapter(adapter);
255}
256
257#if defined(CONFIG_OF)
258static const struct of_device_id i2c_cbus_dt_ids[] = {
259 { .compatible = "i2c-cbus-gpio", },
260 { }
261};
262MODULE_DEVICE_TABLE(of, i2c_cbus_dt_ids);
263#endif
264
265static struct platform_driver cbus_i2c_driver = {
266 .probe = cbus_i2c_probe,
267 .remove = cbus_i2c_remove,
268 .driver = {
269 .name = "i2c-cbus-gpio",
270 .of_match_table = of_match_ptr(i2c_cbus_dt_ids),
271 },
272};
273module_platform_driver(cbus_i2c_driver);
274
275MODULE_ALIAS("platform:i2c-cbus-gpio");
276MODULE_DESCRIPTION("CBUS I2C driver");
277MODULE_AUTHOR("Juha Yrjölä");
278MODULE_AUTHOR("David Weinehall");
279MODULE_AUTHOR("Mikko Ylinen");
280MODULE_AUTHOR("Felipe Balbi");
281MODULE_AUTHOR("Aaro Koskinen <aaro.koskinen@iki.fi>");
282MODULE_LICENSE("GPL");
1/*
2 * CBUS I2C driver for Nokia Internet Tablets.
3 *
4 * Copyright (C) 2004-2010 Nokia Corporation
5 *
6 * Based on code written by Juha Yrjölä, David Weinehall, Mikko Ylinen and
7 * Felipe Balbi. Converted to I2C driver by Aaro Koskinen.
8 *
9 * This file is subject to the terms and conditions of the GNU General
10 * Public License. See the file "COPYING" in the main directory of this
11 * archive for more details.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 */
18
19#include <linux/io.h>
20#include <linux/i2c.h>
21#include <linux/gpio.h>
22#include <linux/slab.h>
23#include <linux/delay.h>
24#include <linux/errno.h>
25#include <linux/kernel.h>
26#include <linux/module.h>
27#include <linux/of_gpio.h>
28#include <linux/interrupt.h>
29#include <linux/platform_device.h>
30#include <linux/platform_data/i2c-cbus-gpio.h>
31
32/*
33 * Bit counts are derived from Nokia implementation. These should be checked
34 * if other CBUS implementations appear.
35 */
36#define CBUS_ADDR_BITS 3
37#define CBUS_REG_BITS 5
38
39struct cbus_host {
40 spinlock_t lock; /* host lock */
41 struct device *dev;
42 int clk_gpio;
43 int dat_gpio;
44 int sel_gpio;
45};
46
47/**
48 * cbus_send_bit - sends one bit over the bus
49 * @host: the host we're using
50 * @bit: one bit of information to send
51 */
52static void cbus_send_bit(struct cbus_host *host, unsigned bit)
53{
54 gpio_set_value(host->dat_gpio, bit ? 1 : 0);
55 gpio_set_value(host->clk_gpio, 1);
56 gpio_set_value(host->clk_gpio, 0);
57}
58
59/**
60 * cbus_send_data - sends @len amount of data over the bus
61 * @host: the host we're using
62 * @data: the data to send
63 * @len: size of the transfer
64 */
65static void cbus_send_data(struct cbus_host *host, unsigned data, unsigned len)
66{
67 int i;
68
69 for (i = len; i > 0; i--)
70 cbus_send_bit(host, data & (1 << (i - 1)));
71}
72
73/**
74 * cbus_receive_bit - receives one bit from the bus
75 * @host: the host we're using
76 */
77static int cbus_receive_bit(struct cbus_host *host)
78{
79 int ret;
80
81 gpio_set_value(host->clk_gpio, 1);
82 ret = gpio_get_value(host->dat_gpio);
83 gpio_set_value(host->clk_gpio, 0);
84 return ret;
85}
86
87/**
88 * cbus_receive_word - receives 16-bit word from the bus
89 * @host: the host we're using
90 */
91static int cbus_receive_word(struct cbus_host *host)
92{
93 int ret = 0;
94 int i;
95
96 for (i = 16; i > 0; i--) {
97 int bit = cbus_receive_bit(host);
98
99 if (bit < 0)
100 return bit;
101
102 if (bit)
103 ret |= 1 << (i - 1);
104 }
105 return ret;
106}
107
108/**
109 * cbus_transfer - transfers data over the bus
110 * @host: the host we're using
111 * @rw: read/write flag
112 * @dev: device address
113 * @reg: register address
114 * @data: if @rw == I2C_SBUS_WRITE data to send otherwise 0
115 */
116static int cbus_transfer(struct cbus_host *host, char rw, unsigned dev,
117 unsigned reg, unsigned data)
118{
119 unsigned long flags;
120 int ret;
121
122 /* We don't want interrupts disturbing our transfer */
123 spin_lock_irqsave(&host->lock, flags);
124
125 /* Reset state and start of transfer, SEL stays down during transfer */
126 gpio_set_value(host->sel_gpio, 0);
127
128 /* Set the DAT pin to output */
129 gpio_direction_output(host->dat_gpio, 1);
130
131 /* Send the device address */
132 cbus_send_data(host, dev, CBUS_ADDR_BITS);
133
134 /* Send the rw flag */
135 cbus_send_bit(host, rw == I2C_SMBUS_READ);
136
137 /* Send the register address */
138 cbus_send_data(host, reg, CBUS_REG_BITS);
139
140 if (rw == I2C_SMBUS_WRITE) {
141 cbus_send_data(host, data, 16);
142 ret = 0;
143 } else {
144 ret = gpio_direction_input(host->dat_gpio);
145 if (ret) {
146 dev_dbg(host->dev, "failed setting direction\n");
147 goto out;
148 }
149 gpio_set_value(host->clk_gpio, 1);
150
151 ret = cbus_receive_word(host);
152 if (ret < 0) {
153 dev_dbg(host->dev, "failed receiving data\n");
154 goto out;
155 }
156 }
157
158 /* Indicate end of transfer, SEL goes up until next transfer */
159 gpio_set_value(host->sel_gpio, 1);
160 gpio_set_value(host->clk_gpio, 1);
161 gpio_set_value(host->clk_gpio, 0);
162
163out:
164 spin_unlock_irqrestore(&host->lock, flags);
165
166 return ret;
167}
168
169static int cbus_i2c_smbus_xfer(struct i2c_adapter *adapter,
170 u16 addr,
171 unsigned short flags,
172 char read_write,
173 u8 command,
174 int size,
175 union i2c_smbus_data *data)
176{
177 struct cbus_host *chost = i2c_get_adapdata(adapter);
178 int ret;
179
180 if (size != I2C_SMBUS_WORD_DATA)
181 return -EINVAL;
182
183 ret = cbus_transfer(chost, read_write == I2C_SMBUS_READ, addr,
184 command, data->word);
185 if (ret < 0)
186 return ret;
187
188 if (read_write == I2C_SMBUS_READ)
189 data->word = ret;
190
191 return 0;
192}
193
194static u32 cbus_i2c_func(struct i2c_adapter *adapter)
195{
196 return I2C_FUNC_SMBUS_READ_WORD_DATA | I2C_FUNC_SMBUS_WRITE_WORD_DATA;
197}
198
199static const struct i2c_algorithm cbus_i2c_algo = {
200 .smbus_xfer = cbus_i2c_smbus_xfer,
201 .functionality = cbus_i2c_func,
202};
203
204static int cbus_i2c_remove(struct platform_device *pdev)
205{
206 struct i2c_adapter *adapter = platform_get_drvdata(pdev);
207
208 i2c_del_adapter(adapter);
209
210 return 0;
211}
212
213static int cbus_i2c_probe(struct platform_device *pdev)
214{
215 struct i2c_adapter *adapter;
216 struct cbus_host *chost;
217 int ret;
218
219 adapter = devm_kzalloc(&pdev->dev, sizeof(struct i2c_adapter),
220 GFP_KERNEL);
221 if (!adapter)
222 return -ENOMEM;
223
224 chost = devm_kzalloc(&pdev->dev, sizeof(*chost), GFP_KERNEL);
225 if (!chost)
226 return -ENOMEM;
227
228 if (pdev->dev.of_node) {
229 struct device_node *dnode = pdev->dev.of_node;
230 if (of_gpio_count(dnode) != 3)
231 return -ENODEV;
232 chost->clk_gpio = of_get_gpio(dnode, 0);
233 chost->dat_gpio = of_get_gpio(dnode, 1);
234 chost->sel_gpio = of_get_gpio(dnode, 2);
235 } else if (dev_get_platdata(&pdev->dev)) {
236 struct i2c_cbus_platform_data *pdata =
237 dev_get_platdata(&pdev->dev);
238 chost->clk_gpio = pdata->clk_gpio;
239 chost->dat_gpio = pdata->dat_gpio;
240 chost->sel_gpio = pdata->sel_gpio;
241 } else {
242 return -ENODEV;
243 }
244
245 adapter->owner = THIS_MODULE;
246 adapter->class = I2C_CLASS_HWMON;
247 adapter->dev.parent = &pdev->dev;
248 adapter->dev.of_node = pdev->dev.of_node;
249 adapter->nr = pdev->id;
250 adapter->timeout = HZ;
251 adapter->algo = &cbus_i2c_algo;
252 strlcpy(adapter->name, "CBUS I2C adapter", sizeof(adapter->name));
253
254 spin_lock_init(&chost->lock);
255 chost->dev = &pdev->dev;
256
257 ret = devm_gpio_request_one(&pdev->dev, chost->clk_gpio,
258 GPIOF_OUT_INIT_LOW, "CBUS clk");
259 if (ret)
260 return ret;
261
262 ret = devm_gpio_request_one(&pdev->dev, chost->dat_gpio, GPIOF_IN,
263 "CBUS data");
264 if (ret)
265 return ret;
266
267 ret = devm_gpio_request_one(&pdev->dev, chost->sel_gpio,
268 GPIOF_OUT_INIT_HIGH, "CBUS sel");
269 if (ret)
270 return ret;
271
272 i2c_set_adapdata(adapter, chost);
273 platform_set_drvdata(pdev, adapter);
274
275 return i2c_add_numbered_adapter(adapter);
276}
277
278#if defined(CONFIG_OF)
279static const struct of_device_id i2c_cbus_dt_ids[] = {
280 { .compatible = "i2c-cbus-gpio", },
281 { }
282};
283MODULE_DEVICE_TABLE(of, i2c_cbus_dt_ids);
284#endif
285
286static struct platform_driver cbus_i2c_driver = {
287 .probe = cbus_i2c_probe,
288 .remove = cbus_i2c_remove,
289 .driver = {
290 .owner = THIS_MODULE,
291 .name = "i2c-cbus-gpio",
292 .of_match_table = of_match_ptr(i2c_cbus_dt_ids),
293 },
294};
295module_platform_driver(cbus_i2c_driver);
296
297MODULE_ALIAS("platform:i2c-cbus-gpio");
298MODULE_DESCRIPTION("CBUS I2C driver");
299MODULE_AUTHOR("Juha Yrjölä");
300MODULE_AUTHOR("David Weinehall");
301MODULE_AUTHOR("Mikko Ylinen");
302MODULE_AUTHOR("Felipe Balbi");
303MODULE_AUTHOR("Aaro Koskinen <aaro.koskinen@iki.fi>");
304MODULE_LICENSE("GPL");