1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include <linux/module.h>
23#include <linux/moduleparam.h>
24#include <linux/init.h>
25#include <linux/delay.h>
26#include <linux/io.h>
27
28#include "au0828.h"
29
30#include <media/v4l2-common.h>
31
32static int i2c_scan;
33module_param(i2c_scan, int, 0444);
34MODULE_PARM_DESC(i2c_scan, "scan i2c bus at insmod time");
35
36#define I2C_WAIT_DELAY 512
37#define I2C_WAIT_RETRY 64
38
39static inline int i2c_slave_did_write_ack(struct i2c_adapter *i2c_adap)
40{
41 struct au0828_dev *dev = i2c_adap->algo_data;
42 return au0828_read(dev, AU0828_I2C_STATUS_201) &
43 AU0828_I2C_STATUS_NO_WRITE_ACK ? 0 : 1;
44}
45
46static inline int i2c_slave_did_read_ack(struct i2c_adapter *i2c_adap)
47{
48 struct au0828_dev *dev = i2c_adap->algo_data;
49 return au0828_read(dev, AU0828_I2C_STATUS_201) &
50 AU0828_I2C_STATUS_NO_READ_ACK ? 0 : 1;
51}
52
53static int i2c_wait_read_ack(struct i2c_adapter *i2c_adap)
54{
55 int count;
56
57 for (count = 0; count < I2C_WAIT_RETRY; count++) {
58 if (!i2c_slave_did_read_ack(i2c_adap))
59 break;
60 udelay(I2C_WAIT_DELAY);
61 }
62
63 if (I2C_WAIT_RETRY == count)
64 return 0;
65
66 return 1;
67}
68
69static inline int i2c_is_read_busy(struct i2c_adapter *i2c_adap)
70{
71 struct au0828_dev *dev = i2c_adap->algo_data;
72 return au0828_read(dev, AU0828_I2C_STATUS_201) &
73 AU0828_I2C_STATUS_READ_DONE ? 0 : 1;
74}
75
76static int i2c_wait_read_done(struct i2c_adapter *i2c_adap)
77{
78 int count;
79
80 for (count = 0; count < I2C_WAIT_RETRY; count++) {
81 if (!i2c_is_read_busy(i2c_adap))
82 break;
83 udelay(I2C_WAIT_DELAY);
84 }
85
86 if (I2C_WAIT_RETRY == count)
87 return 0;
88
89 return 1;
90}
91
92static inline int i2c_is_write_done(struct i2c_adapter *i2c_adap)
93{
94 struct au0828_dev *dev = i2c_adap->algo_data;
95 return au0828_read(dev, AU0828_I2C_STATUS_201) &
96 AU0828_I2C_STATUS_WRITE_DONE ? 1 : 0;
97}
98
99static int i2c_wait_write_done(struct i2c_adapter *i2c_adap)
100{
101 int count;
102
103 for (count = 0; count < I2C_WAIT_RETRY; count++) {
104 if (i2c_is_write_done(i2c_adap))
105 break;
106 udelay(I2C_WAIT_DELAY);
107 }
108
109 if (I2C_WAIT_RETRY == count)
110 return 0;
111
112 return 1;
113}
114
115static inline int i2c_is_busy(struct i2c_adapter *i2c_adap)
116{
117 struct au0828_dev *dev = i2c_adap->algo_data;
118 return au0828_read(dev, AU0828_I2C_STATUS_201) &
119 AU0828_I2C_STATUS_BUSY ? 1 : 0;
120}
121
122static int i2c_wait_done(struct i2c_adapter *i2c_adap)
123{
124 int count;
125
126 for (count = 0; count < I2C_WAIT_RETRY; count++) {
127 if (!i2c_is_busy(i2c_adap))
128 break;
129 udelay(I2C_WAIT_DELAY);
130 }
131
132 if (I2C_WAIT_RETRY == count)
133 return 0;
134
135 return 1;
136}
137
138
139static int i2c_sendbytes(struct i2c_adapter *i2c_adap,
140 const struct i2c_msg *msg, int joined_rlen)
141{
142 int i, strobe = 0;
143 struct au0828_dev *dev = i2c_adap->algo_data;
144
145 dprintk(4, "%s()\n", __func__);
146
147 au0828_write(dev, AU0828_I2C_MULTIBYTE_MODE_2FF, 0x01);
148
149
150 au0828_write(dev, AU0828_I2C_CLK_DIVIDER_202,
151 dev->board.i2c_clk_divider);
152
153
154 au0828_write(dev, AU0828_I2C_DEST_ADDR_203, msg->addr << 1);
155
156 dprintk(4, "SEND: %02x\n", msg->addr);
157
158
159 if (msg->len == 0) {
160
161
162
163
164
165
166 au0828_write(dev, AU0828_I2C_TRIGGER_200,
167 AU0828_I2C_TRIGGER_READ);
168
169 if (!i2c_wait_done(i2c_adap))
170 return -EIO;
171
172 if (i2c_wait_read_ack(i2c_adap))
173 return -EIO;
174
175 return 0;
176 }
177
178 for (i = 0; i < msg->len;) {
179
180 dprintk(4, " %02x\n", msg->buf[i]);
181
182 au0828_write(dev, AU0828_I2C_WRITE_FIFO_205, msg->buf[i]);
183
184 strobe++;
185 i++;
186
187 if ((strobe >= 4) || (i >= msg->len)) {
188
189
190 if (i < msg->len)
191 au0828_write(dev, AU0828_I2C_TRIGGER_200,
192 AU0828_I2C_TRIGGER_WRITE |
193 AU0828_I2C_TRIGGER_HOLD);
194 else
195 au0828_write(dev, AU0828_I2C_TRIGGER_200,
196 AU0828_I2C_TRIGGER_WRITE);
197
198
199 strobe = 0;
200
201 if (!i2c_wait_write_done(i2c_adap))
202 return -EIO;
203
204 }
205
206 }
207 if (!i2c_wait_done(i2c_adap))
208 return -EIO;
209
210 dprintk(4, "\n");
211
212 return msg->len;
213}
214
215
216static int i2c_readbytes(struct i2c_adapter *i2c_adap,
217 const struct i2c_msg *msg, int joined)
218{
219 struct au0828_dev *dev = i2c_adap->algo_data;
220 int i;
221
222 dprintk(4, "%s()\n", __func__);
223
224 au0828_write(dev, AU0828_I2C_MULTIBYTE_MODE_2FF, 0x01);
225
226
227 au0828_write(dev, AU0828_I2C_CLK_DIVIDER_202,
228 dev->board.i2c_clk_divider);
229
230
231 au0828_write(dev, AU0828_I2C_DEST_ADDR_203, msg->addr << 1);
232
233 dprintk(4, " RECV:\n");
234
235
236 if (msg->len == 0) {
237 au0828_write(dev, AU0828_I2C_TRIGGER_200,
238 AU0828_I2C_TRIGGER_READ);
239
240 if (i2c_wait_read_ack(i2c_adap))
241 return -EIO;
242 return 0;
243 }
244
245 for (i = 0; i < msg->len;) {
246
247 i++;
248
249 if (i < msg->len)
250 au0828_write(dev, AU0828_I2C_TRIGGER_200,
251 AU0828_I2C_TRIGGER_READ |
252 AU0828_I2C_TRIGGER_HOLD);
253 else
254 au0828_write(dev, AU0828_I2C_TRIGGER_200,
255 AU0828_I2C_TRIGGER_READ);
256
257 if (!i2c_wait_read_done(i2c_adap))
258 return -EIO;
259
260 msg->buf[i-1] = au0828_read(dev, AU0828_I2C_READ_FIFO_209) &
261 0xff;
262
263 dprintk(4, " %02x\n", msg->buf[i-1]);
264 }
265 if (!i2c_wait_done(i2c_adap))
266 return -EIO;
267
268 dprintk(4, "\n");
269
270 return msg->len;
271}
272
273static int i2c_xfer(struct i2c_adapter *i2c_adap,
274 struct i2c_msg *msgs, int num)
275{
276 int i, retval = 0;
277
278 dprintk(4, "%s(num = %d)\n", __func__, num);
279
280 for (i = 0; i < num; i++) {
281 dprintk(4, "%s(num = %d) addr = 0x%02x len = 0x%x\n",
282 __func__, num, msgs[i].addr, msgs[i].len);
283 if (msgs[i].flags & I2C_M_RD) {
284
285 retval = i2c_readbytes(i2c_adap, &msgs[i], 0);
286 } else if (i + 1 < num && (msgs[i + 1].flags & I2C_M_RD) &&
287 msgs[i].addr == msgs[i + 1].addr) {
288
289 retval = i2c_sendbytes(i2c_adap, &msgs[i],
290 msgs[i + 1].len);
291 if (retval < 0)
292 goto err;
293 i++;
294 retval = i2c_readbytes(i2c_adap, &msgs[i], 1);
295 } else {
296
297 retval = i2c_sendbytes(i2c_adap, &msgs[i], 0);
298 }
299 if (retval < 0)
300 goto err;
301 }
302 return num;
303
304err:
305 return retval;
306}
307
308static u32 au0828_functionality(struct i2c_adapter *adap)
309{
310 return I2C_FUNC_SMBUS_EMUL | I2C_FUNC_I2C;
311}
312
313static struct i2c_algorithm au0828_i2c_algo_template = {
314 .master_xfer = i2c_xfer,
315 .functionality = au0828_functionality,
316};
317
318
319
320static struct i2c_adapter au0828_i2c_adap_template = {
321 .name = DRIVER_NAME,
322 .owner = THIS_MODULE,
323 .algo = &au0828_i2c_algo_template,
324};
325
326static struct i2c_client au0828_i2c_client_template = {
327 .name = "au0828 internal",
328};
329
330static char *i2c_devs[128] = {
331 [0x8e >> 1] = "au8522",
332 [0xa0 >> 1] = "eeprom",
333 [0xc2 >> 1] = "tuner/xc5000",
334};
335
336static void do_i2c_scan(char *name, struct i2c_client *c)
337{
338 unsigned char buf;
339 int i, rc;
340
341 for (i = 0; i < 128; i++) {
342 c->addr = i;
343 rc = i2c_master_recv(c, &buf, 0);
344 if (rc < 0)
345 continue;
346 printk(KERN_INFO "%s: i2c scan: found device @ 0x%x [%s]\n",
347 name, i << 1, i2c_devs[i] ? i2c_devs[i] : "???");
348 }
349}
350
351
352int au0828_i2c_register(struct au0828_dev *dev)
353{
354 dprintk(1, "%s()\n", __func__);
355
356 memcpy(&dev->i2c_adap, &au0828_i2c_adap_template,
357 sizeof(dev->i2c_adap));
358 memcpy(&dev->i2c_algo, &au0828_i2c_algo_template,
359 sizeof(dev->i2c_algo));
360 memcpy(&dev->i2c_client, &au0828_i2c_client_template,
361 sizeof(dev->i2c_client));
362
363 dev->i2c_adap.dev.parent = &dev->usbdev->dev;
364
365 strlcpy(dev->i2c_adap.name, DRIVER_NAME,
366 sizeof(dev->i2c_adap.name));
367
368 dev->i2c_adap.algo = &dev->i2c_algo;
369 dev->i2c_adap.algo_data = dev;
370 i2c_set_adapdata(&dev->i2c_adap, &dev->v4l2_dev);
371 i2c_add_adapter(&dev->i2c_adap);
372
373 dev->i2c_client.adapter = &dev->i2c_adap;
374
375 if (0 == dev->i2c_rc) {
376 printk(KERN_INFO "%s: i2c bus registered\n", DRIVER_NAME);
377 if (i2c_scan)
378 do_i2c_scan(DRIVER_NAME, &dev->i2c_client);
379 } else
380 printk(KERN_INFO "%s: i2c bus register FAILED\n", DRIVER_NAME);
381
382 return dev->i2c_rc;
383}
384
385int au0828_i2c_unregister(struct au0828_dev *dev)
386{
387 i2c_del_adapter(&dev->i2c_adap);
388 return 0;
389}
390
391