1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#include "cx231xx.h"
24#include <linux/module.h>
25#include <linux/kernel.h>
26#include <linux/i2c.h>
27#include <linux/i2c-mux.h>
28#include <media/v4l2-common.h>
29#include <media/tuner.h>
30
31
32
33
34static unsigned int i2c_scan;
35module_param(i2c_scan, int, 0444);
36MODULE_PARM_DESC(i2c_scan, "scan i2c bus at insmod time");
37
38static unsigned int i2c_debug;
39module_param(i2c_debug, int, 0644);
40MODULE_PARM_DESC(i2c_debug, "enable debug messages [i2c]");
41
42#define dprintk1(lvl, fmt, args...) \
43do { \
44 if (i2c_debug >= lvl) { \
45 printk(fmt, ##args); \
46 } \
47} while (0)
48
49#define dprintk2(lvl, fmt, args...) \
50do { \
51 if (i2c_debug >= lvl) { \
52 printk(KERN_DEBUG "%s at %s: " fmt, \
53 dev->name, __func__ , ##args); \
54 } \
55} while (0)
56
57static inline int get_real_i2c_port(struct cx231xx *dev, int bus_nr)
58{
59 if (bus_nr == 1)
60 return dev->port_3_switch_enabled ? I2C_1_MUX_3 : I2C_1_MUX_1;
61 return bus_nr;
62}
63
64static inline bool is_tuner(struct cx231xx *dev, struct cx231xx_i2c *bus,
65 const struct i2c_msg *msg, int tuner_type)
66{
67 int i2c_port = get_real_i2c_port(dev, bus->nr);
68
69 if (i2c_port != dev->board.tuner_i2c_master)
70 return false;
71
72 if (msg->addr != dev->board.tuner_addr)
73 return false;
74
75 if (dev->tuner_type != tuner_type)
76 return false;
77
78 return true;
79}
80
81
82
83
84static int cx231xx_i2c_send_bytes(struct i2c_adapter *i2c_adap,
85 const struct i2c_msg *msg)
86{
87 struct cx231xx_i2c *bus = i2c_adap->algo_data;
88 struct cx231xx *dev = bus->dev;
89 struct cx231xx_i2c_xfer_data req_data;
90 int status = 0;
91 u16 size = 0;
92 u8 loop = 0;
93 u8 saddr_len = 1;
94 u8 *buf_ptr = NULL;
95 u16 saddr = 0;
96 u8 need_gpio = 0;
97
98 if (is_tuner(dev, bus, msg, TUNER_XC5000)) {
99 size = msg->len;
100
101 if (size == 2) {
102
103
104 return 0;
105 } else if (size == 4) {
106 if (msg->len >= 2)
107 saddr = msg->buf[0] << 8 | msg->buf[1];
108 else if (msg->len == 1)
109 saddr = msg->buf[0];
110
111 switch (saddr) {
112 case 0x0000:
113 need_gpio = 1;
114
115 dev->xc_fw_load_done = 1;
116 break;
117 case 0x000D:
118 case 0x0001:
119 case 0x0002:
120 case 0x0003:
121 need_gpio = 1;
122 break;
123 default:
124 if (dev->xc_fw_load_done)
125 need_gpio = 1;
126 break;
127 }
128
129 if (need_gpio) {
130 dprintk1(1,
131 "GPIO WRITE: addr 0x%x, len %d, saddr 0x%x\n",
132 msg->addr, msg->len, saddr);
133
134 return dev->cx231xx_gpio_i2c_write(dev,
135 msg->addr,
136 msg->buf,
137 msg->len);
138 }
139 }
140
141
142 saddr_len = 1;
143
144
145 size -= saddr_len;
146 buf_ptr = (u8 *) (msg->buf + 1);
147
148 do {
149
150 req_data.dev_addr = msg->addr;
151 req_data.direction = msg->flags;
152 req_data.saddr_len = saddr_len;
153 req_data.saddr_dat = msg->buf[0];
154 req_data.buf_size = size > 16 ? 16 : size;
155 req_data.p_buffer = (u8 *) (buf_ptr + loop * 16);
156
157 bus->i2c_nostop = (size > 16) ? 1 : 0;
158 bus->i2c_reserve = (loop == 0) ? 0 : 1;
159
160
161 status = dev->cx231xx_send_usb_command(bus, &req_data);
162 loop++;
163
164 if (size >= 16)
165 size -= 16;
166 else
167 size = 0;
168
169 } while (size > 0);
170
171 bus->i2c_nostop = 0;
172 bus->i2c_reserve = 0;
173
174 } else {
175
176
177 req_data.dev_addr = msg->addr;
178 req_data.direction = msg->flags;
179 req_data.saddr_len = 0;
180 req_data.saddr_dat = 0;
181 req_data.buf_size = msg->len;
182 req_data.p_buffer = msg->buf;
183
184
185 status = dev->cx231xx_send_usb_command(bus, &req_data);
186 }
187
188 return status < 0 ? status : 0;
189}
190
191
192
193
194
195static int cx231xx_i2c_recv_bytes(struct i2c_adapter *i2c_adap,
196 const struct i2c_msg *msg)
197{
198 struct cx231xx_i2c *bus = i2c_adap->algo_data;
199 struct cx231xx *dev = bus->dev;
200 struct cx231xx_i2c_xfer_data req_data;
201 int status = 0;
202 u16 saddr = 0;
203 u8 need_gpio = 0;
204
205 if (is_tuner(dev, bus, msg, TUNER_XC5000)) {
206 if (msg->len == 2)
207 saddr = msg->buf[0] << 8 | msg->buf[1];
208 else if (msg->len == 1)
209 saddr = msg->buf[0];
210
211 if (dev->xc_fw_load_done) {
212
213 switch (saddr) {
214 case 0x0009:
215 dprintk1(1,
216 "GPIO R E A D: Special case BUSY check \n");
217
218 msg->buf[0] = 0;
219 if (msg->len == 2)
220 msg->buf[1] = 0;
221 return 0;
222 case 0x0004:
223 need_gpio = 1;
224 break;
225
226 }
227
228 if (need_gpio) {
229
230
231
232 dprintk1(1,
233 "GPIO R E A D: addr 0x%x, len %d, saddr 0x%x\n",
234 msg->addr, msg->len,
235 msg->buf[0] << 8 | msg->buf[1]);
236
237 status =
238 dev->cx231xx_gpio_i2c_write(dev, msg->addr,
239 msg->buf,
240 msg->len);
241 status =
242 dev->cx231xx_gpio_i2c_read(dev, msg->addr,
243 msg->buf,
244 msg->len);
245 return status;
246 }
247 }
248
249
250 req_data.dev_addr = msg->addr;
251 req_data.direction = msg->flags;
252 req_data.saddr_len = msg->len;
253 req_data.saddr_dat = msg->buf[0] << 8 | msg->buf[1];
254 req_data.buf_size = msg->len;
255 req_data.p_buffer = msg->buf;
256
257
258 status = dev->cx231xx_send_usb_command(bus, &req_data);
259
260 } else {
261
262
263 req_data.dev_addr = msg->addr;
264 req_data.direction = msg->flags;
265 req_data.saddr_len = 0;
266 req_data.saddr_dat = 0;
267 req_data.buf_size = msg->len;
268 req_data.p_buffer = msg->buf;
269
270
271 status = dev->cx231xx_send_usb_command(bus, &req_data);
272 }
273
274 return status < 0 ? status : 0;
275}
276
277
278
279
280
281static int cx231xx_i2c_recv_bytes_with_saddr(struct i2c_adapter *i2c_adap,
282 const struct i2c_msg *msg1,
283 const struct i2c_msg *msg2)
284{
285 struct cx231xx_i2c *bus = i2c_adap->algo_data;
286 struct cx231xx *dev = bus->dev;
287 struct cx231xx_i2c_xfer_data req_data;
288 int status = 0;
289 u16 saddr = 0;
290 u8 need_gpio = 0;
291
292 if (msg1->len == 2)
293 saddr = msg1->buf[0] << 8 | msg1->buf[1];
294 else if (msg1->len == 1)
295 saddr = msg1->buf[0];
296
297 if (is_tuner(dev, bus, msg2, TUNER_XC5000)) {
298 if ((msg2->len < 16)) {
299
300 dprintk1(1,
301 "i2c_read: addr 0x%x, len %d, saddr 0x%x, len %d\n",
302 msg2->addr, msg2->len, saddr, msg1->len);
303
304 switch (saddr) {
305 case 0x0008:
306 need_gpio = 1;
307 break;
308 case 0x0004:
309 need_gpio = 1;
310 break;
311 }
312
313 if (need_gpio) {
314 status =
315 dev->cx231xx_gpio_i2c_write(dev, msg1->addr,
316 msg1->buf,
317 msg1->len);
318 status =
319 dev->cx231xx_gpio_i2c_read(dev, msg2->addr,
320 msg2->buf,
321 msg2->len);
322 return status;
323 }
324 }
325 }
326
327
328 req_data.dev_addr = msg2->addr;
329 req_data.direction = msg2->flags;
330 req_data.saddr_len = msg1->len;
331 req_data.saddr_dat = saddr;
332 req_data.buf_size = msg2->len;
333 req_data.p_buffer = msg2->buf;
334
335
336 status = dev->cx231xx_send_usb_command(bus, &req_data);
337
338 return status < 0 ? status : 0;
339}
340
341
342
343
344
345static int cx231xx_i2c_check_for_device(struct i2c_adapter *i2c_adap,
346 const struct i2c_msg *msg)
347{
348 struct cx231xx_i2c *bus = i2c_adap->algo_data;
349 struct cx231xx *dev = bus->dev;
350 struct cx231xx_i2c_xfer_data req_data;
351 int status = 0;
352 u8 buf[1];
353
354
355 req_data.dev_addr = msg->addr;
356 req_data.direction = I2C_M_RD;
357 req_data.saddr_len = 0;
358 req_data.saddr_dat = 0;
359 req_data.buf_size = 1;
360 req_data.p_buffer = buf;
361
362
363 status = dev->cx231xx_send_usb_command(bus, &req_data);
364
365 return status < 0 ? status : 0;
366}
367
368
369
370
371
372static int cx231xx_i2c_xfer(struct i2c_adapter *i2c_adap,
373 struct i2c_msg msgs[], int num)
374{
375 struct cx231xx_i2c *bus = i2c_adap->algo_data;
376 struct cx231xx *dev = bus->dev;
377 int addr, rc, i, byte;
378
379 if (num <= 0)
380 return 0;
381 mutex_lock(&dev->i2c_lock);
382 for (i = 0; i < num; i++) {
383
384 addr = msgs[i].addr;
385
386 dprintk2(2, "%s %s addr=0x%x len=%d:",
387 (msgs[i].flags & I2C_M_RD) ? "read" : "write",
388 i == num - 1 ? "stop" : "nonstop", addr, msgs[i].len);
389 if (!msgs[i].len) {
390
391 rc = cx231xx_i2c_check_for_device(i2c_adap, &msgs[i]);
392 if (rc < 0) {
393 dprintk2(2, " no device\n");
394 mutex_unlock(&dev->i2c_lock);
395 return rc;
396 }
397
398 } else if (msgs[i].flags & I2C_M_RD) {
399
400 rc = cx231xx_i2c_recv_bytes(i2c_adap, &msgs[i]);
401 if (i2c_debug >= 2) {
402 for (byte = 0; byte < msgs[i].len; byte++)
403 printk(KERN_CONT " %02x", msgs[i].buf[byte]);
404 }
405 } else if (i + 1 < num && (msgs[i + 1].flags & I2C_M_RD) &&
406 msgs[i].addr == msgs[i + 1].addr
407 && (msgs[i].len <= 2) && (bus->nr < 3)) {
408
409 if (i2c_debug >= 2) {
410 for (byte = 0; byte < msgs[i].len; byte++)
411 printk(KERN_CONT " %02x", msgs[i].buf[byte]);
412 printk(KERN_CONT "\n");
413 }
414
415 dprintk2(2, "plus %s %s addr=0x%x len=%d:",
416 (msgs[i+1].flags & I2C_M_RD) ? "read" : "write",
417 i+1 == num - 1 ? "stop" : "nonstop", addr, msgs[i+1].len);
418 rc = cx231xx_i2c_recv_bytes_with_saddr(i2c_adap,
419 &msgs[i],
420 &msgs[i + 1]);
421 if (i2c_debug >= 2) {
422 for (byte = 0; byte < msgs[i+1].len; byte++)
423 printk(KERN_CONT " %02x", msgs[i+1].buf[byte]);
424 }
425 i++;
426 } else {
427
428 if (i2c_debug >= 2) {
429 for (byte = 0; byte < msgs[i].len; byte++)
430 printk(KERN_CONT " %02x", msgs[i].buf[byte]);
431 }
432 rc = cx231xx_i2c_send_bytes(i2c_adap, &msgs[i]);
433 }
434 if (rc < 0)
435 goto err;
436 if (i2c_debug >= 2)
437 printk(KERN_CONT "\n");
438 }
439 mutex_unlock(&dev->i2c_lock);
440 return num;
441err:
442 dprintk2(2, " ERROR: %i\n", rc);
443 mutex_unlock(&dev->i2c_lock);
444 return rc;
445}
446
447
448
449
450
451
452static u32 functionality(struct i2c_adapter *adap)
453{
454 return I2C_FUNC_SMBUS_EMUL | I2C_FUNC_I2C;
455}
456
457static struct i2c_algorithm cx231xx_algo = {
458 .master_xfer = cx231xx_i2c_xfer,
459 .functionality = functionality,
460};
461
462static struct i2c_adapter cx231xx_adap_template = {
463 .owner = THIS_MODULE,
464 .name = "cx231xx",
465 .algo = &cx231xx_algo,
466};
467
468
469
470
471
472
473
474static const char *i2c_devs[128] = {
475 [0x20 >> 1] = "demod",
476 [0x60 >> 1] = "colibri",
477 [0x88 >> 1] = "hammerhead",
478 [0x8e >> 1] = "CIR",
479 [0x32 >> 1] = "GeminiIII",
480 [0x02 >> 1] = "Aquarius",
481 [0xa0 >> 1] = "eeprom",
482 [0xc0 >> 1] = "tuner",
483 [0xc2 >> 1] = "tuner",
484};
485
486
487
488
489
490void cx231xx_do_i2c_scan(struct cx231xx *dev, int i2c_port)
491{
492 unsigned char buf;
493 int i, rc;
494 struct i2c_client client;
495
496 if (!i2c_scan)
497 return;
498
499
500 dev->i2c_scan_running = true;
501
502 memset(&client, 0, sizeof(client));
503 client.adapter = cx231xx_get_i2c_adap(dev, i2c_port);
504
505 for (i = 0; i < 128; i++) {
506 client.addr = i;
507 rc = i2c_master_recv(&client, &buf, 0);
508 if (rc < 0)
509 continue;
510 dev_info(dev->dev,
511 "i2c scan: found device @ port %d addr 0x%x [%s]\n",
512 i2c_port,
513 i << 1,
514 i2c_devs[i] ? i2c_devs[i] : "???");
515 }
516
517 dev->i2c_scan_running = false;
518}
519
520
521
522
523
524int cx231xx_i2c_register(struct cx231xx_i2c *bus)
525{
526 struct cx231xx *dev = bus->dev;
527
528 BUG_ON(!dev->cx231xx_send_usb_command);
529
530 bus->i2c_adap = cx231xx_adap_template;
531 bus->i2c_adap.dev.parent = dev->dev;
532
533 snprintf(bus->i2c_adap.name, sizeof(bus->i2c_adap.name), "%s-%d", bus->dev->name, bus->nr);
534
535 bus->i2c_adap.algo_data = bus;
536 i2c_set_adapdata(&bus->i2c_adap, &dev->v4l2_dev);
537 i2c_add_adapter(&bus->i2c_adap);
538
539 if (0 != bus->i2c_rc)
540 dev_warn(dev->dev,
541 "i2c bus %d register FAILED\n", bus->nr);
542
543 return bus->i2c_rc;
544}
545
546
547
548
549
550int cx231xx_i2c_unregister(struct cx231xx_i2c *bus)
551{
552 i2c_del_adapter(&bus->i2c_adap);
553 return 0;
554}
555
556
557
558
559
560static int cx231xx_i2c_mux_select(struct i2c_adapter *adap,
561 void *mux_priv, u32 chan_id)
562{
563 struct cx231xx *dev = mux_priv;
564
565 return cx231xx_enable_i2c_port_3(dev, chan_id);
566}
567
568int cx231xx_i2c_mux_register(struct cx231xx *dev, int mux_no)
569{
570 struct i2c_adapter *i2c_parent = &dev->i2c_bus[1].i2c_adap;
571
572 struct device *mux_dev = dev->dev;
573
574 dev->i2c_mux_adap[mux_no] = i2c_add_mux_adapter(i2c_parent,
575 mux_dev,
576 dev ,
577 0,
578 mux_no ,
579 0 ,
580 &cx231xx_i2c_mux_select,
581 NULL);
582
583 if (!dev->i2c_mux_adap[mux_no])
584 dev_warn(dev->dev,
585 "i2c mux %d register FAILED\n", mux_no);
586
587 return 0;
588}
589
590void cx231xx_i2c_mux_unregister(struct cx231xx *dev, int mux_no)
591{
592 i2c_del_mux_adapter(dev->i2c_mux_adap[mux_no]);
593 dev->i2c_mux_adap[mux_no] = NULL;
594}
595
596struct i2c_adapter *cx231xx_get_i2c_adap(struct cx231xx *dev, int i2c_port)
597{
598 switch (i2c_port) {
599 case I2C_0:
600 return &dev->i2c_bus[0].i2c_adap;
601 case I2C_1:
602 return &dev->i2c_bus[1].i2c_adap;
603 case I2C_2:
604 return &dev->i2c_bus[2].i2c_adap;
605 case I2C_1_MUX_1:
606 return dev->i2c_mux_adap[0];
607 case I2C_1_MUX_3:
608 return dev->i2c_mux_adap[1];
609 default:
610 return NULL;
611 }
612}
613EXPORT_SYMBOL_GPL(cx231xx_get_i2c_adap);
614