diff --git a/drivers/media/video/gspca/mars.c b/drivers/media/video/gspca/mars.c
index e85ba1aa8bd3dc1a9ea7f14ea8b8b0f8a51b5de1..1eeac4041a61374e76ed3513eb7a933277dc455f 100644
--- a/drivers/media/video/gspca/mars.c
+++ b/drivers/media/video/gspca/mars.c
@@ -325,12 +325,12 @@ static void sd_pkt_scan(struct gspca_dev *gspca_dev,
 				PDEBUG(D_PACK, "sof offset: %d len: %d",
 					p, len);
 				frame = gspca_frame_add(gspca_dev, LAST_PACKET,
-							frame, data, 0);
+							frame, data, p);
 
 				/* put the JPEG header */
 				jpeg_put_header(gspca_dev, frame, 0x21);
-				data += 16;
-				len -= 16;
+				data += p + 16;
+				len -= p + 16;
 				break;
 			}
 		}