Commit 00b581ef authored by Brian Johnson's avatar Brian Johnson Committed by Mauro Carvalho Chehab

V4L/DVB (12351): gspca - sn9c20x: Misc fixes

* use i2c_w instead of reg_w
* return error on failure
* read the correct number of bytes
Signed-off-by: default avatarBrian Johnson <brijohn@gmail.com>
Signed-off-by: default avatarJean-Francois Moine <moinejf@free.fr>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@redhat.com>
parent f3d6f633
...@@ -1096,12 +1096,12 @@ int i2c_w(struct gspca_dev *gspca_dev, const u8 *buffer) ...@@ -1096,12 +1096,12 @@ int i2c_w(struct gspca_dev *gspca_dev, const u8 *buffer)
reg_r(gspca_dev, 0x10c0, 1); reg_r(gspca_dev, 0x10c0, 1);
if (gspca_dev->usb_buf[0] & 0x04) { if (gspca_dev->usb_buf[0] & 0x04) {
if (gspca_dev->usb_buf[0] & 0x08) if (gspca_dev->usb_buf[0] & 0x08)
return -1; return -EIO;
return 0; return 0;
} }
msleep(1); msleep(1);
} }
return -1; return -EIO;
} }
int i2c_w1(struct gspca_dev *gspca_dev, u8 reg, u8 val) int i2c_w1(struct gspca_dev *gspca_dev, u8 reg, u8 val)
...@@ -1152,7 +1152,7 @@ int i2c_r1(struct gspca_dev *gspca_dev, u8 reg, u8 *val) ...@@ -1152,7 +1152,7 @@ int i2c_r1(struct gspca_dev *gspca_dev, u8 reg, u8 *val)
struct sd *sd = (struct sd *) gspca_dev; struct sd *sd = (struct sd *) gspca_dev;
u8 row[8]; u8 row[8];
row[0] = 0x81 | 0x10; row[0] = 0x81 | (1 << 4);
row[1] = sd->i2c_addr; row[1] = sd->i2c_addr;
row[2] = reg; row[2] = reg;
row[3] = 0; row[3] = 0;
...@@ -1160,14 +1160,15 @@ int i2c_r1(struct gspca_dev *gspca_dev, u8 reg, u8 *val) ...@@ -1160,14 +1160,15 @@ int i2c_r1(struct gspca_dev *gspca_dev, u8 reg, u8 *val)
row[5] = 0; row[5] = 0;
row[6] = 0; row[6] = 0;
row[7] = 0x10; row[7] = 0x10;
reg_w(gspca_dev, 0x10c0, row, 8); if (i2c_w(gspca_dev, row) < 0)
msleep(1); return -EIO;
row[0] = 0x81 | (2 << 4) | 0x02; row[0] = 0x81 | (1 << 4) | 0x02;
row[2] = 0; row[2] = 0;
reg_w(gspca_dev, 0x10c0, row, 8); if (i2c_w(gspca_dev, row) < 0)
msleep(1); return -EIO;
reg_r(gspca_dev, 0x10c2, 5); if (reg_r(gspca_dev, 0x10c2, 5) < 0)
*val = gspca_dev->usb_buf[3]; return -EIO;
*val = gspca_dev->usb_buf[4];
return 0; return 0;
} }
...@@ -1176,7 +1177,7 @@ int i2c_r2(struct gspca_dev *gspca_dev, u8 reg, u16 *val) ...@@ -1176,7 +1177,7 @@ int i2c_r2(struct gspca_dev *gspca_dev, u8 reg, u16 *val)
struct sd *sd = (struct sd *) gspca_dev; struct sd *sd = (struct sd *) gspca_dev;
u8 row[8]; u8 row[8];
row[0] = 0x81 | 0x10; row[0] = 0x81 | (1 << 4);
row[1] = sd->i2c_addr; row[1] = sd->i2c_addr;
row[2] = reg; row[2] = reg;
row[3] = 0; row[3] = 0;
...@@ -1184,14 +1185,15 @@ int i2c_r2(struct gspca_dev *gspca_dev, u8 reg, u16 *val) ...@@ -1184,14 +1185,15 @@ int i2c_r2(struct gspca_dev *gspca_dev, u8 reg, u16 *val)
row[5] = 0; row[5] = 0;
row[6] = 0; row[6] = 0;
row[7] = 0x10; row[7] = 0x10;
reg_w(gspca_dev, 0x10c0, row, 8); if (i2c_w(gspca_dev, row) < 0)
msleep(1); return -EIO;
row[0] = 0x81 | (3 << 4) | 0x02; row[0] = 0x81 | (2 << 4) | 0x02;
row[2] = 0; row[2] = 0;
reg_w(gspca_dev, 0x10c0, row, 8); if (i2c_w(gspca_dev, row) < 0)
msleep(1); return -EIO;
reg_r(gspca_dev, 0x10c2, 5); if (reg_r(gspca_dev, 0x10c2, 5) < 0)
*val = (gspca_dev->usb_buf[2] << 8) | gspca_dev->usb_buf[3]; return -EIO;
*val = (gspca_dev->usb_buf[3] << 8) | gspca_dev->usb_buf[4];
return 0; return 0;
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment