V4L/DVB: gspca_xirlink_cit: Use alt setting -> fps formula for model 1 cams too

gspca_xirlink_cit: Use alt setting -> fps formula for model 1 cams too

Signed-off-by: Hans de Goede <hdegoede@redhat.com>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>

1 files changed, 14 insertions, 4 deletions

diff --git a/drivers/media/video/gspca/xirlink_cit.c b/drivers/media/video/gspca/xirlink_cit.c
index 3b503b50b82e..b13ecbaf3e68 100644
--- a/drivers/media/video/gspca/xirlink_cit.c
+++ b/drivers/media/video/gspca/xirlink_cit.c
@@ -1659,7 +1659,19 @@ static int cit_start_model0(struct gspca_dev *gspca_dev)
 static int cit_start_model1(struct gspca_dev *gspca_dev)
 {
         struct sd *sd = (struct sd *) gspca_dev;
-        int i, clock_div = 0;
+        int clock_div = 7; /* 0=30 1=25 2=20 3=15 4=12 5=7.5 6=6 7=3fps ?? */
+        int fps[8] = { 30, 25, 20, 15, 12, 8, 6, 3 };
+        int i, packet_size;
+
+        packet_size = cit_get_packet_size(gspca_dev);
+        if (packet_size < 0)
+                return packet_size;
+
+        while (clock_div > 3 &&
+                        1000 * packet_size >
+                        gspca_dev->width * gspca_dev->height *
+                        fps[clock_div - 1] * 3 / 2)
+                clock_div--;
 
         cit_read_reg(gspca_dev, 0x0128);
         cit_read_reg(gspca_dev, 0x0100);
@@ -1767,7 +1779,6 @@ static int cit_start_model1(struct gspca_dev *gspca_dev)
                 cit_write_reg(gspca_dev, 0x0b, 0x011d);
                 cit_write_reg(gspca_dev, 0x00, 0x011e); /* Same everywhere */
                 cit_write_reg(gspca_dev, 0x00, 0x0129);
-                clock_div = 3;
                 break;
         case 176: /* 176x144 */
                 cit_write_reg(gspca_dev, 0xb0, 0x0103);
@@ -1777,7 +1788,6 @@ static int cit_start_model1(struct gspca_dev *gspca_dev)
                 cit_write_reg(gspca_dev, 0x0d, 0x011d);
                 cit_write_reg(gspca_dev, 0x00, 0x011e); /* Same everywhere */
                 cit_write_reg(gspca_dev, 0x03, 0x0129);
-                clock_div = 3;
                 break;
         case 352: /* 352x288 */
                 cit_write_reg(gspca_dev, 0xb0, 0x0103);
@@ -1787,7 +1797,6 @@ static int cit_start_model1(struct gspca_dev *gspca_dev)
                 cit_write_reg(gspca_dev, 0x05, 0x011d);
                 cit_write_reg(gspca_dev, 0x00, 0x011e); /* Same everywhere */
                 cit_write_reg(gspca_dev, 0x00, 0x0129);
-                clock_div = 5;
                 break;
         }
 
@@ -1852,6 +1861,7 @@ static int cit_start_model1(struct gspca_dev *gspca_dev)
 
         cit_write_reg(gspca_dev, 0x01, 0x0100); /* LED On  */
         cit_write_reg(gspca_dev, clock_div, 0x0111);
+        PDEBUG(D_PROBE, "Using clockdiv: %d", clock_div);
 
         return 0;
 }