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"
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)) \
50 printk(KERN_INFO KBUILD_MODNAME ":[%s:%d] " fmt, \
51 __func__, __LINE__ , ## args); \
54 static int usbvision_i2c_write(struct usb_usbvision
*usbvision
, unsigned char addr
, char *buf
,
56 static int usbvision_i2c_read(struct usb_usbvision
*usbvision
, unsigned char addr
, char *buf
,
59 static inline int try_write_address(struct i2c_adapter
*i2c_adap
,
60 unsigned char addr
, int retries
)
62 struct usb_usbvision
*usbvision
;
66 usbvision
= (struct usb_usbvision
*)i2c_get_adapdata(i2c_adap
);
68 for (i
= 0; i
<= retries
; i
++) {
69 ret
= (usbvision_i2c_write(usbvision
, addr
, buf
, 1));
73 if (i
== retries
) /* no success */
78 PDEBUG(DBG_I2C
,"Needed %d retries for address %#2x", i
, addr
);
79 PDEBUG(DBG_I2C
,"Maybe there's no device at this address");
84 static inline int try_read_address(struct i2c_adapter
*i2c_adap
,
85 unsigned char addr
, int retries
)
87 struct usb_usbvision
*usbvision
;
91 usbvision
= (struct usb_usbvision
*)i2c_get_adapdata(i2c_adap
);
92 for (i
= 0; i
<= retries
; i
++) {
93 ret
= (usbvision_i2c_read(usbvision
, addr
, buf
, 1));
97 if (i
== retries
) /* no success */
102 PDEBUG(DBG_I2C
,"Needed %d retries for address %#2x", i
, addr
);
103 PDEBUG(DBG_I2C
,"Maybe there's no device at this address");
108 static inline int usb_find_address(struct i2c_adapter
*i2c_adap
,
109 struct i2c_msg
*msg
, int retries
,
112 unsigned short flags
= msg
->flags
;
116 if ((flags
& I2C_M_TEN
)) {
117 /* a ten bit address */
118 addr
= 0xf0 | ((msg
->addr
>> 7) & 0x03);
119 /* try extended address code... */
120 ret
= try_write_address(i2c_adap
, addr
, retries
);
122 dev_err(&i2c_adap
->dev
,
123 "died at extended address code, while writing\n");
127 if (flags
& I2C_M_RD
) {
128 /* okay, now switch into reading mode */
130 ret
= try_read_address(i2c_adap
, addr
, retries
);
132 dev_err(&i2c_adap
->dev
,
133 "died at extended address code, while reading\n");
138 } else { /* normal 7bit address */
139 addr
= (msg
->addr
<< 1);
140 if (flags
& I2C_M_RD
)
144 if (flags
& I2C_M_RD
)
145 ret
= try_read_address(i2c_adap
, addr
, retries
);
147 ret
= try_write_address(i2c_adap
, addr
, retries
);
157 usbvision_i2c_xfer(struct i2c_adapter
*i2c_adap
, struct i2c_msg msgs
[], int num
)
159 struct i2c_msg
*pmsg
;
160 struct usb_usbvision
*usbvision
;
162 unsigned char addr
= 0;
164 usbvision
= (struct usb_usbvision
*)i2c_get_adapdata(i2c_adap
);
166 for (i
= 0; i
< num
; i
++) {
168 ret
= usb_find_address(i2c_adap
, pmsg
, i2c_adap
->retries
, &addr
);
170 PDEBUG(DBG_I2C
,"got NAK from device, message #%d", i
);
171 return (ret
< 0) ? ret
: -EREMOTEIO
;
174 if (pmsg
->flags
& I2C_M_RD
) {
175 /* read bytes into buffer */
176 ret
= (usbvision_i2c_read(usbvision
, addr
, pmsg
->buf
, pmsg
->len
));
177 if (ret
< pmsg
->len
) {
178 return (ret
< 0) ? ret
: -EREMOTEIO
;
181 /* write bytes from buffer */
182 ret
= (usbvision_i2c_write(usbvision
, addr
, pmsg
->buf
, pmsg
->len
));
183 if (ret
< pmsg
->len
) {
184 return (ret
< 0) ? ret
: -EREMOTEIO
;
191 static u32
functionality(struct i2c_adapter
*adap
)
193 return I2C_FUNC_SMBUS_EMUL
| I2C_FUNC_10BIT_ADDR
;
196 /* -----exported algorithm data: ------------------------------------- */
198 static struct i2c_algorithm usbvision_algo
= {
199 .master_xfer
= usbvision_i2c_xfer
,
201 .functionality
= functionality
,
205 /* ----------------------------------------------------------------------- */
206 /* usbvision specific I2C functions */
207 /* ----------------------------------------------------------------------- */
208 static struct i2c_adapter i2c_adap_template
;
210 int usbvision_i2c_register(struct usb_usbvision
*usbvision
)
212 static unsigned short saa711x_addrs
[] = {
213 0x4a >> 1, 0x48 >> 1, /* SAA7111, SAA7111A and SAA7113 */
214 0x42 >> 1, 0x40 >> 1, /* SAA7114, SAA7115 and SAA7118 */
217 memcpy(&usbvision
->i2c_adap
, &i2c_adap_template
,
218 sizeof(struct i2c_adapter
));
220 sprintf(usbvision
->i2c_adap
.name
+ strlen(usbvision
->i2c_adap
.name
),
221 " #%d", usbvision
->vdev
->num
);
222 PDEBUG(DBG_I2C
,"Adaptername: %s", usbvision
->i2c_adap
.name
);
223 usbvision
->i2c_adap
.dev
.parent
= &usbvision
->dev
->dev
;
225 i2c_set_adapdata(&usbvision
->i2c_adap
, &usbvision
->v4l2_dev
);
227 if (usbvision_write_reg(usbvision
, USBVISION_SER_MODE
, USBVISION_IIC_LRNACK
) < 0) {
228 printk(KERN_ERR
"usbvision_register: can't write reg\n");
232 PDEBUG(DBG_I2C
, "I2C debugging is enabled [i2c]");
233 PDEBUG(DBG_I2C
, "ALGO debugging is enabled [i2c]");
235 /* register new adapter to i2c module... */
237 usbvision
->i2c_adap
.algo
= &usbvision_algo
;
239 usbvision
->i2c_adap
.timeout
= 100; /* default values, should */
240 usbvision
->i2c_adap
.retries
= 3; /* be replaced by defines */
242 i2c_add_adapter(&usbvision
->i2c_adap
);
244 PDEBUG(DBG_I2C
, "i2c bus for %s registered", usbvision
->i2c_adap
.name
);
246 /* Request the load of the i2c modules we need */
247 switch (usbvision_device_data
[usbvision
->DevModel
].Codec
) {
250 v4l2_i2c_new_probed_subdev(&usbvision
->i2c_adap
, "saa7115",
251 "saa7115_auto", saa711x_addrs
);
254 if (usbvision_device_data
[usbvision
->DevModel
].Tuner
== 1) {
255 struct v4l2_subdev
*sd
;
256 enum v4l2_i2c_tuner_type type
;
257 struct tuner_setup tun_setup
;
259 sd
= v4l2_i2c_new_probed_subdev(&usbvision
->i2c_adap
, "tuner",
260 "tuner", v4l2_i2c_tuner_addrs(ADDRS_DEMOD
));
261 /* depending on whether we found a demod or not, select
263 type
= sd
? ADDRS_TV_WITH_DEMOD
: ADDRS_TV
;
265 sd
= v4l2_i2c_new_probed_subdev(&usbvision
->i2c_adap
, "tuner",
266 "tuner", v4l2_i2c_tuner_addrs(type
));
268 if (usbvision
->tuner_type
!= -1) {
269 tun_setup
.mode_mask
= T_ANALOG_TV
| T_RADIO
;
270 tun_setup
.type
= usbvision
->tuner_type
;
271 tun_setup
.addr
= v4l2_i2c_subdev_addr(sd
);
272 call_all(usbvision
, tuner
, s_type_addr
, &tun_setup
);
279 int usbvision_i2c_unregister(struct usb_usbvision
*usbvision
)
282 i2c_del_adapter(&(usbvision
->i2c_adap
));
284 PDEBUG(DBG_I2C
,"i2c bus for %s unregistered", usbvision
->i2c_adap
.name
);
290 usbvision_i2c_read_max4(struct usb_usbvision
*usbvision
, unsigned char addr
,
291 char *buf
, short len
)
295 for (retries
= 5;;) {
296 rc
= usbvision_write_reg(usbvision
, USBVISION_SER_ADRS
, addr
);
300 /* Initiate byte read cycle */
301 /* USBVISION_SER_CONT <- d0-d2 n. of bytes to r/w */
303 rc
= usbvision_write_reg(usbvision
, USBVISION_SER_CONT
,
304 (len
& 0x07) | 0x18);
308 /* Test for Busy and ACK */
310 /* USBVISION_SER_CONT -> d4 == 0 busy */
311 rc
= usbvision_read_reg(usbvision
, USBVISION_SER_CONT
);
312 } while (rc
> 0 && ((rc
& 0x10) != 0)); /* Retry while busy */
316 /* USBVISION_SER_CONT -> d5 == 1 Not ack */
317 if ((rc
& 0x20) == 0) /* Ack? */
321 rc
= usbvision_write_reg(usbvision
, USBVISION_SER_CONT
, 0x00);
331 buf
[3] = usbvision_read_reg(usbvision
, USBVISION_SER_DAT4
);
333 buf
[2] = usbvision_read_reg(usbvision
, USBVISION_SER_DAT3
);
335 buf
[1] = usbvision_read_reg(usbvision
, USBVISION_SER_DAT2
);
337 buf
[0] = usbvision_read_reg(usbvision
, USBVISION_SER_DAT1
);
341 "usbvision_i2c_read_max4: buffer length > 4\n");
344 if (i2c_debug
& DBG_I2C
) {
346 for (idx
= 0; idx
< len
; idx
++) {
347 PDEBUG(DBG_I2C
,"read %x from address %x", (unsigned char)buf
[idx
], addr
);
354 static int usbvision_i2c_write_max4(struct usb_usbvision
*usbvision
,
355 unsigned char addr
, const char *buf
,
360 unsigned char value
[6];
361 unsigned char ser_cont
;
363 ser_cont
= (len
& 0x07) | 0x10;
367 for (i
= 0; i
< len
; i
++)
368 value
[i
+ 2] = buf
[i
];
370 for (retries
= 5;;) {
371 rc
= usb_control_msg(usbvision
->dev
,
372 usb_sndctrlpipe(usbvision
->dev
, 1),
374 USB_DIR_OUT
| USB_TYPE_VENDOR
|
375 USB_RECIP_ENDPOINT
, 0,
376 (__u16
) USBVISION_SER_ADRS
, value
,
382 rc
= usbvision_write_reg(usbvision
, USBVISION_SER_CONT
,
383 (len
& 0x07) | 0x10);
387 /* Test for Busy and ACK */
389 rc
= usbvision_read_reg(usbvision
, USBVISION_SER_CONT
);
390 } while (rc
> 0 && ((rc
& 0x10) != 0)); /* Retry while busy */
394 if ((rc
& 0x20) == 0) /* Ack? */
398 usbvision_write_reg(usbvision
, USBVISION_SER_CONT
, 0x00);
405 if (i2c_debug
& DBG_I2C
) {
407 for (idx
= 0; idx
< len
; idx
++) {
408 PDEBUG(DBG_I2C
,"wrote %x at address %x", (unsigned char)buf
[idx
], addr
);
414 static int usbvision_i2c_write(struct usb_usbvision
*usbvision
, unsigned char addr
, char *buf
,
424 count
= (len
> maxLen
) ? maxLen
: len
;
425 retval
= usbvision_i2c_write_max4(usbvision
, addr
, bufPtr
, count
);
431 return (retval
< 0) ? retval
: -EFAULT
;
436 static int usbvision_i2c_read(struct usb_usbvision
*usbvision
, unsigned char addr
, char *buf
,
445 count
= (len
> 3) ? 4 : len
;
446 retval
= usbvision_i2c_read_max4(usbvision
, addr
, temp
, count
);
448 for (i
= 0; i
< len
; i
++)
449 buf
[rdcount
+ i
] = temp
[i
];
453 return (retval
< 0) ? retval
: -EFAULT
;
458 static struct i2c_adapter i2c_adap_template
= {
459 .owner
= THIS_MODULE
,
464 * Overrides for Emacs so that we follow Linus's tabbing style.
465 * ---------------------------------------------------------------------------