android/android_kernel_xiaomi_sm8450
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

V4L/DVB (10018): gspca - m5602 - ov9650: Use generic read_sensor function

Browse Source 
Toggle read sensor sequence depending on type of sensor. Check that no
more than max width of a sensor is read.

Signed-off-by: Erik Andrén <erik.andren@gmail.com>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
This commit is contained in:
Erik Andrén 2008-11-27 13:41:55 -03:00 committed by Mauro Carvalho Chehab
parent e7a7f5103b
commit edbfbdb3bd
1 changed files with 17 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
drivers/media/video/gspca/m5602/m5602_core.c
View File

@ -85,9 +85,14 @@ int m5602_read_sensor(struct sd *sd, const u8 address,
{ {
int err, i; int err, i;
if (!len || len > sd->sensor->i2c_regW)
return -EINVAL;
do { do {
err = m5602_read_bridge(sd, M5602_XB_I2C_STATUS, i2c_data); err = m5602_read_bridge(sd, M5602_XB_I2C_STATUS, i2c_data);
} while ((*i2c_data & I2C_BUSY) && !err); } while ((*i2c_data & I2C_BUSY) && !err);
if (err < 0)
goto out;
err = m5602_write_bridge(sd, M5602_XB_I2C_DEV_ADDR, err = m5602_write_bridge(sd, M5602_XB_I2C_DEV_ADDR,
sd->sensor->i2c_slave_id); sd->sensor->i2c_slave_id);
@ -98,13 +103,19 @@ int m5602_read_sensor(struct sd *sd, const u8 address,
if (err < 0) if (err < 0)
goto out; goto out;
err = m5602_write_bridge(sd, M5602_XB_I2C_CTRL, 0x10 + len); if (sd->sensor->i2c_regW == 1) {
if (err < 0) err = m5602_write_bridge(sd, M5602_XB_I2C_CTRL, len);
goto out; if (err < 0)
goto out;
err = m5602_write_bridge(sd, M5602_XB_I2C_CTRL, 0x08); err = m5602_write_bridge(sd, M5602_XB_I2C_CTRL, 0x08);
if (err < 0) if (err < 0)
goto out; goto out;
} else {
err = m5602_write_bridge(sd, M5602_XB_I2C_CTRL, 0x18 + len);
if (err < 0)
goto out;
}
for (i = 0; (i < len) && !err; i++) { for (i = 0; (i < len) && !err; i++) {
err = m5602_read_bridge(sd, M5602_XB_I2C_DATA, &(i2c_data[i])); err = m5602_read_bridge(sd, M5602_XB_I2C_DATA, &(i2c_data[i]));