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 err("died at extended address code, while writing");
126 if (flags
& I2C_M_RD
) {
127 /* okay, now switch into reading mode */
129 ret
= try_read_address(i2c_adap
, addr
, retries
);
131 err("died at extended address code, while reading");
136 } else { /* normal 7bit address */
137 addr
= (msg
->addr
<< 1);
138 if (flags
& I2C_M_RD
)
142 if (flags
& I2C_M_RD
)
143 ret
= try_read_address(i2c_adap
, addr
, retries
);
145 ret
= try_write_address(i2c_adap
, addr
, retries
);
155 usbvision_i2c_xfer(struct i2c_adapter
*i2c_adap
, struct i2c_msg msgs
[], int num
)
157 struct i2c_msg
*pmsg
;
158 struct usb_usbvision
*usbvision
;
162 usbvision
= (struct usb_usbvision
*)i2c_get_adapdata(i2c_adap
);
164 for (i
= 0; i
< num
; i
++) {
166 ret
= usb_find_address(i2c_adap
, pmsg
, i2c_adap
->retries
, &addr
);
168 PDEBUG(DBG_I2C
,"got NAK from device, message #%d", i
);
169 return (ret
< 0) ? ret
: -EREMOTEIO
;
172 if (pmsg
->flags
& I2C_M_RD
) {
173 /* read bytes into buffer */
174 ret
= (usbvision_i2c_read(usbvision
, addr
, pmsg
->buf
, pmsg
->len
));
175 if (ret
< pmsg
->len
) {
176 return (ret
< 0) ? ret
: -EREMOTEIO
;
179 /* write bytes from buffer */
180 ret
= (usbvision_i2c_write(usbvision
, addr
, pmsg
->buf
, pmsg
->len
));
181 if (ret
< pmsg
->len
) {
182 return (ret
< 0) ? ret
: -EREMOTEIO
;
189 static u32
functionality(struct i2c_adapter
*adap
)
191 return I2C_FUNC_SMBUS_EMUL
| I2C_FUNC_10BIT_ADDR
;
194 /* -----exported algorithm data: ------------------------------------- */
196 static struct i2c_algorithm usbvision_algo
= {
197 .master_xfer
= usbvision_i2c_xfer
,
199 .functionality
= functionality
,
204 * registering functions to load algorithms at runtime
206 static int usbvision_i2c_usb_add_bus(struct i2c_adapter
*adap
)
208 PDEBUG(DBG_I2C
, "I2C debugging is enabled [i2c]");
209 PDEBUG(DBG_I2C
, "ALGO debugging is enabled [i2c]");
211 /* register new adapter to i2c module... */
213 adap
->algo
= &usbvision_algo
;
215 adap
->timeout
= 100; /* default values, should */
216 adap
->retries
= 3; /* be replaced by defines */
218 i2c_add_adapter(adap
);
220 PDEBUG(DBG_I2C
,"i2c bus for %s registered", adap
->name
);
225 /* ----------------------------------------------------------------------- */
226 /* usbvision specific I2C functions */
227 /* ----------------------------------------------------------------------- */
228 static struct i2c_adapter i2c_adap_template
;
229 static struct i2c_client i2c_client_template
;
231 int usbvision_i2c_register(struct usb_usbvision
*usbvision
)
233 memcpy(&usbvision
->i2c_adap
, &i2c_adap_template
,
234 sizeof(struct i2c_adapter
));
235 memcpy(&usbvision
->i2c_client
, &i2c_client_template
,
236 sizeof(struct i2c_client
));
238 sprintf(usbvision
->i2c_adap
.name
+ strlen(usbvision
->i2c_adap
.name
),
239 " #%d", usbvision
->vdev
->num
);
240 PDEBUG(DBG_I2C
,"Adaptername: %s", usbvision
->i2c_adap
.name
);
241 usbvision
->i2c_adap
.dev
.parent
= &usbvision
->dev
->dev
;
243 i2c_set_adapdata(&usbvision
->i2c_adap
, usbvision
);
244 i2c_set_clientdata(&usbvision
->i2c_client
, usbvision
);
246 usbvision
->i2c_client
.adapter
= &usbvision
->i2c_adap
;
248 if (usbvision_write_reg(usbvision
, USBVISION_SER_MODE
, USBVISION_IIC_LRNACK
) < 0) {
249 printk(KERN_ERR
"usbvision_register: can't write reg\n");
253 #ifdef CONFIG_MODULES
254 /* Request the load of the i2c modules we need */
255 switch (usbvision_device_data
[usbvision
->DevModel
].Codec
) {
257 request_module("saa7115");
260 request_module("saa7115");
263 if (usbvision_device_data
[usbvision
->DevModel
].Tuner
== 1) {
264 request_module("tuner");
268 return usbvision_i2c_usb_add_bus(&usbvision
->i2c_adap
);
271 int usbvision_i2c_unregister(struct usb_usbvision
*usbvision
)
274 i2c_del_adapter(&(usbvision
->i2c_adap
));
276 PDEBUG(DBG_I2C
,"i2c bus for %s unregistered", usbvision
->i2c_adap
.name
);
281 void call_i2c_clients(struct usb_usbvision
*usbvision
, unsigned int cmd
,
284 i2c_clients_command(&usbvision
->i2c_adap
, cmd
, arg
);
287 static int attach_inform(struct i2c_client
*client
)
289 struct usb_usbvision
*usbvision
;
291 usbvision
= (struct usb_usbvision
*)i2c_get_adapdata(client
->adapter
);
293 switch (client
->addr
<< 1) {
298 PDEBUG(DBG_I2C
,"attach_inform: tda9887 detected.");
301 PDEBUG(DBG_I2C
,"attach_inform: saa7114 detected.");
304 PDEBUG(DBG_I2C
,"attach_inform: saa7113 detected.");
307 PDEBUG(DBG_I2C
,"attach_inform: saa7111 detected.");
310 PDEBUG(DBG_I2C
,"attach_inform: eeprom detected.");
315 struct tuner_setup tun_setup
;
317 PDEBUG(DBG_I2C
,"attach inform: detected I2C address %x", client
->addr
<< 1);
318 usbvision
->tuner_addr
= client
->addr
;
320 if ((usbvision
->have_tuner
) && (usbvision
->tuner_type
!= -1)) {
321 tun_setup
.mode_mask
= T_ANALOG_TV
| T_RADIO
;
322 tun_setup
.type
= usbvision
->tuner_type
;
323 tun_setup
.addr
= usbvision
->tuner_addr
;
324 call_i2c_clients(usbvision
, TUNER_SET_TYPE_ADDR
, &tun_setup
);
332 static int detach_inform(struct i2c_client
*client
)
334 struct usb_usbvision
*usbvision
;
336 usbvision
= (struct usb_usbvision
*)i2c_get_adapdata(client
->adapter
);
338 PDEBUG(DBG_I2C
,"usbvision[%d] detaches %s", usbvision
->nr
, client
->name
);
343 usbvision_i2c_read_max4(struct usb_usbvision
*usbvision
, unsigned char addr
,
344 char *buf
, short len
)
348 for (retries
= 5;;) {
349 rc
= usbvision_write_reg(usbvision
, USBVISION_SER_ADRS
, addr
);
353 /* Initiate byte read cycle */
354 /* USBVISION_SER_CONT <- d0-d2 n. of bytes to r/w */
356 rc
= usbvision_write_reg(usbvision
, USBVISION_SER_CONT
,
357 (len
& 0x07) | 0x18);
361 /* Test for Busy and ACK */
363 /* USBVISION_SER_CONT -> d4 == 0 busy */
364 rc
= usbvision_read_reg(usbvision
, USBVISION_SER_CONT
);
365 } while (rc
> 0 && ((rc
& 0x10) != 0)); /* Retry while busy */
369 /* USBVISION_SER_CONT -> d5 == 1 Not ack */
370 if ((rc
& 0x20) == 0) /* Ack? */
374 rc
= usbvision_write_reg(usbvision
, USBVISION_SER_CONT
, 0x00);
384 buf
[3] = usbvision_read_reg(usbvision
, USBVISION_SER_DAT4
);
386 buf
[2] = usbvision_read_reg(usbvision
, USBVISION_SER_DAT3
);
388 buf
[1] = usbvision_read_reg(usbvision
, USBVISION_SER_DAT2
);
390 buf
[0] = usbvision_read_reg(usbvision
, USBVISION_SER_DAT1
);
394 "usbvision_i2c_read_max4: buffer length > 4\n");
397 if (i2c_debug
& DBG_I2C
) {
399 for (idx
= 0; idx
< len
; idx
++) {
400 PDEBUG(DBG_I2C
,"read %x from address %x", (unsigned char)buf
[idx
], addr
);
407 static int usbvision_i2c_write_max4(struct usb_usbvision
*usbvision
,
408 unsigned char addr
, const char *buf
,
413 unsigned char value
[6];
414 unsigned char ser_cont
;
416 ser_cont
= (len
& 0x07) | 0x10;
420 for (i
= 0; i
< len
; i
++)
421 value
[i
+ 2] = buf
[i
];
423 for (retries
= 5;;) {
424 rc
= usb_control_msg(usbvision
->dev
,
425 usb_sndctrlpipe(usbvision
->dev
, 1),
427 USB_DIR_OUT
| USB_TYPE_VENDOR
|
428 USB_RECIP_ENDPOINT
, 0,
429 (__u16
) USBVISION_SER_ADRS
, value
,
435 rc
= usbvision_write_reg(usbvision
, USBVISION_SER_CONT
,
436 (len
& 0x07) | 0x10);
440 /* Test for Busy and ACK */
442 rc
= usbvision_read_reg(usbvision
, USBVISION_SER_CONT
);
443 } while (rc
> 0 && ((rc
& 0x10) != 0)); /* Retry while busy */
447 if ((rc
& 0x20) == 0) /* Ack? */
451 usbvision_write_reg(usbvision
, USBVISION_SER_CONT
, 0x00);
458 if (i2c_debug
& DBG_I2C
) {
460 for (idx
= 0; idx
< len
; idx
++) {
461 PDEBUG(DBG_I2C
,"wrote %x at address %x", (unsigned char)buf
[idx
], addr
);
467 static int usbvision_i2c_write(struct usb_usbvision
*usbvision
, unsigned char addr
, char *buf
,
477 count
= (len
> maxLen
) ? maxLen
: len
;
478 retval
= usbvision_i2c_write_max4(usbvision
, addr
, bufPtr
, count
);
484 return (retval
< 0) ? retval
: -EFAULT
;
489 static int usbvision_i2c_read(struct usb_usbvision
*usbvision
, unsigned char addr
, char *buf
,
498 count
= (len
> 3) ? 4 : len
;
499 retval
= usbvision_i2c_read_max4(usbvision
, addr
, temp
, count
);
501 for (i
= 0; i
< len
; i
++)
502 buf
[rdcount
+ i
] = temp
[i
];
506 return (retval
< 0) ? retval
: -EFAULT
;
511 static struct i2c_adapter i2c_adap_template
= {
512 .owner
= THIS_MODULE
,
514 .id
= I2C_HW_B_BT848
, /* FIXME */
515 .client_register
= attach_inform
,
516 .client_unregister
= detach_inform
,
517 .class = I2C_CLASS_TV_ANALOG
,
520 static struct i2c_client i2c_client_template
= {
521 .name
= "usbvision internal",
525 * Overrides for Emacs so that we follow Linus's tabbing style.
526 * ---------------------------------------------------------------------------