1 files changed, 14 insertions, 2 deletions

diff --git a/drivers/media/video/gspca/m5602/m5602_ov9650.c b/drivers/media/video/gspca/m5602/m5602_ov9650.c
index 76317e274bf..bbf91356096 100644
--- a/drivers/media/video/gspca/m5602/m5602_ov9650.c
+++ b/drivers/media/video/gspca/m5602/m5602_ov9650.c
@@ -147,8 +147,14 @@ int ov9650_start(struct sd *sd)
         int i, err = 0;
         struct cam *cam = &sd->gspca_dev.cam;
 
-        for (i = 0; i < ARRAY_SIZE(res_init_ov9650) && !err; i++)
-                err = m5602_write_bridge(sd, res_init_ov9650[i][0], res_init_ov9650[i][1]);
+        for (i = 0; i < ARRAY_SIZE(res_init_ov9650) && !err; i++) {
+                if (res_init_ov9650[i][0] == BRIDGE)
+                        err = m5602_write_bridge(sd, res_init_ov9650[i][1], res_init_ov9650[i][2]);
+                else if (res_init_ov9650[i][0] == SENSOR) {
+                        u8 data = res_init_ov9650[i][2];
+                        err = m5602_write_sensor(sd, res_init_ov9650[i][1], &data, 1);
+                }
+        }
         if (err < 0)
                 return err;
 
@@ -217,6 +223,12 @@ int ov9650_start(struct sd *sd)
         return err;
 }
 
+int ov9650_stop(struct sd *sd)
+{
+        u8 data = OV9650_SOFT_SLEEP | OV9650_OUTPUT_DRIVE_2X;
+        return m5602_write_sensor(sd, OV9650_COM2, &data, 1);
+}
+
 int ov9650_power_down(struct sd *sd)
 {
         int i, err = 0;