forked from luck/tmp_suning_uos_patched
[media] tda18271c2dd: Remove the CHK_ERROR macro
The CHK_ERROR macro does a flow control, violating chapter 12
of the Documentation/CodingStyle. Doing flow controls inside
macros is a bad idea, as it hides what's happening. It also
hides the var "status" with is also a bad idea.
The changes were done by this small perl script:
my $blk=0;
while (<>) {
s/^\s+// if ($blk);
$f =~ s/\s+$// if ($blk && /^\(/);
$blk = 1 if (!m/\#/ && m/CHK_ERROR/);
$blk=0 if ($blk && m/\;/);
s/\n/ / if ($blk);
$f.=$_;
};
$f=~ s,\n(\t+)CHK_ERROR\((.*)\)\;([^\n]*),\n\1status = \2;\3\n\1if (status < 0)\n\1\tbreak;,g;
print $f;
And manually fixed.
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
This commit is contained in:
Mauro Carvalho Chehab
parent
ea90f011fd
commit
469ffe0836
@ -175,9 +175,6 @@ static int UpdateReg(struct tda_state *state, u8 Reg)
|
||||
|
||||
#include "tda18271c2dd_maps.h"
|
||||
|
||||
#undef CHK_ERROR
|
||||
#define CHK_ERROR(s) if ((status = s) < 0) break
|
||||
|
||||
static void reset(struct tda_state *state)
|
||||
{
|
||||
u32 ulIFLevelAnalog = 0;
|
||||
@ -271,22 +268,34 @@ static int ThermometerRead(struct tda_state *state, u8 *pTM_Value)
|
||||
do {
|
||||
u8 Regs[16];
|
||||
state->m_Regs[TM] |= 0x10;
|
||||
CHK_ERROR(UpdateReg(state, TM));
|
||||
CHK_ERROR(Read(state, Regs));
|
||||
status = UpdateReg(state, TM);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = Read(state, Regs);
|
||||
if (status < 0)
|
||||
break;
|
||||
if (((Regs[TM] & 0x0F) == 0 && (Regs[TM] & 0x20) == 0x20) ||
|
||||
((Regs[TM] & 0x0F) == 8 && (Regs[TM] & 0x20) == 0x00)) {
|
||||
state->m_Regs[TM] ^= 0x20;
|
||||
CHK_ERROR(UpdateReg(state, TM));
|
||||
status = UpdateReg(state, TM);
|
||||
if (status < 0)
|
||||
break;
|
||||
msleep(10);
|
||||
CHK_ERROR(Read(state, Regs));
|
||||
status = Read(state, Regs);
|
||||
if (status < 0)
|
||||
break;
|
||||
}
|
||||
*pTM_Value = (Regs[TM] & 0x20)
|
||||
? m_Thermometer_Map_2[Regs[TM] & 0x0F]
|
||||
: m_Thermometer_Map_1[Regs[TM] & 0x0F] ;
|
||||
state->m_Regs[TM] &= ~0x10; /* Thermometer off */
|
||||
CHK_ERROR(UpdateReg(state, TM));
|
||||
status = UpdateReg(state, TM);
|
||||
if (status < 0)
|
||||
break;
|
||||
state->m_Regs[EP4] &= ~0x03; /* CAL_mode = 0 ????????? */
|
||||
CHK_ERROR(UpdateReg(state, EP4));
|
||||
status = UpdateReg(state, EP4);
|
||||
if (status < 0)
|
||||
break;
|
||||
} while (0);
|
||||
|
||||
return status;
|
||||
@ -297,14 +306,22 @@ static int StandBy(struct tda_state *state)
|
||||
int status = 0;
|
||||
do {
|
||||
state->m_Regs[EB12] &= ~0x20; /* PD_AGC1_Det = 0 */
|
||||
CHK_ERROR(UpdateReg(state, EB12));
|
||||
status = UpdateReg(state, EB12);
|
||||
if (status < 0)
|
||||
break;
|
||||
state->m_Regs[EB18] &= ~0x83; /* AGC1_loop_off = 0, AGC1_Gain = 6 dB */
|
||||
CHK_ERROR(UpdateReg(state, EB18));
|
||||
status = UpdateReg(state, EB18);
|
||||
if (status < 0)
|
||||
break;
|
||||
state->m_Regs[EB21] |= 0x03; /* AGC2_Gain = -6 dB */
|
||||
state->m_Regs[EP3] = state->m_EP3_Standby;
|
||||
CHK_ERROR(UpdateReg(state, EP3));
|
||||
status = UpdateReg(state, EP3);
|
||||
if (status < 0)
|
||||
break;
|
||||
state->m_Regs[EB23] &= ~0x06; /* ForceLP_Fc2_En = 0, LP_Fc[2] = 0 */
|
||||
CHK_ERROR(UpdateRegs(state, EB21, EB23));
|
||||
status = UpdateRegs(state, EB21, EB23);
|
||||
if (status < 0)
|
||||
break;
|
||||
} while (0);
|
||||
return status;
|
||||
}
|
||||
@ -369,9 +386,13 @@ static int CalibrateRF(struct tda_state *state,
|
||||
u8 RFC_M = 0;
|
||||
|
||||
state->m_Regs[EP4] &= ~0x03; /* CAL_mode = 0 */
|
||||
CHK_ERROR(UpdateReg(state, EP4));
|
||||
status = UpdateReg(state, EP4);
|
||||
if (status < 0)
|
||||
break;
|
||||
state->m_Regs[EB18] |= 0x03; /* AGC1_Gain = 3 */
|
||||
CHK_ERROR(UpdateReg(state, EB18));
|
||||
status = UpdateReg(state, EB18);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
/* Switching off LT (as datasheet says) causes calibration on C1 to fail */
|
||||
/* (Readout of Cprog is allways 255) */
|
||||
@ -388,52 +409,92 @@ static int CalibrateRF(struct tda_state *state,
|
||||
|
||||
state->m_Regs[EB13] = (state->m_Regs[EB13] & ~0x7C) | (RFC_K << 4) | (RFC_M << 2);
|
||||
|
||||
CHK_ERROR(UpdateRegs(state, EP1, EP3));
|
||||
CHK_ERROR(UpdateReg(state, EB13));
|
||||
status = UpdateRegs(state, EP1, EP3);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = UpdateReg(state, EB13);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
state->m_Regs[EB4] |= 0x20; /* LO_ForceSrce = 1 */
|
||||
CHK_ERROR(UpdateReg(state, EB4));
|
||||
status = UpdateReg(state, EB4);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
state->m_Regs[EB7] |= 0x20; /* CAL_ForceSrce = 1 */
|
||||
CHK_ERROR(UpdateReg(state, EB7));
|
||||
status = UpdateReg(state, EB7);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
state->m_Regs[EB14] = 0; /* RFC_Cprog = 0 */
|
||||
CHK_ERROR(UpdateReg(state, EB14));
|
||||
status = UpdateReg(state, EB14);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
state->m_Regs[EB20] &= ~0x20; /* ForceLock = 0; */
|
||||
CHK_ERROR(UpdateReg(state, EB20));
|
||||
status = UpdateReg(state, EB20);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
state->m_Regs[EP4] |= 0x03; /* CAL_Mode = 3 */
|
||||
CHK_ERROR(UpdateRegs(state, EP4, EP5));
|
||||
status = UpdateRegs(state, EP4, EP5);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
CHK_ERROR(CalcCalPLL(state, freq));
|
||||
CHK_ERROR(CalcMainPLL(state, freq + 1000000));
|
||||
status = CalcCalPLL(state, freq);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = CalcMainPLL(state, freq + 1000000);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
msleep(5);
|
||||
CHK_ERROR(UpdateReg(state, EP2));
|
||||
CHK_ERROR(UpdateReg(state, EP1));
|
||||
CHK_ERROR(UpdateReg(state, EP2));
|
||||
CHK_ERROR(UpdateReg(state, EP1));
|
||||
status = UpdateReg(state, EP2);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = UpdateReg(state, EP1);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = UpdateReg(state, EP2);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = UpdateReg(state, EP1);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
state->m_Regs[EB4] &= ~0x20; /* LO_ForceSrce = 0 */
|
||||
CHK_ERROR(UpdateReg(state, EB4));
|
||||
status = UpdateReg(state, EB4);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
state->m_Regs[EB7] &= ~0x20; /* CAL_ForceSrce = 0 */
|
||||
CHK_ERROR(UpdateReg(state, EB7));
|
||||
status = UpdateReg(state, EB7);
|
||||
if (status < 0)
|
||||
break;
|
||||
msleep(10);
|
||||
|
||||
state->m_Regs[EB20] |= 0x20; /* ForceLock = 1; */
|
||||
CHK_ERROR(UpdateReg(state, EB20));
|
||||
status = UpdateReg(state, EB20);
|
||||
if (status < 0)
|
||||
break;
|
||||
msleep(60);
|
||||
|
||||
state->m_Regs[EP4] &= ~0x03; /* CAL_Mode = 0 */
|
||||
state->m_Regs[EP3] &= ~0x40; /* SM_LT = 0 */
|
||||
state->m_Regs[EB18] &= ~0x03; /* AGC1_Gain = 0 */
|
||||
CHK_ERROR(UpdateReg(state, EB18));
|
||||
CHK_ERROR(UpdateRegs(state, EP3, EP4));
|
||||
CHK_ERROR(UpdateReg(state, EP1));
|
||||
status = UpdateReg(state, EB18);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = UpdateRegs(state, EP3, EP4);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = UpdateReg(state, EP1);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
CHK_ERROR(ReadExtented(state, Regs));
|
||||
status = ReadExtented(state, Regs);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
*pCprog = Regs[EB14];
|
||||
|
||||
@ -464,9 +525,13 @@ static int RFTrackingFiltersInit(struct tda_state *state,
|
||||
state->m_RF_B2[RFBand] = 0;
|
||||
|
||||
do {
|
||||
CHK_ERROR(PowerScan(state, RFBand, RF1, &RF1, &bcal));
|
||||
status = PowerScan(state, RFBand, RF1, &RF1, &bcal);
|
||||
if (status < 0)
|
||||
break;
|
||||
if (bcal) {
|
||||
CHK_ERROR(CalibrateRF(state, RFBand, RF1, &Cprog_cal1));
|
||||
status = CalibrateRF(state, RFBand, RF1, &Cprog_cal1);
|
||||
if (status < 0)
|
||||
break;
|
||||
}
|
||||
SearchMap2(m_RF_Cal_Map, RF1, &Cprog_table1);
|
||||
if (!bcal)
|
||||
@ -477,9 +542,13 @@ static int RFTrackingFiltersInit(struct tda_state *state,
|
||||
if (RF2 == 0)
|
||||
break;
|
||||
|
||||
CHK_ERROR(PowerScan(state, RFBand, RF2, &RF2, &bcal));
|
||||
status = PowerScan(state, RFBand, RF2, &RF2, &bcal);
|
||||
if (status < 0)
|
||||
break;
|
||||
if (bcal) {
|
||||
CHK_ERROR(CalibrateRF(state, RFBand, RF2, &Cprog_cal2));
|
||||
status = CalibrateRF(state, RFBand, RF2, &Cprog_cal2);
|
||||
if (status < 0)
|
||||
break;
|
||||
}
|
||||
SearchMap2(m_RF_Cal_Map, RF2, &Cprog_table2);
|
||||
if (!bcal)
|
||||
@ -492,9 +561,13 @@ static int RFTrackingFiltersInit(struct tda_state *state,
|
||||
if (RF3 == 0)
|
||||
break;
|
||||
|
||||
CHK_ERROR(PowerScan(state, RFBand, RF3, &RF3, &bcal));
|
||||
status = PowerScan(state, RFBand, RF3, &RF3, &bcal);
|
||||
if (status < 0)
|
||||
break;
|
||||
if (bcal) {
|
||||
CHK_ERROR(CalibrateRF(state, RFBand, RF3, &Cprog_cal3));
|
||||
status = CalibrateRF(state, RFBand, RF3, &Cprog_cal3);
|
||||
if (status < 0)
|
||||
break;
|
||||
}
|
||||
SearchMap2(m_RF_Cal_Map, RF3, &Cprog_table3);
|
||||
if (!bcal)
|
||||
@ -543,16 +616,28 @@ static int PowerScan(struct tda_state *state,
|
||||
|
||||
state->m_Regs[EP2] = (RFBand << 5) | Gain_Taper;
|
||||
state->m_Regs[EB14] = (RFC_Cprog);
|
||||
CHK_ERROR(UpdateReg(state, EP2));
|
||||
CHK_ERROR(UpdateReg(state, EB14));
|
||||
status = UpdateReg(state, EP2);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = UpdateReg(state, EB14);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
freq_MainPLL = RF_in + 1000000;
|
||||
CHK_ERROR(CalcMainPLL(state, freq_MainPLL));
|
||||
status = CalcMainPLL(state, freq_MainPLL);
|
||||
if (status < 0)
|
||||
break;
|
||||
msleep(5);
|
||||
state->m_Regs[EP4] = (state->m_Regs[EP4] & ~0x03) | 1; /* CAL_mode = 1 */
|
||||
CHK_ERROR(UpdateReg(state, EP4));
|
||||
CHK_ERROR(UpdateReg(state, EP2)); /* Launch power measurement */
|
||||
CHK_ERROR(ReadExtented(state, Regs));
|
||||
status = UpdateReg(state, EP4);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = UpdateReg(state, EP2); /* Launch power measurement */
|
||||
if (status < 0)
|
||||
break;
|
||||
status = ReadExtented(state, Regs);
|
||||
if (status < 0)
|
||||
break;
|
||||
CID_Gain = Regs[EB10] & 0x3F;
|
||||
state->m_Regs[ID] = Regs[ID]; /* Chip version, (needed for C1 workarround in CalibrateRF) */
|
||||
|
||||
@ -560,11 +645,17 @@ static int PowerScan(struct tda_state *state,
|
||||
|
||||
while (CID_Gain < CID_Target) {
|
||||
freq_MainPLL = RF_in + sign * Count + 1000000;
|
||||
CHK_ERROR(CalcMainPLL(state, freq_MainPLL));
|
||||
status = CalcMainPLL(state, freq_MainPLL);
|
||||
if (status < 0)
|
||||
break;
|
||||
msleep(wait ? 5 : 1);
|
||||
wait = false;
|
||||
CHK_ERROR(UpdateReg(state, EP2)); /* Launch power measurement */
|
||||
CHK_ERROR(ReadExtented(state, Regs));
|
||||
status = UpdateReg(state, EP2); /* Launch power measurement */
|
||||
if (status < 0)
|
||||
break;
|
||||
status = ReadExtented(state, Regs);
|
||||
if (status < 0)
|
||||
break;
|
||||
CID_Gain = Regs[EB10] & 0x3F;
|
||||
Count += 200000;
|
||||
|
||||
@ -577,7 +668,9 @@ static int PowerScan(struct tda_state *state,
|
||||
Count = 200000;
|
||||
wait = true;
|
||||
}
|
||||
CHK_ERROR(status);
|
||||
status = status;
|
||||
if (status < 0)
|
||||
break;
|
||||
if (CID_Gain >= CID_Target) {
|
||||
*pbcal = true;
|
||||
*pRF_Out = freq_MainPLL - 1000000;
|
||||
@ -594,12 +687,18 @@ static int PowerScanInit(struct tda_state *state)
|
||||
do {
|
||||
state->m_Regs[EP3] = (state->m_Regs[EP3] & ~0x1F) | 0x12;
|
||||
state->m_Regs[EP4] = (state->m_Regs[EP4] & ~0x1F); /* If level = 0, Cal mode = 0 */
|
||||
CHK_ERROR(UpdateRegs(state, EP3, EP4));
|
||||
status = UpdateRegs(state, EP3, EP4);
|
||||
if (status < 0)
|
||||
break;
|
||||
state->m_Regs[EB18] = (state->m_Regs[EB18] & ~0x03); /* AGC 1 Gain = 0 */
|
||||
CHK_ERROR(UpdateReg(state, EB18));
|
||||
status = UpdateReg(state, EB18);
|
||||
if (status < 0)
|
||||
break;
|
||||
state->m_Regs[EB21] = (state->m_Regs[EB21] & ~0x03); /* AGC 2 Gain = 0 (Datasheet = 3) */
|
||||
state->m_Regs[EB23] = (state->m_Regs[EB23] | 0x06); /* ForceLP_Fc2_En = 1, LPFc[2] = 1 */
|
||||
CHK_ERROR(UpdateRegs(state, EB21, EB23));
|
||||
status = UpdateRegs(state, EB21, EB23);
|
||||
if (status < 0)
|
||||
break;
|
||||
} while (0);
|
||||
return status;
|
||||
}
|
||||
@ -609,15 +708,33 @@ static int CalcRFFilterCurve(struct tda_state *state)
|
||||
int status = 0;
|
||||
do {
|
||||
msleep(200); /* Temperature stabilisation */
|
||||
CHK_ERROR(PowerScanInit(state));
|
||||
CHK_ERROR(RFTrackingFiltersInit(state, 0));
|
||||
CHK_ERROR(RFTrackingFiltersInit(state, 1));
|
||||
CHK_ERROR(RFTrackingFiltersInit(state, 2));
|
||||
CHK_ERROR(RFTrackingFiltersInit(state, 3));
|
||||
CHK_ERROR(RFTrackingFiltersInit(state, 4));
|
||||
CHK_ERROR(RFTrackingFiltersInit(state, 5));
|
||||
CHK_ERROR(RFTrackingFiltersInit(state, 6));
|
||||
CHK_ERROR(ThermometerRead(state, &state->m_TMValue_RFCal)); /* also switches off Cal mode !!! */
|
||||
status = PowerScanInit(state);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = RFTrackingFiltersInit(state, 0);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = RFTrackingFiltersInit(state, 1);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = RFTrackingFiltersInit(state, 2);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = RFTrackingFiltersInit(state, 3);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = RFTrackingFiltersInit(state, 4);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = RFTrackingFiltersInit(state, 5);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = RFTrackingFiltersInit(state, 6);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = ThermometerRead(state, &state->m_TMValue_RFCal); /* also switches off Cal mode !!! */
|
||||
if (status < 0)
|
||||
break;
|
||||
} while (0);
|
||||
|
||||
return status;
|
||||
@ -640,17 +757,27 @@ static int FixedContentsI2CUpdate(struct tda_state *state)
|
||||
int status = 0;
|
||||
memcpy(&state->m_Regs[TM], InitRegs, EB23 - TM + 1);
|
||||
do {
|
||||
CHK_ERROR(UpdateRegs(state, TM, EB23));
|
||||
status = UpdateRegs(state, TM, EB23);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
/* AGC1 gain setup */
|
||||
state->m_Regs[EB17] = 0x00;
|
||||
CHK_ERROR(UpdateReg(state, EB17));
|
||||
status = UpdateReg(state, EB17);
|
||||
if (status < 0)
|
||||
break;
|
||||
state->m_Regs[EB17] = 0x03;
|
||||
CHK_ERROR(UpdateReg(state, EB17));
|
||||
status = UpdateReg(state, EB17);
|
||||
if (status < 0)
|
||||
break;
|
||||
state->m_Regs[EB17] = 0x43;
|
||||
CHK_ERROR(UpdateReg(state, EB17));
|
||||
status = UpdateReg(state, EB17);
|
||||
if (status < 0)
|
||||
break;
|
||||
state->m_Regs[EB17] = 0x4C;
|
||||
CHK_ERROR(UpdateReg(state, EB17));
|
||||
status = UpdateReg(state, EB17);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
/* IRC Cal Low band */
|
||||
state->m_Regs[EP3] = 0x1F;
|
||||
@ -664,27 +791,39 @@ static int FixedContentsI2CUpdate(struct tda_state *state)
|
||||
state->m_Regs[MD1] = 0x77;
|
||||
state->m_Regs[MD2] = 0x08;
|
||||
state->m_Regs[MD3] = 0x00;
|
||||
CHK_ERROR(UpdateRegs(state, EP2, MD3)); /* diff between sw and datasheet (ep3-md3) */
|
||||
status = UpdateRegs(state, EP2, MD3); /* diff between sw and datasheet (ep3-md3) */
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
#if 0
|
||||
state->m_Regs[EB4] = 0x61; /* missing in sw */
|
||||
CHK_ERROR(UpdateReg(state, EB4));
|
||||
status = UpdateReg(state, EB4);
|
||||
if (status < 0)
|
||||
break;
|
||||
msleep(1);
|
||||
state->m_Regs[EB4] = 0x41;
|
||||
CHK_ERROR(UpdateReg(state, EB4));
|
||||
status = UpdateReg(state, EB4);
|
||||
if (status < 0)
|
||||
break;
|
||||
#endif
|
||||
|
||||
msleep(5);
|
||||
CHK_ERROR(UpdateReg(state, EP1));
|
||||
status = UpdateReg(state, EP1);
|
||||
if (status < 0)
|
||||
break;
|
||||
msleep(5);
|
||||
|
||||
state->m_Regs[EP5] = 0x85;
|
||||
state->m_Regs[CPD] = 0xCB;
|
||||
state->m_Regs[CD1] = 0x66;
|
||||
state->m_Regs[CD2] = 0x70;
|
||||
CHK_ERROR(UpdateRegs(state, EP3, CD3));
|
||||
status = UpdateRegs(state, EP3, CD3);
|
||||
if (status < 0)
|
||||
break;
|
||||
msleep(5);
|
||||
CHK_ERROR(UpdateReg(state, EP2));
|
||||
status = UpdateReg(state, EP2);
|
||||
if (status < 0)
|
||||
break;
|
||||
msleep(30);
|
||||
|
||||
/* IRC Cal mid band */
|
||||
@ -694,19 +833,27 @@ static int FixedContentsI2CUpdate(struct tda_state *state)
|
||||
state->m_Regs[MPD] = 0xA1; /* Datasheet = 0xA9 */
|
||||
state->m_Regs[MD1] = 0x73;
|
||||
state->m_Regs[MD2] = 0x1A;
|
||||
CHK_ERROR(UpdateRegs(state, EP3, MD3));
|
||||
status = UpdateRegs(state, EP3, MD3);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
msleep(5);
|
||||
CHK_ERROR(UpdateReg(state, EP1));
|
||||
status = UpdateReg(state, EP1);
|
||||
if (status < 0)
|
||||
break;
|
||||
msleep(5);
|
||||
|
||||
state->m_Regs[EP5] = 0x86;
|
||||
state->m_Regs[CPD] = 0xA8;
|
||||
state->m_Regs[CD1] = 0x66;
|
||||
state->m_Regs[CD2] = 0xA0;
|
||||
CHK_ERROR(UpdateRegs(state, EP3, CD3));
|
||||
status = UpdateRegs(state, EP3, CD3);
|
||||
if (status < 0)
|
||||
break;
|
||||
msleep(5);
|
||||
CHK_ERROR(UpdateReg(state, EP2));
|
||||
status = UpdateReg(state, EP2);
|
||||
if (status < 0)
|
||||
break;
|
||||
msleep(30);
|
||||
|
||||
/* IRC Cal high band */
|
||||
@ -717,22 +864,34 @@ static int FixedContentsI2CUpdate(struct tda_state *state)
|
||||
state->m_Regs[MPD] = 0x91; /* Datasheet = 0x91 */
|
||||
state->m_Regs[MD1] = 0x71;
|
||||
state->m_Regs[MD2] = 0xCD;
|
||||
CHK_ERROR(UpdateRegs(state, EP3, MD3));
|
||||
status = UpdateRegs(state, EP3, MD3);
|
||||
if (status < 0)
|
||||
break;
|
||||
msleep(5);
|
||||
CHK_ERROR(UpdateReg(state, EP1));
|
||||
status = UpdateReg(state, EP1);
|
||||
if (status < 0)
|
||||
break;
|
||||
msleep(5);
|
||||
state->m_Regs[EP5] = 0x87;
|
||||
state->m_Regs[CD1] = 0x65;
|
||||
state->m_Regs[CD2] = 0x50;
|
||||
CHK_ERROR(UpdateRegs(state, EP3, CD3));
|
||||
status = UpdateRegs(state, EP3, CD3);
|
||||
if (status < 0)
|
||||
break;
|
||||
msleep(5);
|
||||
CHK_ERROR(UpdateReg(state, EP2));
|
||||
status = UpdateReg(state, EP2);
|
||||
if (status < 0)
|
||||
break;
|
||||
msleep(30);
|
||||
|
||||
/* Back to normal */
|
||||
state->m_Regs[EP4] = 0x64;
|
||||
CHK_ERROR(UpdateReg(state, EP4));
|
||||
CHK_ERROR(UpdateReg(state, EP1));
|
||||
status = UpdateReg(state, EP4);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = UpdateReg(state, EP1);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
} while (0);
|
||||
return status;
|
||||
@ -743,9 +902,15 @@ static int InitCal(struct tda_state *state)
|
||||
int status = 0;
|
||||
|
||||
do {
|
||||
CHK_ERROR(FixedContentsI2CUpdate(state));
|
||||
CHK_ERROR(CalcRFFilterCurve(state));
|
||||
CHK_ERROR(StandBy(state));
|
||||
status = FixedContentsI2CUpdate(state);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = CalcRFFilterCurve(state);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = StandBy(state);
|
||||
if (status < 0)
|
||||
break;
|
||||
/* m_bInitDone = true; */
|
||||
} while (0);
|
||||
return status;
|
||||
@ -778,9 +943,13 @@ static int RFTrackingFiltersCorrection(struct tda_state *state,
|
||||
int TComp;
|
||||
|
||||
state->m_Regs[EP3] &= ~0xE0; /* Power up */
|
||||
CHK_ERROR(UpdateReg(state, EP3));
|
||||
status = UpdateReg(state, EP3);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
CHK_ERROR(ThermometerRead(state, &TMValue_Current));
|
||||
status = ThermometerRead(state, &TMValue_Current);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
if (RF3 == 0 || Frequency < RF2)
|
||||
Capprox = RF_A1 * ((s32)(Frequency) - (s32)(RF1)) + RF_B1 + Cprog_table;
|
||||
@ -801,7 +970,9 @@ static int RFTrackingFiltersCorrection(struct tda_state *state,
|
||||
/* missing in the datasheet, so leave it out for now. */
|
||||
state->m_Regs[EB14] = Capprox;
|
||||
|
||||
CHK_ERROR(UpdateReg(state, EB14));
|
||||
status = UpdateReg(state, EB14);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
} while (0);
|
||||
return status;
|
||||
@ -863,7 +1034,9 @@ static int ChannelConfiguration(struct tda_state *state,
|
||||
else
|
||||
state->m_Regs[EB23] &= ~0x06; /* ForceLP_Fc2_En = 0, LPFc[2] = 0 */
|
||||
|
||||
CHK_ERROR(UpdateRegs(state, EB22, EB23));
|
||||
status = UpdateRegs(state, EB22, EB23);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
state->m_Regs[EP1] = (state->m_Regs[EP1] & ~0x07) | 0x40 | BP_Filter; /* Dis_Power_level = 1, Filter */
|
||||
state->m_Regs[EP5] = (state->m_Regs[EP5] & ~0x07) | IR_Meas;
|
||||
@ -873,36 +1046,58 @@ static int ChannelConfiguration(struct tda_state *state,
|
||||
(state->m_bMaster ? 0x04 : 0x00); /* CALVCO_FortLOn = MS */
|
||||
/* AGC1_always_master = 0 */
|
||||
/* AGC_firstn = 0 */
|
||||
CHK_ERROR(UpdateReg(state, EB1));
|
||||
status = UpdateReg(state, EB1);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
if (state->m_bMaster) {
|
||||
CHK_ERROR(CalcMainPLL(state, Frequency + IntermediateFrequency));
|
||||
CHK_ERROR(UpdateRegs(state, TM, EP5));
|
||||
status = CalcMainPLL(state, Frequency + IntermediateFrequency);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = UpdateRegs(state, TM, EP5);
|
||||
if (status < 0)
|
||||
break;
|
||||
state->m_Regs[EB4] |= 0x20; /* LO_forceSrce = 1 */
|
||||
CHK_ERROR(UpdateReg(state, EB4));
|
||||
status = UpdateReg(state, EB4);
|
||||
if (status < 0)
|
||||
break;
|
||||
msleep(1);
|
||||
state->m_Regs[EB4] &= ~0x20; /* LO_forceSrce = 0 */
|
||||
CHK_ERROR(UpdateReg(state, EB4));
|
||||
status = UpdateReg(state, EB4);
|
||||
if (status < 0)
|
||||
break;
|
||||
} else {
|
||||
u8 PostDiv = 0;
|
||||
u8 Div;
|
||||
CHK_ERROR(CalcCalPLL(state, Frequency + IntermediateFrequency));
|
||||
status = CalcCalPLL(state, Frequency + IntermediateFrequency);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
SearchMap3(m_Cal_PLL_Map, Frequency + IntermediateFrequency, &PostDiv, &Div);
|
||||
state->m_Regs[MPD] = (state->m_Regs[MPD] & ~0x7F) | (PostDiv & 0x77);
|
||||
CHK_ERROR(UpdateReg(state, MPD));
|
||||
CHK_ERROR(UpdateRegs(state, TM, EP5));
|
||||
status = UpdateReg(state, MPD);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = UpdateRegs(state, TM, EP5);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
state->m_Regs[EB7] |= 0x20; /* CAL_forceSrce = 1 */
|
||||
CHK_ERROR(UpdateReg(state, EB7));
|
||||
status = UpdateReg(state, EB7);
|
||||
if (status < 0)
|
||||
break;
|
||||
msleep(1);
|
||||
state->m_Regs[EB7] &= ~0x20; /* CAL_forceSrce = 0 */
|
||||
CHK_ERROR(UpdateReg(state, EB7));
|
||||
status = UpdateReg(state, EB7);
|
||||
if (status < 0)
|
||||
break;
|
||||
}
|
||||
msleep(20);
|
||||
if (Standard != HF_FM_Radio)
|
||||
state->m_Regs[EP3] |= 0x04; /* RFAGC to normal mode */
|
||||
CHK_ERROR(UpdateReg(state, EP3));
|
||||
status = UpdateReg(state, EP3);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
} while (0);
|
||||
return status;
|
||||
@ -955,8 +1150,12 @@ static int set_params(struct dvb_frontend *fe,
|
||||
} else
|
||||
return -EINVAL;
|
||||
do {
|
||||
CHK_ERROR(RFTrackingFiltersCorrection(state, params->frequency));
|
||||
CHK_ERROR(ChannelConfiguration(state, params->frequency, Standard));
|
||||
status = RFTrackingFiltersCorrection(state, params->frequency);
|
||||
if (status < 0)
|
||||
break;
|
||||
status = ChannelConfiguration(state, params->frequency, Standard);
|
||||
if (status < 0)
|
||||
break;
|
||||
|
||||
msleep(state->m_SettlingTime); /* Allow AGC's to settle down */
|
||||
} while (0);
|
||||
|
||||
Loading…
Reference in New Issue
Block a user