3 * i2c algorithm for USB-I2C Bridges
5 * Copyright (c) 1999-2007 Joerg Heckenbach <joerg@heckenbach-aw.de>
6 * Dwaine Garden <dwainegarden@rogers.com>
8 * This module is part of usbvision driver project.
9 * Updates to driver completed by Dwaine P. Garden
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License as published by
13 * the Free Software Foundation; either version 2 of the License, or
14 * (at your option) any later version.
16 * This program is distributed in the hope that it will be useful,
17 * but WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
19 * GNU General Public License for more details.
21 * You should have received a copy of the GNU General Public License
22 * along with this program; if not, write to the Free Software
23 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
27 #include <linux/kernel.h>
28 #include <linux/module.h>
29 #include <linux/delay.h>
30 #include <linux/slab.h>
31 #include <linux/version.h>
32 #include <linux/utsname.h>
33 #include <linux/init.h>
34 #include <asm/uaccess.h>
35 #include <linux/ioport.h>
36 #include <linux/errno.h>
37 #include <linux/usb.h>
38 #include <linux/i2c.h>
39 #include "usbvision.h"
43 static int i2c_debug
= 0;
45 module_param (i2c_debug
, int, 0644); // debug_i2c_usb mode of the device driver
46 MODULE_PARM_DESC(i2c_debug
, "enable debug messages [i2c]");
48 #define PDEBUG(level, fmt, args...) \
49 if (i2c_debug & (level)) info("[%s:%d] " fmt, __PRETTY_FUNCTION__, __LINE__ , ## args)
51 static int usbvision_i2c_write(struct usb_usbvision
*usbvision
, unsigned char addr
, char *buf
,
53 static int usbvision_i2c_read(struct usb_usbvision
*usbvision
, unsigned char addr
, char *buf
,
56 static inline int try_write_address(struct i2c_adapter
*i2c_adap
,
57 unsigned char addr
, int retries
)
59 struct usb_usbvision
*usbvision
;
63 usbvision
= (struct usb_usbvision
*)i2c_get_adapdata(i2c_adap
);
65 for (i
= 0; i
<= retries
; i
++) {
66 ret
= (usbvision_i2c_write(usbvision
, addr
, buf
, 1));
70 if (i
== retries
) /* no success */
75 PDEBUG(DBG_I2C
,"Needed %d retries for address %#2x", i
, addr
);
76 PDEBUG(DBG_I2C
,"Maybe there's no device at this address");
81 static inline int try_read_address(struct i2c_adapter
*i2c_adap
,
82 unsigned char addr
, int retries
)
84 struct usb_usbvision
*usbvision
;
88 usbvision
= (struct usb_usbvision
*)i2c_get_adapdata(i2c_adap
);
89 for (i
= 0; i
<= retries
; i
++) {
90 ret
= (usbvision_i2c_read(usbvision
, addr
, buf
, 1));
94 if (i
== retries
) /* no success */
99 PDEBUG(DBG_I2C
,"Needed %d retries for address %#2x", i
, addr
);
100 PDEBUG(DBG_I2C
,"Maybe there's no device at this address");
105 static inline int usb_find_address(struct i2c_adapter
*i2c_adap
,
106 struct i2c_msg
*msg
, int retries
,
109 unsigned short flags
= msg
->flags
;
113 if ((flags
& I2C_M_TEN
)) {
114 /* a ten bit address */
115 addr
= 0xf0 | ((msg
->addr
>> 7) & 0x03);
116 /* try extended address code... */
117 ret
= try_write_address(i2c_adap
, addr
, retries
);
119 err("died at extended address code, while writing");
123 if (flags
& I2C_M_RD
) {
124 /* okay, now switch into reading mode */
126 ret
= try_read_address(i2c_adap
, addr
, retries
);
128 err("died at extended address code, while reading");
133 } else { /* normal 7bit address */
134 addr
= (msg
->addr
<< 1);
135 if (flags
& I2C_M_RD
)
139 if (flags
& I2C_M_RD
)
140 ret
= try_read_address(i2c_adap
, addr
, retries
);
142 ret
= try_write_address(i2c_adap
, addr
, retries
);
152 usbvision_i2c_xfer(struct i2c_adapter
*i2c_adap
, struct i2c_msg msgs
[], int num
)
154 struct i2c_msg
*pmsg
;
155 struct usb_usbvision
*usbvision
;
159 usbvision
= (struct usb_usbvision
*)i2c_get_adapdata(i2c_adap
);
161 for (i
= 0; i
< num
; i
++) {
163 ret
= usb_find_address(i2c_adap
, pmsg
, i2c_adap
->retries
, &addr
);
165 PDEBUG(DBG_I2C
,"got NAK from device, message #%d", i
);
166 return (ret
< 0) ? ret
: -EREMOTEIO
;
169 if (pmsg
->flags
& I2C_M_RD
) {
170 /* read bytes into buffer */
171 ret
= (usbvision_i2c_read(usbvision
, addr
, pmsg
->buf
, pmsg
->len
));
172 if (ret
< pmsg
->len
) {
173 return (ret
< 0) ? ret
: -EREMOTEIO
;
176 /* write bytes from buffer */
177 ret
= (usbvision_i2c_write(usbvision
, addr
, pmsg
->buf
, pmsg
->len
));
178 if (ret
< pmsg
->len
) {
179 return (ret
< 0) ? ret
: -EREMOTEIO
;
186 static int algo_control(struct i2c_adapter
*adapter
, unsigned int cmd
, unsigned long arg
)
191 static u32
functionality(struct i2c_adapter
*adap
)
193 return I2C_FUNC_SMBUS_EMUL
| I2C_FUNC_10BIT_ADDR
;
197 /* -----exported algorithm data: ------------------------------------- */
199 static struct i2c_algorithm usbvision_algo
= {
200 .master_xfer
= usbvision_i2c_xfer
,
202 .algo_control
= algo_control
,
203 .functionality
= functionality
,
208 * registering functions to load algorithms at runtime
210 static int usbvision_i2c_usb_add_bus(struct i2c_adapter
*adap
)
212 PDEBUG(DBG_I2C
, "I2C debugging is enabled [i2c]");
213 PDEBUG(DBG_I2C
, "ALGO debugging is enabled [i2c]");
215 /* register new adapter to i2c module... */
217 adap
->algo
= &usbvision_algo
;
219 adap
->timeout
= 100; /* default values, should */
220 adap
->retries
= 3; /* be replaced by defines */
222 i2c_add_adapter(adap
);
224 PDEBUG(DBG_I2C
,"i2c bus for %s registered", adap
->name
);
229 /* ----------------------------------------------------------------------- */
230 /* usbvision specific I2C functions */
231 /* ----------------------------------------------------------------------- */
232 static struct i2c_adapter i2c_adap_template
;
233 static struct i2c_client i2c_client_template
;
235 int usbvision_i2c_register(struct usb_usbvision
*usbvision
)
237 memcpy(&usbvision
->i2c_adap
, &i2c_adap_template
,
238 sizeof(struct i2c_adapter
));
239 memcpy(&usbvision
->i2c_client
, &i2c_client_template
,
240 sizeof(struct i2c_client
));
242 sprintf(usbvision
->i2c_adap
.name
+ strlen(usbvision
->i2c_adap
.name
),
243 " #%d", usbvision
->vdev
->minor
& 0x1f);
244 PDEBUG(DBG_I2C
,"Adaptername: %s", usbvision
->i2c_adap
.name
);
245 usbvision
->i2c_adap
.dev
.parent
= &usbvision
->dev
->dev
;
247 i2c_set_adapdata(&usbvision
->i2c_adap
, usbvision
);
248 i2c_set_clientdata(&usbvision
->i2c_client
, usbvision
);
250 usbvision
->i2c_client
.adapter
= &usbvision
->i2c_adap
;
252 if (usbvision_write_reg(usbvision
, USBVISION_SER_MODE
, USBVISION_IIC_LRNACK
) < 0) {
253 printk(KERN_ERR
"usbvision_register: can't write reg\n");
257 #ifdef CONFIG_MODULES
258 /* Request the load of the i2c modules we need */
259 switch (usbvision_device_data
[usbvision
->DevModel
].Codec
) {
261 request_module("saa7115");
264 request_module("saa7115");
267 if (usbvision_device_data
[usbvision
->DevModel
].Tuner
== 1) {
268 request_module("tuner");
272 return usbvision_i2c_usb_add_bus(&usbvision
->i2c_adap
);
275 int usbvision_i2c_unregister(struct usb_usbvision
*usbvision
)
278 i2c_del_adapter(&(usbvision
->i2c_adap
));
280 PDEBUG(DBG_I2C
,"i2c bus for %s unregistered", usbvision
->i2c_adap
.name
);
285 void call_i2c_clients(struct usb_usbvision
*usbvision
, unsigned int cmd
,
288 i2c_clients_command(&usbvision
->i2c_adap
, cmd
, arg
);
291 static int attach_inform(struct i2c_client
*client
)
293 struct usb_usbvision
*usbvision
;
295 usbvision
= (struct usb_usbvision
*)i2c_get_adapdata(client
->adapter
);
297 switch (client
->addr
<< 1) {
302 PDEBUG(DBG_I2C
,"attach_inform: tda9887 detected.");
305 PDEBUG(DBG_I2C
,"attach_inform: saa7114 detected.");
308 PDEBUG(DBG_I2C
,"attach_inform: saa7113 detected.");
311 PDEBUG(DBG_I2C
,"attach_inform: saa7111 detected.");
314 PDEBUG(DBG_I2C
,"attach_inform: eeprom detected.");
319 struct tuner_setup tun_setup
;
321 PDEBUG(DBG_I2C
,"attach inform: detected I2C address %x", client
->addr
<< 1);
322 usbvision
->tuner_addr
= client
->addr
;
324 if ((usbvision
->have_tuner
) && (usbvision
->tuner_type
!= -1)) {
325 tun_setup
.mode_mask
= T_ANALOG_TV
| T_RADIO
;
326 tun_setup
.type
= usbvision
->tuner_type
;
327 tun_setup
.addr
= usbvision
->tuner_addr
;
328 call_i2c_clients(usbvision
, TUNER_SET_TYPE_ADDR
, &tun_setup
);
336 static int detach_inform(struct i2c_client
*client
)
338 struct usb_usbvision
*usbvision
;
340 usbvision
= (struct usb_usbvision
*)i2c_get_adapdata(client
->adapter
);
342 PDEBUG(DBG_I2C
,"usbvision[%d] detaches %s", usbvision
->nr
, client
->name
);
347 usbvision_i2c_read_max4(struct usb_usbvision
*usbvision
, unsigned char addr
,
348 char *buf
, short len
)
352 for (retries
= 5;;) {
353 rc
= usbvision_write_reg(usbvision
, USBVISION_SER_ADRS
, addr
);
357 /* Initiate byte read cycle */
358 /* USBVISION_SER_CONT <- d0-d2 n. of bytes to r/w */
360 rc
= usbvision_write_reg(usbvision
, USBVISION_SER_CONT
,
361 (len
& 0x07) | 0x18);
365 /* Test for Busy and ACK */
367 /* USBVISION_SER_CONT -> d4 == 0 busy */
368 rc
= usbvision_read_reg(usbvision
, USBVISION_SER_CONT
);
369 } while (rc
> 0 && ((rc
& 0x10) != 0)); /* Retry while busy */
373 /* USBVISION_SER_CONT -> d5 == 1 Not ack */
374 if ((rc
& 0x20) == 0) /* Ack? */
378 rc
= usbvision_write_reg(usbvision
, USBVISION_SER_CONT
, 0x00);
388 buf
[3] = usbvision_read_reg(usbvision
, USBVISION_SER_DAT4
);
390 buf
[2] = usbvision_read_reg(usbvision
, USBVISION_SER_DAT3
);
392 buf
[1] = usbvision_read_reg(usbvision
, USBVISION_SER_DAT2
);
394 buf
[0] = usbvision_read_reg(usbvision
, USBVISION_SER_DAT1
);
398 "usbvision_i2c_read_max4: buffer length > 4\n");
401 if (i2c_debug
& DBG_I2C
) {
403 for (idx
= 0; idx
< len
; idx
++) {
404 PDEBUG(DBG_I2C
,"read %x from address %x", (unsigned char)buf
[idx
], addr
);
411 static int usbvision_i2c_write_max4(struct usb_usbvision
*usbvision
,
412 unsigned char addr
, const char *buf
,
417 unsigned char value
[6];
418 unsigned char ser_cont
;
420 ser_cont
= (len
& 0x07) | 0x10;
424 for (i
= 0; i
< len
; i
++)
425 value
[i
+ 2] = buf
[i
];
427 for (retries
= 5;;) {
428 rc
= usb_control_msg(usbvision
->dev
,
429 usb_sndctrlpipe(usbvision
->dev
, 1),
431 USB_DIR_OUT
| USB_TYPE_VENDOR
|
432 USB_RECIP_ENDPOINT
, 0,
433 (__u16
) USBVISION_SER_ADRS
, value
,
439 rc
= usbvision_write_reg(usbvision
, USBVISION_SER_CONT
,
440 (len
& 0x07) | 0x10);
444 /* Test for Busy and ACK */
446 rc
= usbvision_read_reg(usbvision
, USBVISION_SER_CONT
);
447 } while (rc
> 0 && ((rc
& 0x10) != 0)); /* Retry while busy */
451 if ((rc
& 0x20) == 0) /* Ack? */
455 usbvision_write_reg(usbvision
, USBVISION_SER_CONT
, 0x00);
462 if (i2c_debug
& DBG_I2C
) {
464 for (idx
= 0; idx
< len
; idx
++) {
465 PDEBUG(DBG_I2C
,"wrote %x at address %x", (unsigned char)buf
[idx
], addr
);
471 static int usbvision_i2c_write(struct usb_usbvision
*usbvision
, unsigned char addr
, char *buf
,
481 count
= (len
> maxLen
) ? maxLen
: len
;
482 retval
= usbvision_i2c_write_max4(usbvision
, addr
, bufPtr
, count
);
488 return (retval
< 0) ? retval
: -EFAULT
;
493 static int usbvision_i2c_read(struct usb_usbvision
*usbvision
, unsigned char addr
, char *buf
,
502 count
= (len
> 3) ? 4 : len
;
503 retval
= usbvision_i2c_read_max4(usbvision
, addr
, temp
, count
);
505 for (i
= 0; i
< len
; i
++)
506 buf
[rdcount
+ i
] = temp
[i
];
510 return (retval
< 0) ? retval
: -EFAULT
;
515 static struct i2c_adapter i2c_adap_template
= {
516 .owner
= THIS_MODULE
,
518 .id
= I2C_HW_B_BT848
, /* FIXME */
519 .client_register
= attach_inform
,
520 .client_unregister
= detach_inform
,
521 #ifdef I2C_ADAP_CLASS_TV_ANALOG
522 .class = I2C_ADAP_CLASS_TV_ANALOG
,
524 .class = I2C_CLASS_TV_ANALOG
,
528 static struct i2c_client i2c_client_template
= {
529 .name
= "usbvision internal",
533 * Overrides for Emacs so that we follow Linus's tabbing style.
534 * ---------------------------------------------------------------------------