evie/android_kernel_oneplus_msm8998
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

V4L/DVB (12820): tm6000: fix i2c readings

Browse source 
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
This commit is contained in:
Christopher Pascoe 2007-11-23 13:18:56 -03:00 • committed by Mauro Carvalho Chehab
parent 3716ae3ed7
commit cf9e1509c2
1 changed files with 26 additions and 7 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

33
drivers/staging/tm6000/tm6000-i2c.c
View file

@ -94,7 +94,7 @@ static int tm6000_i2c_xfer(struct i2c_adapter *i2c_adap,
{ {
struct tm6000_core *dev = i2c_adap->algo_data; struct tm6000_core *dev = i2c_adap->algo_data;
int addr, rc, i, byte; int addr, rc, i, byte;
u8 prev_reg = 0; int prev_reg = -1;
if (num <= 0) if (num <= 0)
return 0; return 0;
@ -113,16 +113,38 @@ static int tm6000_i2c_xfer(struct i2c_adapter *i2c_adap,
out of message data. out of message data.
*/ */
/* SMBus Read Byte command */ /* SMBus Read Byte command */
if (prev_reg < 0)
printk("XXX read from unknown prev_reg\n");
rc = tm6000_read_write_usb (dev, rc = tm6000_read_write_usb (dev,
USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE, USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
REQ_16_SET_GET_I2CSEQ, REQ_16_SET_GET_I2CSEQ,
addr | (prev_reg << 8), 0, addr | (prev_reg << 8), 0,
msgs[i].buf, msgs[i].len); msgs[i].buf, msgs[i].len);
if (prev_reg >= 0)
prev_reg += msgs[i].len;
if (i2c_debug>=2) { if (i2c_debug>=2) {
for (byte = 0; byte < msgs[i].len; byte++) { for (byte = 0; byte < msgs[i].len; byte++) {
printk(" %02x", msgs[i].buf[byte]); printk(" %02x", msgs[i].buf[byte]);
} }
} }
} else if (i+1 < num && msgs[i].len == 2 &&
(msgs[i+1].flags & I2C_M_RD) &&
msgs[i].addr == msgs[i+1].addr) {
i2c_dprintk(2, "msg %d: write 2, read %d", i,
msgs[i+1].len);
/* Write 2 Read N command */
rc = tm6000_read_write_usb (dev,
USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
REQ_14_SET_GET_EEPROM_PAGE, /* XXX wrong name */
addr | msgs[i].buf[0] << 8, msgs[i].buf[1],
msgs[i+1].buf, msgs[i+1].len);
i++;
if (i2c_debug>=2) {
for (byte = 0; byte < msgs[i].len; byte++) {
printk(" %02x", msgs[i].buf[byte]);
}
}
prev_reg = -1;
} else { } else {
/* write bytes */ /* write bytes */
if (i2c_debug>=2) { if (i2c_debug>=2) {
@ -134,6 +156,8 @@ static int tm6000_i2c_xfer(struct i2c_adapter *i2c_adap,
if(msgs[i].len == 1 && i+1 < num && msgs[i+1].flags & I2C_M_RD if(msgs[i].len == 1 && i+1 < num && msgs[i+1].flags & I2C_M_RD
&& msgs[i+1].addr == msgs[i].addr) { && msgs[i+1].addr == msgs[i].addr) {
prev_reg = msgs[i].buf[0]; prev_reg = msgs[i].buf[0];
if (i2c_debug >= 2)
printk("\n");
continue; continue;
} }
@ -143,12 +167,7 @@ static int tm6000_i2c_xfer(struct i2c_adapter *i2c_adap,
addr|(*msgs[i].buf)<<8, 0, addr|(*msgs[i].buf)<<8, 0,
msgs[i].buf+1, msgs[i].len-1); msgs[i].buf+1, msgs[i].len-1);
if(msgs[i].len >= 1) { prev_reg = -1;
prev_reg = msgs[i].buf[0];
}
else {
prev_reg = 0;
}
} }
if (i2c_debug>=2) if (i2c_debug>=2)
printk("\n"); printk("\n");