2 files changed, 35 insertions, 48 deletions

diff --git a/drivers/media/dvb/dvb-usb/dib0700_devices.c b/drivers/media/dvb/dvb-usb/dib0700_devices.c
index 58ecc8ff858a..182051011c91 100644
--- a/drivers/media/dvb/dvb-usb/dib0700_devices.c
+++ b/drivers/media/dvb/dvb-usb/dib0700_devices.c
@@ -25,7 +25,7 @@ static struct mt2060_config bristol_mt2060_config[2] = {
 
 static struct dibx000_agc_config bristol_dib3000p_mt2060_agc_config = {
         .band_caps = BAND_VHF | BAND_UHF,
-        .setup     = (0 << 15) | (0 << 14) | (0 << 13) | (0 << 12) | (29 << 0),
+        .setup     = (1 << 8) | (5 << 5) | (0 << 4) | (0 << 3) | (0 << 2) | (2 << 0),
 
         .agc1_max = 42598,
         .agc1_min = 17694,
diff --git a/drivers/media/dvb/frontends/dib3000mc.c b/drivers/media/dvb/frontends/dib3000mc.c
index 60e10dba3684..0b051c7d5cd7 100644
--- a/drivers/media/dvb/frontends/dib3000mc.c
+++ b/drivers/media/dvb/frontends/dib3000mc.c
@@ -37,6 +37,8 @@ struct dib3000mc_state {
 
         struct dibx000_i2c_master i2c_master;
 
+        u32 timf;
+
         fe_bandwidth_t current_bandwidth;
 
         u16 dev_id;
@@ -92,50 +94,31 @@ static int dib3000mc_identify(struct dib3000mc_state *state)
 
 static int dib3000mc_set_timing(struct dib3000mc_state *state, s16 nfft, u8 bw, u8 update_offset)
 {
-/*
-        u32 timf_msb, timf_lsb, i;
-        int tim_sgn ;
-        LUInt comp1, comp2, comp ;
-//      u32 tim_offset ;
-        comp = 27700 * BW_INDEX_TO_KHZ(bw) / 1000;
-        timf_msb = (comp >> 16) & 0x00FF;
-        timf_lsb =  comp        & 0xFFFF;
-
-        // Update the timing offset ;
-        if (update_offset) {
-                if (state->timing_offset_comp_done == 0) {
-                        usleep(200000);
-                        state->timing_offset_comp_done = 1;
-                }
-                tim_offset = dib3000mc_read_word(state, 416);
-                if ((tim_offset & 0x2000) == 0x2000)
-                        tim_offset |= 0xC000; // PB: This only works if tim_offset is s16 - weird
-
-                if (nfft == 0)
-                        tim_offset = tim_offset << 2; // PB: Do not store the offset for different things in one variable
-                state->timing_offset += tim_offset;
-        }
-        tim_offset = state->timing_offset;
+        u32 timf;
 
-        if (tim_offset < 0) {
-                tim_sgn = 1;
-                tim_offset = -tim_offset;
+        if (state->timf == 0) {
+                timf = 1384402; // default value for 8MHz
+                if (update_offset)
+                        msleep(200); // first time we do an update
         } else
-                tim_sgn = 0;
+                timf = state->timf;
 
-        comp1 = tim_offset * timf_lsb;
-        comp2 = tim_offset * timf_msb;
-        comp  = ((comp1 >> 16) + comp2) >> 7;
+        timf *= (BW_INDEX_TO_KHZ(bw) / 1000);
 
-        if (tim_sgn == 0)
-                comp = timf_msb * (1<<16) + timf_lsb + comp;
-        else
-                comp = timf_msb * (1<<16) + timf_lsb - comp;
+        if (update_offset) {
+                s16 tim_offs = dib3000mc_read_word(state, 416);
+
+                if (tim_offs &  0x2000)
+                        tim_offs -= 0x4000;
+
+                if (nfft == 0)
+                        tim_offs *= 4;
+
+                timf += tim_offs;
+                state->timf = timf / (BW_INDEX_TO_KHZ(bw) / 1000);
+        }
 
-        timf_msb = (comp>>16)&0xFF ;
-        timf_lsb = comp&0xFFFF;
-*/
-        u32 timf = 1384402 * (BW_INDEX_TO_KHZ(bw) / 1000);
+        dprintk("timf: %d\n", timf);
 
         dib3000mc_write_word(state, 23, timf >> 16);
         dib3000mc_write_word(state, 24, timf & 0xffff);
@@ -143,15 +126,18 @@ static int dib3000mc_set_timing(struct dib3000mc_state *state, s16 nfft, u8 bw,
         return 0;
 }
 
-static int dib3000mc_setup_pwm3_state(struct dib3000mc_state *state)
+static int dib3000mc_setup_pwm_state(struct dib3000mc_state *state)
 {
+        u16 reg_51, reg_52 = state->cfg->agc->setup & 0xfefb;
     if (state->cfg->pwm3_inversion) {
-                dib3000mc_write_word(state, 51, (2 << 14) | (0 << 10) | (7 << 6) | (2 << 2) | (2 << 0));
-                dib3000mc_write_word(state, 52, (0 << 8) | (5 << 5) | (1 << 4) | (1 << 3) | (1 << 2) | (2 << 0));
+                reg_51 =  (2 << 14) | (0 << 10) | (7 << 6) | (2 << 2) | (2 << 0);
+                reg_52 |= (1 << 2);
         } else {
-                dib3000mc_write_word(state, 51, (2 << 14) | (4 << 10) | (7 << 6) | (2 << 2) | (2 << 0));
-                dib3000mc_write_word(state, 52, (1 << 8) | (5 << 5) | (1 << 4) | (1 << 3) | (0 << 2) | (2 << 0));
+                reg_51 = (2 << 14) | (4 << 10) | (7 << 6) | (2 << 2) | (2 << 0);
+                reg_52 |= (1 << 8);
         }
+        dib3000mc_write_word(state, 51, reg_51);
+        dib3000mc_write_word(state, 52, reg_52);
 
     if (state->cfg->use_pwm3)
                 dib3000mc_write_word(state, 245, (1 << 3) | (1 << 0));
@@ -350,7 +336,7 @@ static int dib3000mc_init(struct dvb_frontend *demod)
         dib3000mc_write_word(state, 50, 0x8000);
 
         // agc setup misc
-        dib3000mc_setup_pwm3_state(state);
+        dib3000mc_setup_pwm_state(state);
 
         // P_agc_counter_lock
         dib3000mc_write_word(state, 53, 0x87);
@@ -539,6 +525,7 @@ static int dib3000mc_autosearch_start(struct dvb_frontend *demod, struct dibx000
 
         reg = dib3000mc_read_word(state, 0);
         dib3000mc_write_word(state, 0, reg | (1 << 8));
+        dib3000mc_read_word(state, 511);
         dib3000mc_write_word(state, 0, reg);
 
         return 0;
@@ -578,8 +565,8 @@ static int dib3000mc_tune(struct dvb_frontend *demod, struct dibx000_ofdm_channe
                 dib3000mc_write_word(state, 33, 6);
         }
 
-        // if (lock)
-        //      dib3000mc_set_timing(state, ch->nfft, ch->Bw, 1);
+        if (dib3000mc_read_word(state, 509) & 0x80)
+                dib3000mc_set_timing(state, ch->nfft, ch->Bw, 1);
 
         return 0;
 }