Commit 1d07b6f1 authored by Erik Andrén's avatar Erik Andrén Committed by Mauro Carvalho Chehab
Browse files

V4L/DVB (10030): m5602: Use read/modify/write when toggling vflip on the po1030

parent 48223c88
Loading
Loading
Loading
Loading
+12 −4
Original line number Diff line number Diff line
@@ -184,12 +184,16 @@ int po1030_set_hflip(struct gspca_dev *gspca_dev, __s32 val)
	int err;

	PDEBUG(D_V4L2, "Set hflip %d", val);
	err = m5602_read_sensor(sd, PO1030_REG_CONTROL2, &i2c_data, 1);
	if (err < 0)
		goto out;

	i2c_data = (val & 0x01) << 7;
	i2c_data = (0x7f & i2c_data) | ((val & 0x01) << 7);

	err = m5602_write_sensor(sd, PO1030_REG_CONTROL2,
				 &i2c_data, 1);

out:
	return err;
}

@@ -216,12 +220,16 @@ int po1030_set_vflip(struct gspca_dev *gspca_dev, __s32 val)
	int err;

	PDEBUG(D_V4L2, "Set vflip %d", val);
	err = m5602_read_sensor(sd, PO1030_REG_CONTROL2, &i2c_data, 1);
	if (err < 0)
		goto out;

	i2c_data = (val & 0x01) << 6;
	i2c_data = (i2c_data & 0xbf) | ((val & 0x01) << 6);

	err = m5602_write_sensor(sd, PO1030_REG_CONTROL2,
				 &i2c_data, 1);

out:
	return err;
}