Skip to content

K
kernel_linux

OpenHarmony / kernel_linux
上一次同步 4 年多

通知 15
Star 8
Fork 2
K
kernel_linux
提交 ebc7de22 编写于 作者: O Oliver Endriss 提交者： Mauro Carvalho Chehab
浏览文件
操作

[media] DRX-K: Tons of coding-style fixes 

Tons of coding-style fixes
Signed-off-by: NOliver Endriss <o.endriss@gmx.de>
Signed-off-by: NMauro Carvalho Chehab <mchehab@redhat.com>
上级 874f6518
显示空白变更内容
内联 并排
Showing with 2444 addition and 2129 deletion
drivers/media/dvb/frontends/drxk_hard.c
浏览文件 @ ebc7de22
...@@ -37,13 +37,16 @@ ...@@ -37,13 +37,16 @@
static int PowerDownDVBT(struct drxk_state *state, bool setPowerMode); static int PowerDownDVBT(struct drxk_state *state, bool setPowerMode);
static int PowerDownQAM(struct drxk_state *state); static int PowerDownQAM(struct drxk_state *state);
static int SetDVBTStandard (struct drxk_state *state,enum OperationMode oMode); static int SetDVBTStandard(struct drxk_state *state,
static int SetQAMStandard(struct drxk_state *state,enum OperationMode oMode); enum OperationMode oMode);
static int SetQAM(struct drxk_state *state,u16 IntermediateFreqkHz, static int SetQAMStandard(struct drxk_state *state,
enum OperationMode oMode);
static int SetQAM(struct drxk_state *state, u16 IntermediateFreqkHz,
s32 tunerFreqOffset); s32 tunerFreqOffset);
static int SetDVBTStandard (struct drxk_state *state,enum OperationMode oMode); static int SetDVBTStandard(struct drxk_state *state,
enum OperationMode oMode);
static int DVBTStart(struct drxk_state *state); static int DVBTStart(struct drxk_state *state);
static int SetDVBT (struct drxk_state *state,u16 IntermediateFreqkHz, static int SetDVBT(struct drxk_state *state, u16 IntermediateFreqkHz,
s32 tunerFreqOffset); s32 tunerFreqOffset);
static int GetQAMLockStatus(struct drxk_state *state, u32 *pLockStatus); static int GetQAMLockStatus(struct drxk_state *state, u32 *pLockStatus);
static int GetDVBTLockStatus(struct drxk_state *state, u32 *pLockStatus); static int GetDVBTLockStatus(struct drxk_state *state, u32 *pLockStatus);
...@@ -75,7 +78,7 @@ bool IsA1WithRomCode(struct drxk_state *state) ...@@ -75,7 +78,7 @@ bool IsA1WithRomCode(struct drxk_state *state)
#define NOA1ROM 0 #define NOA1ROM 0
#ifndef CHK_ERROR #ifndef CHK_ERROR
#define CHK_ERROR(s) if ((status = s) < 0) break #define CHK_ERROR(s) if ((status = s) < 0) break
#endif #endif
#define DRXDAP_FASI_SHORT_FORMAT(addr) (((addr) & 0xFC30FF80) == 0) #define DRXDAP_FASI_SHORT_FORMAT(addr) (((addr) & 0xFC30FF80) == 0)
...@@ -178,7 +181,7 @@ inline u32 MulDiv32(u32 a, u32 b, u32 c) ...@@ -178,7 +181,7 @@ inline u32 MulDiv32(u32 a, u32 b, u32 c)
{ {
u64 tmp64; u64 tmp64;
tmp64 = (u64)a * (u64)b; tmp64 = (u64) a * (u64) b;
do_div(tmp64, c); do_div(tmp64, c);
return (u32) tmp64; return (u32) tmp64;
...@@ -258,19 +261,19 @@ static u32 Log10Times100(u32 x) ...@@ -258,19 +261,19 @@ static u32 Log10Times100(u32 x)
if (x == 0) if (x == 0)
return (0); return 0;
/* Scale x (normalize) */ /* Scale x (normalize) */
/* computing y in log(x/y) = log(x) - log(y) */ /* computing y in log(x/y) = log(x) - log(y) */
if ((x & ((0xffffffff) << (scale + 1))) == 0) { if ((x & ((0xffffffff) << (scale + 1))) == 0) {
for (k = scale; k > 0; k--) { for (k = scale; k > 0; k--) {
if (x & (((u32)1) << scale)) if (x & (((u32) 1) << scale))
break; break;
x <<= 1; x <<= 1;
} }
} else { } else {
for (k = scale; k < 31 ; k++) { for (k = scale; k < 31; k++) {
if ((x & (((u32)(-1)) << (scale+1))) == 0) if ((x & (((u32) (-1)) << (scale + 1))) == 0)
break; break;
x >>= 1; x >>= 1;
} }
...@@ -280,14 +283,14 @@ static u32 Log10Times100(u32 x) ...@@ -280,14 +283,14 @@ static u32 Log10Times100(u32 x)
and 1.0 <= x < 2.0 */ and 1.0 <= x < 2.0 */
/* correction for divison: log(x) = log(x/y)+log(y) */ /* correction for divison: log(x) = log(x/y)+log(y) */
y = k * ((((u32)1) << scale) * 200); y = k * ((((u32) 1) << scale) * 200);
/* remove integer part */ /* remove integer part */
x &= ((((u32)1) << scale)-1); x &= ((((u32) 1) << scale) - 1);
/* get index */ /* get index */
i = (u8) (x >> (scale - indexWidth)); i = (u8) (x >> (scale - indexWidth));
/* compute delta (x - a) */ /* compute delta (x - a) */
d = x & ((((u32)1) << (scale - indexWidth)) - 1); d = x & ((((u32) 1) << (scale - indexWidth)) - 1);
/* compute log, multiplication (d* (..)) must be within range ! */ /* compute log, multiplication (d* (..)) must be within range ! */
y += log2lut[i] + y += log2lut[i] +
((d * (log2lut[i + 1] - log2lut[i])) >> (scale - indexWidth)); ((d * (log2lut[i + 1] - log2lut[i])) >> (scale - indexWidth));
...@@ -295,9 +298,9 @@ static u32 Log10Times100(u32 x) ...@@ -295,9 +298,9 @@ static u32 Log10Times100(u32 x)
y /= 108853; /* (log2(10) << scale) */ y /= 108853; /* (log2(10) << scale) */
r = (y >> 1); r = (y >> 1);
/* rounding */ /* rounding */
if (y & ((u32)1)) if (y & ((u32) 1))
r++; r++;
return (r); return r;
} }
/****************************************************************************/ /****************************************************************************/
...@@ -306,18 +309,19 @@ static u32 Log10Times100(u32 x) ...@@ -306,18 +309,19 @@ static u32 Log10Times100(u32 x)
static int i2c_read1(struct i2c_adapter *adapter, u8 adr, u8 *val) static int i2c_read1(struct i2c_adapter *adapter, u8 adr, u8 *val)
{ {
struct i2c_msg msgs[1] = {{.addr = adr, .flags = I2C_M_RD, struct i2c_msg msgs[1] = { {.addr = adr, .flags = I2C_M_RD,
.buf = val, .len = 1 }}; .buf = val, .len = 1}
};
return (i2c_transfer(adapter, msgs, 1) == 1) ? 0 : -1; return (i2c_transfer(adapter, msgs, 1) == 1) ? 0 : -1;
} }
static int i2c_write(struct i2c_adapter *adap, u8 adr, u8 *data, int len) static int i2c_write(struct i2c_adapter *adap, u8 adr, u8 *data, int len)
{ {
struct i2c_msg msg = struct i2c_msg msg = {
{.addr = adr, .flags = 0, .buf = data, .len = len}; .addr = adr, .flags = 0, .buf = data, .len = len };
if (i2c_transfer(adap, &msg, 1) != 1) { if (i2c_transfer(adap, &msg, 1) != 1) {
printk("i2c_write error\n"); printk(KERN_ERR "i2c_write error\n");
return -1; return -1;
} }
return 0; return 0;
...@@ -326,12 +330,13 @@ static int i2c_write(struct i2c_adapter *adap, u8 adr, u8 *data, int len) ...@@ -326,12 +330,13 @@ static int i2c_write(struct i2c_adapter *adap, u8 adr, u8 *data, int len)
static int i2c_read(struct i2c_adapter *adap, static int i2c_read(struct i2c_adapter *adap,
u8 adr, u8 *msg, int len, u8 *answ, int alen) u8 adr, u8 *msg, int len, u8 *answ, int alen)
{ {
struct i2c_msg msgs[2] = { { .addr = adr, .flags = 0, struct i2c_msg msgs[2] = { {.addr = adr, .flags = 0,
.buf = msg, .len = len}, .buf = msg, .len = len},
{ .addr = adr, .flags = I2C_M_RD, {.addr = adr, .flags = I2C_M_RD,
.buf = answ, .len = alen } }; .buf = answ, .len = alen}
};
if (i2c_transfer(adap, msgs, 2) != 2) { if (i2c_transfer(adap, msgs, 2) != 2) {
printk("i2c_read error\n"); printk(KERN_ERR "i2c_read error\n");
return -1; return -1;
} }
return 0; return 0;
...@@ -339,7 +344,7 @@ static int i2c_read(struct i2c_adapter *adap, ...@@ -339,7 +344,7 @@ static int i2c_read(struct i2c_adapter *adap,
static int Read16(struct drxk_state *state, u32 reg, u16 *data, u8 flags) static int Read16(struct drxk_state *state, u32 reg, u16 *data, u8 flags)
{ {
u8 adr=state->demod_address, mm1[4], mm2[2], len; u8 adr = state->demod_address, mm1[4], mm2[2], len;
#ifdef I2C_LONG_ADR #ifdef I2C_LONG_ADR
flags |= 0xC0; flags |= 0xC0;
#endif #endif
...@@ -409,7 +414,7 @@ static int Write16(struct drxk_state *state, u32 reg, u16 data, u8 flags) ...@@ -409,7 +414,7 @@ static int Write16(struct drxk_state *state, u32 reg, u16 data, u8 flags)
len = 2; len = 2;
} }
mm[len] = data & 0xff; mm[len] = data & 0xff;
mm[len+1] = (data >>8) & 0xff; mm[len + 1] = (data >> 8) & 0xff;
if (i2c_write(state->i2c, adr, mm, len + 2) < 0) if (i2c_write(state->i2c, adr, mm, len + 2) < 0)
return -1; return -1;
return 0; return 0;
...@@ -438,10 +443,10 @@ static int Write32(struct drxk_state *state, u32 reg, u32 data, u8 flags) ...@@ -438,10 +443,10 @@ static int Write32(struct drxk_state *state, u32 reg, u32 data, u8 flags)
len = 2; len = 2;
} }
mm[len] = data & 0xff; mm[len] = data & 0xff;
mm[len+1] = (data >> 8) & 0xff; mm[len + 1] = (data >> 8) & 0xff;
mm[len+2] = (data >> 16) & 0xff; mm[len + 2] = (data >> 16) & 0xff;
mm[len+3] = (data >> 24) & 0xff; mm[len + 3] = (data >> 24) & 0xff;
if (i2c_write(state->i2c, adr, mm, len+4) < 0) if (i2c_write(state->i2c, adr, mm, len + 4) < 0)
return -1; return -1;
return 0; return 0;
} }
...@@ -455,7 +460,7 @@ static int WriteBlock(struct drxk_state *state, u32 Address, ...@@ -455,7 +460,7 @@ static int WriteBlock(struct drxk_state *state, u32 Address,
#endif #endif
while (BlkSize > 0) { while (BlkSize > 0) {
int Chunk = BlkSize > state->m_ChunkSize ? int Chunk = BlkSize > state->m_ChunkSize ?
state->m_ChunkSize : BlkSize ; state->m_ChunkSize : BlkSize;
u8 *AdrBuf = &state->Chunk[0]; u8 *AdrBuf = &state->Chunk[0];
u32 AdrLength = 0; u32 AdrLength = 0;
...@@ -476,9 +481,9 @@ static int WriteBlock(struct drxk_state *state, u32 Address, ...@@ -476,9 +481,9 @@ static int WriteBlock(struct drxk_state *state, u32 Address,
} }
memcpy(&state->Chunk[AdrLength], pBlock, Chunk); memcpy(&state->Chunk[AdrLength], pBlock, Chunk);
status = i2c_write(state->i2c, state->demod_address, status = i2c_write(state->i2c, state->demod_address,
&state->Chunk[0], Chunk+AdrLength); &state->Chunk[0], Chunk + AdrLength);
if (status<0) { if (status < 0) {
printk("I2C Write error\n"); printk(KERN_ERR "I2C Write error\n");
break; break;
} }
pBlock += Chunk; pBlock += Chunk;
...@@ -499,14 +504,14 @@ int PowerUpDevice(struct drxk_state *state) ...@@ -499,14 +504,14 @@ int PowerUpDevice(struct drxk_state *state)
u16 retryCount = 0; u16 retryCount = 0;
status = i2c_read1(state->i2c, state->demod_address, &data); status = i2c_read1(state->i2c, state->demod_address, &data);
if (status<0) if (status < 0)
do { do {
data = 0; data = 0;
if (i2c_write(state->i2c, if (i2c_write(state->i2c,
state->demod_address, &data, 1) < 0) state->demod_address, &data, 1) < 0)
printk("powerup failed\n"); printk(KERN_ERR "powerup failed\n");
msleep(10); msleep(10);
retryCount++ ; retryCount++;
} while (i2c_read1(state->i2c, } while (i2c_read1(state->i2c,
state->demod_address, &data) < 0 && state->demod_address, &data) < 0 &&
(retryCount < DRXK_MAX_RETRIES_POWERUP)); (retryCount < DRXK_MAX_RETRIES_POWERUP));
...@@ -587,9 +592,9 @@ static int init_state(struct drxk_state *state) ...@@ -587,9 +592,9 @@ static int init_state(struct drxk_state *state)
u32 ulAntennaSwitchDVBTDVBC = 0; u32 ulAntennaSwitchDVBTDVBC = 0;
state->m_hasLNA = false; state->m_hasLNA = false;
state->m_hasDVBT= false; state->m_hasDVBT = false;
state->m_hasDVBC= false; state->m_hasDVBC = false;
state->m_hasATV= false; state->m_hasATV = false;
state->m_hasOOB = false; state->m_hasOOB = false;
state->m_hasAudio = false; state->m_hasAudio = false;
...@@ -687,7 +692,7 @@ static int init_state(struct drxk_state *state) ...@@ -687,7 +692,7 @@ static int init_state(struct drxk_state *state)
state->m_dvbtIfAgcCfg.speed = 3; state->m_dvbtIfAgcCfg.speed = 3;
state->m_dvbtIfAgcCfg.FastClipCtrlDelay = 30; state->m_dvbtIfAgcCfg.FastClipCtrlDelay = 30;
state->m_dvbtIfAgcCfg.IngainTgtMax = 30000; state->m_dvbtIfAgcCfg.IngainTgtMax = 30000;
// state->m_dvbtPgaCfg = 140; /* state->m_dvbtPgaCfg = 140; */
state->m_dvbtPreSawCfg.reference = 4; state->m_dvbtPreSawCfg.reference = 4;
state->m_dvbtPreSawCfg.usePreSaw = false; state->m_dvbtPreSawCfg.usePreSaw = false;
...@@ -728,11 +733,9 @@ static int init_state(struct drxk_state *state) ...@@ -728,11 +733,9 @@ static int init_state(struct drxk_state *state)
state->m_invertERR = false; /* If TRUE; invert ERR signal */ state->m_invertERR = false; /* If TRUE; invert ERR signal */
state->m_invertSTR = false; /* If TRUE; invert STR signals */ state->m_invertSTR = false; /* If TRUE; invert STR signals */
state->m_invertVAL = false; /* If TRUE; invert VAL signals */ state->m_invertVAL = false; /* If TRUE; invert VAL signals */
state->m_invertCLK = state->m_invertCLK = (ulInvertTSClock != 0); /* If TRUE; invert CLK signals */
(ulInvertTSClock != 0); /* If TRUE; invert CLK signals */
state->m_DVBTStaticCLK = (ulDVBTStaticTSClock != 0); state->m_DVBTStaticCLK = (ulDVBTStaticTSClock != 0);
state->m_DVBCStaticCLK = state->m_DVBCStaticCLK = (ulDVBCStaticTSClock != 0);
(ulDVBCStaticTSClock != 0);
/* If TRUE; static MPEG clockrate will be used; /* If TRUE; static MPEG clockrate will be used;
otherwise clockrate will adapt to the bitrate of the TS */ otherwise clockrate will adapt to the bitrate of the TS */
...@@ -756,10 +759,10 @@ static int init_state(struct drxk_state *state) ...@@ -756,10 +759,10 @@ static int init_state(struct drxk_state *state)
if (ulDemodLockTimeOut < 10000) if (ulDemodLockTimeOut < 10000)
state->m_DemodLockTimeOut = ulDemodLockTimeOut; state->m_DemodLockTimeOut = ulDemodLockTimeOut;
// QAM defaults /* QAM defaults */
state->m_Constellation = DRX_CONSTELLATION_AUTO; state->m_Constellation = DRX_CONSTELLATION_AUTO;
state->m_qamInterleaveMode = DRXK_QAM_I12_J17; state->m_qamInterleaveMode = DRXK_QAM_I12_J17;
state->m_fecRsPlen = 204*8; /* fecRsPlen annex A*/ state->m_fecRsPlen = 204 * 8; /* fecRsPlen annex A */
state->m_fecRsPrescale = 1; state->m_fecRsPrescale = 1;
state->m_sqiSpeed = DRXK_DVBT_SQI_SPEED_MEDIUM; state->m_sqiSpeed = DRXK_DVBT_SQI_SPEED_MEDIUM;
...@@ -801,7 +804,7 @@ static int DRXX_Open(struct drxk_state *state) ...@@ -801,7 +804,7 @@ static int DRXX_Open(struct drxk_state *state)
CHK_ERROR(Read32(state, SIO_TOP_JTAGID_LO__A, &jtag, 0)); CHK_ERROR(Read32(state, SIO_TOP_JTAGID_LO__A, &jtag, 0));
CHK_ERROR(Read16(state, SIO_PDR_UIO_IN_HI__A, &bid, 0)); CHK_ERROR(Read16(state, SIO_PDR_UIO_IN_HI__A, &bid, 0));
CHK_ERROR(Write16_0(state, SIO_TOP_COMM_KEY__A, key)); CHK_ERROR(Write16_0(state, SIO_TOP_COMM_KEY__A, key));
} while(0); } while (0);
return status; return status;
} }
...@@ -818,7 +821,8 @@ static int GetDeviceCapabilities(struct drxk_state *state) ...@@ -818,7 +821,8 @@ static int GetDeviceCapabilities(struct drxk_state *state)
SCU_RAM_GPIO_HW_LOCK_IND_DISABLE)); SCU_RAM_GPIO_HW_LOCK_IND_DISABLE));
CHK_ERROR(Write16_0(state, SIO_TOP_COMM_KEY__A, 0xFABA)); CHK_ERROR(Write16_0(state, SIO_TOP_COMM_KEY__A, 0xFABA));
CHK_ERROR(Read16(state, SIO_PDR_OHW_CFG__A, &sioPdrOhwCfg, 0)); CHK_ERROR(Read16
(state, SIO_PDR_OHW_CFG__A, &sioPdrOhwCfg, 0));
CHK_ERROR(Write16_0(state, SIO_TOP_COMM_KEY__A, 0x0000)); CHK_ERROR(Write16_0(state, SIO_TOP_COMM_KEY__A, 0x0000));
switch ((sioPdrOhwCfg & SIO_PDR_OHW_CFG_FREF_SEL__M)) { switch ((sioPdrOhwCfg & SIO_PDR_OHW_CFG_FREF_SEL__M)) {
...@@ -847,7 +851,7 @@ static int GetDeviceCapabilities(struct drxk_state *state) ...@@ -847,7 +851,7 @@ static int GetDeviceCapabilities(struct drxk_state *state)
CHK_ERROR(Read32(state, SIO_TOP_JTAGID_LO__A, CHK_ERROR(Read32(state, SIO_TOP_JTAGID_LO__A,
&sioTopJtagidLo, 0)); &sioTopJtagidLo, 0));
/* driver 0.9.0 */ /* driver 0.9.0 */
switch((sioTopJtagidLo >> 29) & 0xF) { switch ((sioTopJtagidLo >> 29) & 0xF) {
case 0: case 0:
state->m_deviceSpin = DRXK_SPIN_A1; state->m_deviceSpin = DRXK_SPIN_A1;
break; break;
...@@ -862,7 +866,7 @@ static int GetDeviceCapabilities(struct drxk_state *state) ...@@ -862,7 +866,7 @@ static int GetDeviceCapabilities(struct drxk_state *state)
status = -1; status = -1;
break; break;
} }
switch ((sioTopJtagidLo>>12)&0xFF) { switch ((sioTopJtagidLo >> 12) & 0xFF) {
case 0x13: case 0x13:
/* typeId = DRX3913K_TYPE_ID */ /* typeId = DRX3913K_TYPE_ID */
state->m_hasLNA = false; state->m_hasLNA = false;
...@@ -968,12 +972,12 @@ static int GetDeviceCapabilities(struct drxk_state *state) ...@@ -968,12 +972,12 @@ static int GetDeviceCapabilities(struct drxk_state *state)
state->m_hasIRQN = false; state->m_hasIRQN = false;
break; break;
default: default:
printk("DeviceID not supported = %02x\n", printk(KERN_ERR "DeviceID not supported = %02x\n",
((sioTopJtagidLo>>12)&0xFF)); ((sioTopJtagidLo >> 12) & 0xFF));
status = -1; status = -1;
break; break;
} }
} while(0); } while (0);
return status; return status;
} }
...@@ -982,8 +986,6 @@ static int HI_Command(struct drxk_state *state, u16 cmd, u16 *pResult) ...@@ -982,8 +986,6 @@ static int HI_Command(struct drxk_state *state, u16 cmd, u16 *pResult)
int status; int status;
bool powerdown_cmd; bool powerdown_cmd;
//printk("%s\n", __FUNCTION__);
/* Write command */ /* Write command */
status = Write16_0(state, SIO_HI_RA_RAM_CMD__A, cmd); status = Write16_0(state, SIO_HI_RA_RAM_CMD__A, cmd);
if (status < 0) if (status < 0)
...@@ -1006,8 +1008,8 @@ static int HI_Command(struct drxk_state *state, u16 cmd, u16 *pResult) ...@@ -1006,8 +1008,8 @@ static int HI_Command(struct drxk_state *state, u16 cmd, u16 *pResult)
retryCount += 1; retryCount += 1;
status = Read16(state, SIO_HI_RA_RAM_CMD__A, status = Read16(state, SIO_HI_RA_RAM_CMD__A,
&waitCmd, 0); &waitCmd, 0);
} while ((status < 0) && } while ((status < 0) && (retryCount < DRXK_MAX_RETRIES)
(retryCount < DRXK_MAX_RETRIES) && (waitCmd != 0)); && (waitCmd != 0));
if (status == 0) if (status == 0)
status = Read16(state, SIO_HI_RA_RAM_RES__A, status = Read16(state, SIO_HI_RA_RAM_RES__A,
...@@ -1022,29 +1024,29 @@ static int HI_CfgCommand(struct drxk_state *state) ...@@ -1022,29 +1024,29 @@ static int HI_CfgCommand(struct drxk_state *state)
mutex_lock(&state->mutex); mutex_lock(&state->mutex);
do { do {
CHK_ERROR(Write16_0(state,SIO_HI_RA_RAM_PAR_6__A, CHK_ERROR(Write16_0(state, SIO_HI_RA_RAM_PAR_6__A,
state->m_HICfgTimeout)); state->m_HICfgTimeout));
CHK_ERROR(Write16_0(state,SIO_HI_RA_RAM_PAR_5__A, CHK_ERROR(Write16_0(state, SIO_HI_RA_RAM_PAR_5__A,
state->m_HICfgCtrl)); state->m_HICfgCtrl));
CHK_ERROR(Write16_0(state,SIO_HI_RA_RAM_PAR_4__A, CHK_ERROR(Write16_0(state, SIO_HI_RA_RAM_PAR_4__A,
state->m_HICfgWakeUpKey)); state->m_HICfgWakeUpKey));
CHK_ERROR(Write16_0(state,SIO_HI_RA_RAM_PAR_3__A, CHK_ERROR(Write16_0(state, SIO_HI_RA_RAM_PAR_3__A,
state->m_HICfgBridgeDelay)); state->m_HICfgBridgeDelay));
CHK_ERROR(Write16_0(state,SIO_HI_RA_RAM_PAR_2__A, CHK_ERROR(Write16_0(state, SIO_HI_RA_RAM_PAR_2__A,
state->m_HICfgTimingDiv)); state->m_HICfgTimingDiv));
CHK_ERROR(Write16_0(state,SIO_HI_RA_RAM_PAR_1__A, CHK_ERROR(Write16_0(state, SIO_HI_RA_RAM_PAR_1__A,
SIO_HI_RA_RAM_PAR_1_PAR1_SEC_KEY)); SIO_HI_RA_RAM_PAR_1_PAR1_SEC_KEY));
CHK_ERROR(HI_Command(state, SIO_HI_RA_RAM_CMD_CONFIG, 0)); CHK_ERROR(HI_Command(state, SIO_HI_RA_RAM_CMD_CONFIG, 0));
state->m_HICfgCtrl &= ~SIO_HI_RA_RAM_PAR_5_CFG_SLEEP_ZZZ; state->m_HICfgCtrl &= ~SIO_HI_RA_RAM_PAR_5_CFG_SLEEP_ZZZ;
} while(0); } while (0);
mutex_unlock(&state->mutex); mutex_unlock(&state->mutex);
return status; return status;
} }
static int InitHI(struct drxk_state *state) static int InitHI(struct drxk_state *state)
{ {
state->m_HICfgWakeUpKey = (state->demod_address<<1); state->m_HICfgWakeUpKey = (state->demod_address << 1);
state->m_HICfgTimeout = 0x96FF; state->m_HICfgTimeout = 0x96FF;
/* port/bridge/power down ctrl */ /* port/bridge/power down ctrl */
state->m_HICfgCtrl = SIO_HI_RA_RAM_PAR_5_CFG_SLV0_SLAVE; state->m_HICfgCtrl = SIO_HI_RA_RAM_PAR_5_CFG_SLV0_SLAVE;
...@@ -1075,62 +1077,83 @@ static int MPEGTSConfigurePins(struct drxk_state *state, bool mpegEnable) ...@@ -1075,62 +1077,83 @@ static int MPEGTSConfigurePins(struct drxk_state *state, bool mpegEnable)
SIO_PDR_MCLK_CFG__A, 0x0000)); SIO_PDR_MCLK_CFG__A, 0x0000));
CHK_ERROR(Write16_0(state, CHK_ERROR(Write16_0(state,
SIO_PDR_MVAL_CFG__A, 0x0000)); SIO_PDR_MVAL_CFG__A, 0x0000));
CHK_ERROR(Write16_0(state, SIO_PDR_MD0_CFG__A, 0x0000)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SIO_PDR_MD1_CFG__A, 0x0000)); (state, SIO_PDR_MD0_CFG__A, 0x0000));
CHK_ERROR(Write16_0(state, SIO_PDR_MD2_CFG__A, 0x0000)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SIO_PDR_MD3_CFG__A, 0x0000)); (state, SIO_PDR_MD1_CFG__A, 0x0000));
CHK_ERROR(Write16_0(state, SIO_PDR_MD4_CFG__A, 0x0000)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SIO_PDR_MD5_CFG__A, 0x0000)); (state, SIO_PDR_MD2_CFG__A, 0x0000));
CHK_ERROR(Write16_0(state, SIO_PDR_MD6_CFG__A, 0x0000)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SIO_PDR_MD7_CFG__A, 0x0000)); (state, SIO_PDR_MD3_CFG__A, 0x0000));
CHK_ERROR(Write16_0
(state, SIO_PDR_MD4_CFG__A, 0x0000));
CHK_ERROR(Write16_0
(state, SIO_PDR_MD5_CFG__A, 0x0000));
CHK_ERROR(Write16_0
(state, SIO_PDR_MD6_CFG__A, 0x0000));
CHK_ERROR(Write16_0
(state, SIO_PDR_MD7_CFG__A, 0x0000));
} else { } else {
/* Enable MPEG output */ /* Enable MPEG output */
sioPdrMdxCfg = sioPdrMdxCfg =
((state->m_TSDataStrength << ((state->m_TSDataStrength <<
SIO_PDR_MD0_CFG_DRIVE__B) | 0x0003); SIO_PDR_MD0_CFG_DRIVE__B) | 0x0003);
sioPdrMclkCfg = ((state->m_TSClockkStrength << sioPdrMclkCfg = ((state->m_TSClockkStrength <<
SIO_PDR_MCLK_CFG_DRIVE__B) | 0x0003); SIO_PDR_MCLK_CFG_DRIVE__B) |
0x0003);
CHK_ERROR(Write16_0(state, SIO_PDR_MSTRT_CFG__A, CHK_ERROR(Write16_0(state, SIO_PDR_MSTRT_CFG__A,
sioPdrMdxCfg)); sioPdrMdxCfg));
CHK_ERROR(Write16_0(state, SIO_PDR_MERR_CFG__A, CHK_ERROR(Write16_0(state, SIO_PDR_MERR_CFG__A, 0x0000)); /* Disable */
0x0000)); // Disable CHK_ERROR(Write16_0(state, SIO_PDR_MVAL_CFG__A, 0x0000)); /* Disable */
CHK_ERROR(Write16_0(state, SIO_PDR_MVAL_CFG__A,
0x0000)); // Disable
if (state->m_enableParallel == true) { if (state->m_enableParallel == true) {
/* paralel -> enable MD1 to MD7 */ /* paralel -> enable MD1 to MD7 */
CHK_ERROR(Write16_0(state, SIO_PDR_MD1_CFG__A, CHK_ERROR(Write16_0
(state, SIO_PDR_MD1_CFG__A,
sioPdrMdxCfg)); sioPdrMdxCfg));
CHK_ERROR(Write16_0(state, SIO_PDR_MD2_CFG__A, CHK_ERROR(Write16_0
(state, SIO_PDR_MD2_CFG__A,
sioPdrMdxCfg)); sioPdrMdxCfg));
CHK_ERROR(Write16_0(state, SIO_PDR_MD3_CFG__A, CHK_ERROR(Write16_0
(state, SIO_PDR_MD3_CFG__A,
sioPdrMdxCfg)); sioPdrMdxCfg));
CHK_ERROR(Write16_0(state, SIO_PDR_MD4_CFG__A, CHK_ERROR(Write16_0
(state, SIO_PDR_MD4_CFG__A,
sioPdrMdxCfg)); sioPdrMdxCfg));
CHK_ERROR(Write16_0(state, SIO_PDR_MD5_CFG__A, CHK_ERROR(Write16_0
(state, SIO_PDR_MD5_CFG__A,
sioPdrMdxCfg)); sioPdrMdxCfg));
CHK_ERROR(Write16_0(state, SIO_PDR_MD6_CFG__A, CHK_ERROR(Write16_0
(state, SIO_PDR_MD6_CFG__A,
sioPdrMdxCfg)); sioPdrMdxCfg));
CHK_ERROR(Write16_0(state, SIO_PDR_MD7_CFG__A, CHK_ERROR(Write16_0
(state, SIO_PDR_MD7_CFG__A,
sioPdrMdxCfg)); sioPdrMdxCfg));
} else { } else {
sioPdrMdxCfg = ((state->m_TSDataStrength << sioPdrMdxCfg = ((state->m_TSDataStrength <<
SIO_PDR_MD0_CFG_DRIVE__B) | SIO_PDR_MD0_CFG_DRIVE__B)
0x0003); | 0x0003);
/* serial -> disable MD1 to MD7 */ /* serial -> disable MD1 to MD7 */
CHK_ERROR(Write16_0(state, SIO_PDR_MD1_CFG__A, CHK_ERROR(Write16_0
(state, SIO_PDR_MD1_CFG__A,
0x0000)); 0x0000));
CHK_ERROR(Write16_0(state, SIO_PDR_MD2_CFG__A, CHK_ERROR(Write16_0
(state, SIO_PDR_MD2_CFG__A,
0x0000)); 0x0000));
CHK_ERROR(Write16_0(state, SIO_PDR_MD3_CFG__A, CHK_ERROR(Write16_0
(state, SIO_PDR_MD3_CFG__A,
0x0000)); 0x0000));
CHK_ERROR(Write16_0(state, SIO_PDR_MD4_CFG__A, CHK_ERROR(Write16_0
(state, SIO_PDR_MD4_CFG__A,
0x0000)); 0x0000));
CHK_ERROR(Write16_0(state, SIO_PDR_MD5_CFG__A, CHK_ERROR(Write16_0
(state, SIO_PDR_MD5_CFG__A,
0x0000)); 0x0000));
CHK_ERROR(Write16_0(state, SIO_PDR_MD6_CFG__A, CHK_ERROR(Write16_0
(state, SIO_PDR_MD6_CFG__A,
0x0000)); 0x0000));
CHK_ERROR(Write16_0(state, SIO_PDR_MD7_CFG__A, CHK_ERROR(Write16_0
(state, SIO_PDR_MD7_CFG__A,
0x0000)); 0x0000));
} }
CHK_ERROR(Write16_0(state, SIO_PDR_MCLK_CFG__A, CHK_ERROR(Write16_0(state, SIO_PDR_MCLK_CFG__A,
...@@ -1142,7 +1165,7 @@ static int MPEGTSConfigurePins(struct drxk_state *state, bool mpegEnable) ...@@ -1142,7 +1165,7 @@ static int MPEGTSConfigurePins(struct drxk_state *state, bool mpegEnable)
CHK_ERROR(Write16_0(state, SIO_PDR_MON_CFG__A, 0x0000)); CHK_ERROR(Write16_0(state, SIO_PDR_MON_CFG__A, 0x0000));
/* Write nomagic word to enable pdr reg write */ /* Write nomagic word to enable pdr reg write */
CHK_ERROR(Write16_0(state, SIO_TOP_COMM_KEY__A, 0x0000)); CHK_ERROR(Write16_0(state, SIO_TOP_COMM_KEY__A, 0x0000));
} while(0); } while (0);
return status; return status;
} }
...@@ -1168,7 +1191,7 @@ static int BLChainCmd(struct drxk_state *state, ...@@ -1168,7 +1191,7 @@ static int BLChainCmd(struct drxk_state *state,
nrOfElements)); nrOfElements));
CHK_ERROR(Write16_0(state, SIO_BL_ENABLE__A, CHK_ERROR(Write16_0(state, SIO_BL_ENABLE__A,
SIO_BL_ENABLE_ON)); SIO_BL_ENABLE_ON));
end=jiffies+msecs_to_jiffies(timeOut); end = jiffies + msecs_to_jiffies(timeOut);
do { do {
msleep(1); msleep(1);
...@@ -1177,19 +1200,18 @@ static int BLChainCmd(struct drxk_state *state, ...@@ -1177,19 +1200,18 @@ static int BLChainCmd(struct drxk_state *state,
} while ((blStatus == 0x1) && } while ((blStatus == 0x1) &&
((time_is_after_jiffies(end)))); ((time_is_after_jiffies(end))));
if (blStatus == 0x1) { if (blStatus == 0x1) {
printk("SIO not ready\n"); printk(KERN_ERR "SIO not ready\n");
mutex_unlock(&state->mutex); mutex_unlock(&state->mutex);
return -1; return -1;
} }
} while(0); } while (0);
mutex_unlock(&state->mutex); mutex_unlock(&state->mutex);
return status; return status;
} }
static int DownloadMicrocode(struct drxk_state *state, static int DownloadMicrocode(struct drxk_state *state,
const u8 pMCImage[], const u8 pMCImage[], u32 Length)
u32 Length)
{ {
const u8 *pSrc = pMCImage; const u8 *pSrc = pMCImage;
u16 Flags; u16 Flags;
...@@ -1204,25 +1226,31 @@ static int DownloadMicrocode(struct drxk_state *state, ...@@ -1204,25 +1226,31 @@ static int DownloadMicrocode(struct drxk_state *state,
/* down the drain (we don care about MAGIC_WORD) */ /* down the drain (we don care about MAGIC_WORD) */
Drain = (pSrc[0] << 8) | pSrc[1]; Drain = (pSrc[0] << 8) | pSrc[1];
pSrc += sizeof(u16); offset += sizeof(u16); pSrc += sizeof(u16);
offset += sizeof(u16);
nBlocks = (pSrc[0] << 8) | pSrc[1]; nBlocks = (pSrc[0] << 8) | pSrc[1];
pSrc += sizeof(u16); offset += sizeof(u16); pSrc += sizeof(u16);
offset += sizeof(u16);
for (i = 0; i < nBlocks; i += 1) { for (i = 0; i < nBlocks; i += 1) {
Address = (pSrc[0] << 24) | (pSrc[1] << 16) | Address = (pSrc[0] << 24) | (pSrc[1] << 16) |
(pSrc[2] << 8) | pSrc[3]; (pSrc[2] << 8) | pSrc[3];
pSrc += sizeof(u32); offset += sizeof(u32); pSrc += sizeof(u32);
offset += sizeof(u32);
BlockSize = ((pSrc[0] << 8) | pSrc[1]) * sizeof(u16); BlockSize = ((pSrc[0] << 8) | pSrc[1]) * sizeof(u16);
pSrc += sizeof(u16); offset += sizeof(u16); pSrc += sizeof(u16);
offset += sizeof(u16);
Flags = (pSrc[0] << 8) | pSrc[1]; Flags = (pSrc[0] << 8) | pSrc[1];
pSrc += sizeof(u16); offset += sizeof(u16); pSrc += sizeof(u16);
offset += sizeof(u16);
BlockCRC = (pSrc[0] << 8) | pSrc[1]; BlockCRC = (pSrc[0] << 8) | pSrc[1];
pSrc += sizeof(u16); offset += sizeof(u16); pSrc += sizeof(u16);
offset += sizeof(u16);
status = WriteBlock(state, Address, BlockSize, pSrc, 0); status = WriteBlock(state, Address, BlockSize, pSrc, 0);
if (status<0) if (status < 0)
break; break;
pSrc += BlockSize; pSrc += BlockSize;
offset += BlockSize; offset += BlockSize;
...@@ -1250,15 +1278,16 @@ static int DVBTEnableOFDMTokenRing(struct drxk_state *state, bool enable) ...@@ -1250,15 +1278,16 @@ static int DVBTEnableOFDMTokenRing(struct drxk_state *state, bool enable)
return status; return status;
} }
/* Disable/enable dvbt tokenring bridge */ /* Disable/enable dvbt tokenring bridge */
status = Write16_0(state,SIO_OFDM_SH_OFDM_RING_ENABLE__A, desiredCtrl); status =
Write16_0(state, SIO_OFDM_SH_OFDM_RING_ENABLE__A, desiredCtrl);
end=jiffies+msecs_to_jiffies(DRXK_OFDM_TR_SHUTDOWN_TIMEOUT); end = jiffies + msecs_to_jiffies(DRXK_OFDM_TR_SHUTDOWN_TIMEOUT);
do do
CHK_ERROR(Read16_0(state, SIO_OFDM_SH_OFDM_RING_STATUS__A, &data)); CHK_ERROR(Read16_0
while ((data != desiredStatus) && (state, SIO_OFDM_SH_OFDM_RING_STATUS__A, &data));
((time_is_after_jiffies(end)))); while ((data != desiredStatus) && ((time_is_after_jiffies(end))));
if (data != desiredStatus) { if (data != desiredStatus) {
printk("SIO not ready\n"); printk(KERN_ERR "SIO not ready\n");
return -1; return -1;
} }
return status; return status;
...@@ -1272,21 +1301,25 @@ static int MPEGTSStop(struct drxk_state *state) ...@@ -1272,21 +1301,25 @@ static int MPEGTSStop(struct drxk_state *state)
do { do {
/* Gracefull shutdown (byte boundaries) */ /* Gracefull shutdown (byte boundaries) */
CHK_ERROR(Read16_0(state, FEC_OC_SNC_MODE__A, &fecOcSncMode)); CHK_ERROR(Read16_0
(state, FEC_OC_SNC_MODE__A, &fecOcSncMode));
fecOcSncMode |= FEC_OC_SNC_MODE_SHUTDOWN__M; fecOcSncMode |= FEC_OC_SNC_MODE_SHUTDOWN__M;
CHK_ERROR(Write16_0(state, FEC_OC_SNC_MODE__A, fecOcSncMode)); CHK_ERROR(Write16_0
(state, FEC_OC_SNC_MODE__A, fecOcSncMode));
/* Suppress MCLK during absence of data */ /* Suppress MCLK during absence of data */
CHK_ERROR(Read16_0(state, FEC_OC_IPR_MODE__A, &fecOcIprMode)); CHK_ERROR(Read16_0
(state, FEC_OC_IPR_MODE__A, &fecOcIprMode));
fecOcIprMode |= FEC_OC_IPR_MODE_MCLK_DIS_DAT_ABS__M; fecOcIprMode |= FEC_OC_IPR_MODE_MCLK_DIS_DAT_ABS__M;
CHK_ERROR(Write16_0(state, FEC_OC_IPR_MODE__A, fecOcIprMode)); CHK_ERROR(Write16_0
(state, FEC_OC_IPR_MODE__A, fecOcIprMode));
} while (0); } while (0);
return status; return status;
} }
static int scu_command(struct drxk_state *state, static int scu_command(struct drxk_state *state,
u16 cmd, u8 parameterLen, u16 cmd, u8 parameterLen,
u16 * parameter, u8 resultLen, u16 * result) u16 *parameter, u8 resultLen, u16 *result)
{ {
#if (SCU_RAM_PARAM_0__A - SCU_RAM_PARAM_15__A) != 15 #if (SCU_RAM_PARAM_0__A - SCU_RAM_PARAM_15__A) != 15
#error DRXK register mapping no longer compatible with this routine! #error DRXK register mapping no longer compatible with this routine!
...@@ -1306,7 +1339,7 @@ static int scu_command(struct drxk_state *state, ...@@ -1306,7 +1339,7 @@ static int scu_command(struct drxk_state *state,
u8 buffer[34]; u8 buffer[34];
int cnt = 0, ii; int cnt = 0, ii;
for (ii=parameterLen-1; ii >= 0; ii -= 1) { for (ii = parameterLen - 1; ii >= 0; ii -= 1) {
buffer[cnt++] = (parameter[ii] & 0xFF); buffer[cnt++] = (parameter[ii] & 0xFF);
buffer[cnt++] = ((parameter[ii] >> 8) & 0xFF); buffer[cnt++] = ((parameter[ii] >> 8) & 0xFF);
} }
...@@ -1314,16 +1347,17 @@ static int scu_command(struct drxk_state *state, ...@@ -1314,16 +1347,17 @@ static int scu_command(struct drxk_state *state,
buffer[cnt++] = ((cmd >> 8) & 0xFF); buffer[cnt++] = ((cmd >> 8) & 0xFF);
WriteBlock(state, SCU_RAM_PARAM_0__A - WriteBlock(state, SCU_RAM_PARAM_0__A -
(parameterLen-1), cnt, buffer, 0x00); (parameterLen - 1), cnt, buffer, 0x00);
/* Wait until SCU has processed command */ /* Wait until SCU has processed command */
end=jiffies+msecs_to_jiffies(DRXK_MAX_WAITTIME); end = jiffies + msecs_to_jiffies(DRXK_MAX_WAITTIME);
do { do {
msleep(1); msleep(1);
CHK_ERROR(Read16_0(state, SCU_RAM_COMMAND__A, &curCmd)); CHK_ERROR(Read16_0
} while (! (curCmd == DRX_SCU_READY) && (state, SCU_RAM_COMMAND__A, &curCmd));
(time_is_after_jiffies(end))); } while (!(curCmd == DRX_SCU_READY)
&& (time_is_after_jiffies(end)));
if (curCmd != DRX_SCU_READY) { if (curCmd != DRX_SCU_READY) {
printk("SCU not ready\n"); printk(KERN_ERR "SCU not ready\n");
mutex_unlock(&state->mutex); mutex_unlock(&state->mutex);
return -1; return -1;
} }
...@@ -1332,39 +1366,37 @@ static int scu_command(struct drxk_state *state, ...@@ -1332,39 +1366,37 @@ static int scu_command(struct drxk_state *state,
s16 err; s16 err;
int ii; int ii;
for(ii=resultLen-1; ii >= 0; ii -= 1) { for (ii = resultLen - 1; ii >= 0; ii -= 1) {
CHK_ERROR(Read16_0(state, CHK_ERROR(Read16_0(state,
SCU_RAM_PARAM_0__A - ii, SCU_RAM_PARAM_0__A - ii,
&result[ii])); &result[ii]));
} }
/* Check if an error was reported by SCU */ /* Check if an error was reported by SCU */
err = (s16)result[0]; err = (s16) result[0];
/* check a few fixed error codes */ /* check a few fixed error codes */
if (err == SCU_RESULT_UNKSTD) { if (err == SCU_RESULT_UNKSTD) {
printk("SCU_RESULT_UNKSTD\n"); printk(KERN_ERR "SCU_RESULT_UNKSTD\n");
mutex_unlock(&state->mutex); mutex_unlock(&state->mutex);
return -1; return -1;
} else if (err == SCU_RESULT_UNKCMD) { } else if (err == SCU_RESULT_UNKCMD) {
printk("SCU_RESULT_UNKCMD\n"); printk(KERN_ERR "SCU_RESULT_UNKCMD\n");
mutex_unlock(&state->mutex); mutex_unlock(&state->mutex);
return -1; return -1;
} }
/* here it is assumed that negative means error, /* here it is assumed that negative means error,
and positive no error */ and positive no error */
else if (err < 0) { else if (err < 0) {
printk("%s ERROR\n", __FUNCTION__); printk(KERN_ERR "%s ERROR\n", __func__);
mutex_unlock(&state->mutex); mutex_unlock(&state->mutex);
return -1; return -1;
} }
} }
} while(0); } while (0);
mutex_unlock(&state->mutex); mutex_unlock(&state->mutex);
if (status<0) if (status < 0)
{ printk(KERN_ERR "%s: status = %d\n", __func__, status);
printk("%s: status = %d\n", __FUNCTION__, status);
}
return status; return status;
} }
...@@ -1374,48 +1406,34 @@ static int SetIqmAf(struct drxk_state *state, bool active) ...@@ -1374,48 +1406,34 @@ static int SetIqmAf(struct drxk_state *state, bool active)
u16 data = 0; u16 data = 0;
int status; int status;
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ "(%d)\n",active)); do {
//printk("%s\n", __FUNCTION__);
do
{
/* Configure IQM */ /* Configure IQM */
CHK_ERROR(Read16_0(state, IQM_AF_STDBY__A , &data));; CHK_ERROR(Read16_0(state, IQM_AF_STDBY__A, &data));
if (!active) { if (!active) {
data |= (IQM_AF_STDBY_STDBY_ADC_STANDBY data |= (IQM_AF_STDBY_STDBY_ADC_STANDBY
| IQM_AF_STDBY_STDBY_AMP_STANDBY | IQM_AF_STDBY_STDBY_AMP_STANDBY
| IQM_AF_STDBY_STDBY_PD_STANDBY | IQM_AF_STDBY_STDBY_PD_STANDBY
| IQM_AF_STDBY_STDBY_TAGC_IF_STANDBY | IQM_AF_STDBY_STDBY_TAGC_IF_STANDBY
| IQM_AF_STDBY_STDBY_TAGC_RF_STANDBY | IQM_AF_STDBY_STDBY_TAGC_RF_STANDBY);
); } else { /* active */
// break;
//default:
// break;
//}
} else /* active */ {
data &= ((~IQM_AF_STDBY_STDBY_ADC_STANDBY) data &= ((~IQM_AF_STDBY_STDBY_ADC_STANDBY)
& (~IQM_AF_STDBY_STDBY_AMP_STANDBY) & (~IQM_AF_STDBY_STDBY_AMP_STANDBY)
& (~IQM_AF_STDBY_STDBY_PD_STANDBY) & (~IQM_AF_STDBY_STDBY_PD_STANDBY)
& (~IQM_AF_STDBY_STDBY_TAGC_IF_STANDBY) & (~IQM_AF_STDBY_STDBY_TAGC_IF_STANDBY)
& (~IQM_AF_STDBY_STDBY_TAGC_RF_STANDBY) & (~IQM_AF_STDBY_STDBY_TAGC_RF_STANDBY)
); );
// break;
//default:
// break;
//}
} }
CHK_ERROR(Write16_0(state, IQM_AF_STDBY__A , data)); CHK_ERROR(Write16_0(state, IQM_AF_STDBY__A, data));
}while(0); } while (0);
return status; return status;
} }
static int CtrlPowerMode(struct drxk_state *state, static int CtrlPowerMode(struct drxk_state *state, enum DRXPowerMode *mode)
pDRXPowerMode_t mode)
{ {
int status = 0; int status = 0;
u16 sioCcPwdMode = 0; u16 sioCcPwdMode = 0;
//printk("%s\n", __FUNCTION__);
/* Check arguments */ /* Check arguments */
if (mode == NULL) if (mode == NULL)
return -1; return -1;
...@@ -1447,12 +1465,11 @@ static int CtrlPowerMode(struct drxk_state *state, ...@@ -1447,12 +1465,11 @@ static int CtrlPowerMode(struct drxk_state *state,
return 0; return 0;
/* For next steps make sure to start from DRX_POWER_UP mode */ /* For next steps make sure to start from DRX_POWER_UP mode */
if (state->m_currentPowerMode != DRX_POWER_UP) if (state->m_currentPowerMode != DRX_POWER_UP) {
{
do { do {
CHK_ERROR(PowerUpDevice(state)); CHK_ERROR(PowerUpDevice(state));
CHK_ERROR(DVBTEnableOFDMTokenRing(state, true)); CHK_ERROR(DVBTEnableOFDMTokenRing(state, true));
} while(0); } while (0);
} }
if (*mode == DRX_POWER_UP) { if (*mode == DRX_POWER_UP) {
...@@ -1492,15 +1509,15 @@ static int CtrlPowerMode(struct drxk_state *state, ...@@ -1492,15 +1509,15 @@ static int CtrlPowerMode(struct drxk_state *state,
SIO_HI_RA_RAM_PAR_5_CFG_SLEEP_ZZZ; SIO_HI_RA_RAM_PAR_5_CFG_SLEEP_ZZZ;
CHK_ERROR(HI_CfgCommand(state)); CHK_ERROR(HI_CfgCommand(state));
} }
} while(0); } while (0);
} }
state->m_currentPowerMode = *mode; state->m_currentPowerMode = *mode;
return (status); return status;
} }
static int PowerDownDVBT(struct drxk_state *state, bool setPowerMode) static int PowerDownDVBT(struct drxk_state *state, bool setPowerMode)
{ {
DRXPowerMode_t powerMode = DRXK_POWER_DOWN_OFDM; enum DRXPowerMode powerMode = DRXK_POWER_DOWN_OFDM;
u16 cmdResult = 0; u16 cmdResult = 0;
u16 data = 0; u16 data = 0;
int status; int status;
...@@ -1510,12 +1527,14 @@ static int PowerDownDVBT(struct drxk_state *state, bool setPowerMode) ...@@ -1510,12 +1527,14 @@ static int PowerDownDVBT(struct drxk_state *state, bool setPowerMode)
if (data == SCU_COMM_EXEC_ACTIVE) { if (data == SCU_COMM_EXEC_ACTIVE) {
/* Send OFDM stop command */ /* Send OFDM stop command */
CHK_ERROR(scu_command(state, CHK_ERROR(scu_command(state,
SCU_RAM_COMMAND_STANDARD_OFDM | SCU_RAM_COMMAND_STANDARD_OFDM
|
SCU_RAM_COMMAND_CMD_DEMOD_STOP, SCU_RAM_COMMAND_CMD_DEMOD_STOP,
0, NULL, 1, &cmdResult)); 0, NULL, 1, &cmdResult));
/* Send OFDM reset command */ /* Send OFDM reset command */
CHK_ERROR(scu_command(state, CHK_ERROR(scu_command(state,
SCU_RAM_COMMAND_STANDARD_OFDM | SCU_RAM_COMMAND_STANDARD_OFDM
|
SCU_RAM_COMMAND_CMD_DEMOD_RESET, SCU_RAM_COMMAND_CMD_DEMOD_RESET,
0, NULL, 1, &cmdResult)); 0, NULL, 1, &cmdResult));
} }
...@@ -1529,17 +1548,18 @@ static int PowerDownDVBT(struct drxk_state *state, bool setPowerMode) ...@@ -1529,17 +1548,18 @@ static int PowerDownDVBT(struct drxk_state *state, bool setPowerMode)
IQM_COMM_EXEC_B_STOP)); IQM_COMM_EXEC_B_STOP));
/* powerdown AFE */ /* powerdown AFE */
CHK_ERROR(SetIqmAf(state,false)); CHK_ERROR(SetIqmAf(state, false));
/* powerdown to OFDM mode */ /* powerdown to OFDM mode */
if (setPowerMode) { if (setPowerMode) {
CHK_ERROR(CtrlPowerMode(state,&powerMode)); CHK_ERROR(CtrlPowerMode(state, &powerMode));
} }
} while(0); } while (0);
return status; return status;
} }
static int SetOperationMode(struct drxk_state *state, enum OperationMode oMode) static int SetOperationMode(struct drxk_state *state,
enum OperationMode oMode)
{ {
int status = 0; int status = 0;
...@@ -1550,17 +1570,17 @@ static int SetOperationMode(struct drxk_state *state, enum OperationMode oMode) ...@@ -1550,17 +1570,17 @@ static int SetOperationMode(struct drxk_state *state, enum OperationMode oMode)
*/ */
do { do {
/* disable HW lock indicator */ /* disable HW lock indicator */
CHK_ERROR (Write16_0(state, SCU_RAM_GPIO__A, CHK_ERROR(Write16_0(state, SCU_RAM_GPIO__A,
SCU_RAM_GPIO_HW_LOCK_IND_DISABLE)); SCU_RAM_GPIO_HW_LOCK_IND_DISABLE));
if (state->m_OperationMode != oMode) { if (state->m_OperationMode != oMode) {
switch (state->m_OperationMode) { switch (state->m_OperationMode) {
// OM_NONE was added for start up /* OM_NONE was added for start up */
case OM_NONE: case OM_NONE:
break; break;
case OM_DVBT: case OM_DVBT:
CHK_ERROR(MPEGTSStop(state)); CHK_ERROR(MPEGTSStop(state));
CHK_ERROR(PowerDownDVBT(state,true)); CHK_ERROR(PowerDownDVBT(state, true));
state->m_OperationMode = OM_NONE; state->m_OperationMode = OM_NONE;
break; break;
case OM_QAM_ITU_B: case OM_QAM_ITU_B:
...@@ -1580,8 +1600,7 @@ static int SetOperationMode(struct drxk_state *state, enum OperationMode oMode) ...@@ -1580,8 +1600,7 @@ static int SetOperationMode(struct drxk_state *state, enum OperationMode oMode)
/* /*
Power up new standard Power up new standard
*/ */
switch (oMode) switch (oMode) {
{
case OM_DVBT: case OM_DVBT:
state->m_OperationMode = oMode; state->m_OperationMode = oMode;
CHK_ERROR(SetDVBTStandard(state, oMode)); CHK_ERROR(SetDVBTStandard(state, oMode));
...@@ -1592,14 +1611,14 @@ static int SetOperationMode(struct drxk_state *state, enum OperationMode oMode) ...@@ -1592,14 +1611,14 @@ static int SetOperationMode(struct drxk_state *state, enum OperationMode oMode)
case OM_QAM_ITU_A: /* fallthrough */ case OM_QAM_ITU_A: /* fallthrough */
case OM_QAM_ITU_C: case OM_QAM_ITU_C:
state->m_OperationMode = oMode; state->m_OperationMode = oMode;
CHK_ERROR(SetQAMStandard(state,oMode)); CHK_ERROR(SetQAMStandard(state, oMode));
break; break;
default: default:
status = -1; status = -1;
} }
} }
CHK_ERROR(status); CHK_ERROR(status);
} while(0); } while (0);
return 0; return 0;
} }
...@@ -1621,28 +1640,29 @@ static int Start(struct drxk_state *state, s32 offsetFreq, ...@@ -1621,28 +1640,29 @@ static int Start(struct drxk_state *state, s32 offsetFreq,
(state->param.inversion == INVERSION_ON); (state->param.inversion == INVERSION_ON);
if (IntermediateFrequency < 0) { if (IntermediateFrequency < 0) {
state->m_bMirrorFreqSpect = !state->m_bMirrorFreqSpect; state->m_bMirrorFreqSpect =
!state->m_bMirrorFreqSpect;
IntermediateFrequency = -IntermediateFrequency; IntermediateFrequency = -IntermediateFrequency;
} }
switch(state->m_OperationMode) { switch (state->m_OperationMode) {
case OM_QAM_ITU_A: case OM_QAM_ITU_A:
case OM_QAM_ITU_C: case OM_QAM_ITU_C:
IFreqkHz = (IntermediateFrequency / 1000); IFreqkHz = (IntermediateFrequency / 1000);
CHK_ERROR(SetQAM(state,IFreqkHz, OffsetkHz)); CHK_ERROR(SetQAM(state, IFreqkHz, OffsetkHz));
state->m_DrxkState = DRXK_DTV_STARTED; state->m_DrxkState = DRXK_DTV_STARTED;
break; break;
case OM_DVBT: case OM_DVBT:
IFreqkHz = (IntermediateFrequency / 1000); IFreqkHz = (IntermediateFrequency / 1000);
CHK_ERROR(MPEGTSStop(state)); CHK_ERROR(MPEGTSStop(state));
CHK_ERROR(SetDVBT(state,IFreqkHz, OffsetkHz)); CHK_ERROR(SetDVBT(state, IFreqkHz, OffsetkHz));
CHK_ERROR(DVBTStart(state)); CHK_ERROR(DVBTStart(state));
state->m_DrxkState = DRXK_DTV_STARTED; state->m_DrxkState = DRXK_DTV_STARTED;
break; break;
default: default:
break; break;
} }
} while(0); } while (0);
return status; return status;
} }
...@@ -1652,7 +1672,8 @@ static int ShutDown(struct drxk_state *state) ...@@ -1652,7 +1672,8 @@ static int ShutDown(struct drxk_state *state)
return 0; return 0;
} }
static int GetLockStatus(struct drxk_state *state, u32 *pLockStatus, u32 Time) static int GetLockStatus(struct drxk_state *state, u32 *pLockStatus,
u32 Time)
{ {
int status; int status;
...@@ -1685,9 +1706,11 @@ static int MPEGTSStart(struct drxk_state *state) ...@@ -1685,9 +1706,11 @@ static int MPEGTSStart(struct drxk_state *state)
do { do {
/* Allow OC to sync again */ /* Allow OC to sync again */
CHK_ERROR(Read16_0(state, FEC_OC_SNC_MODE__A, &fecOcSncMode)); CHK_ERROR(Read16_0
(state, FEC_OC_SNC_MODE__A, &fecOcSncMode));
fecOcSncMode &= ~FEC_OC_SNC_MODE_SHUTDOWN__M; fecOcSncMode &= ~FEC_OC_SNC_MODE_SHUTDOWN__M;
CHK_ERROR(Write16_0(state, FEC_OC_SNC_MODE__A, fecOcSncMode)); CHK_ERROR(Write16_0
(state, FEC_OC_SNC_MODE__A, fecOcSncMode));
CHK_ERROR(Write16_0(state, FEC_OC_SNC_UNLOCK__A, 1)); CHK_ERROR(Write16_0(state, FEC_OC_SNC_UNLOCK__A, 1));
} while (0); } while (0);
return status; return status;
...@@ -1699,13 +1722,17 @@ static int MPEGTSDtoInit(struct drxk_state *state) ...@@ -1699,13 +1722,17 @@ static int MPEGTSDtoInit(struct drxk_state *state)
do { do {
/* Rate integration settings */ /* Rate integration settings */
CHK_ERROR(Write16_0(state, FEC_OC_RCN_CTL_STEP_LO__A, 0x0000)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, FEC_OC_RCN_CTL_STEP_HI__A, 0x000C)); (state, FEC_OC_RCN_CTL_STEP_LO__A, 0x0000));
CHK_ERROR(Write16_0
(state, FEC_OC_RCN_CTL_STEP_HI__A, 0x000C));
CHK_ERROR(Write16_0(state, FEC_OC_RCN_GAIN__A, 0x000A)); CHK_ERROR(Write16_0(state, FEC_OC_RCN_GAIN__A, 0x000A));
CHK_ERROR(Write16_0(state, FEC_OC_AVR_PARM_A__A, 0x0008)); CHK_ERROR(Write16_0(state, FEC_OC_AVR_PARM_A__A, 0x0008));
CHK_ERROR(Write16_0(state, FEC_OC_AVR_PARM_B__A, 0x0006)); CHK_ERROR(Write16_0(state, FEC_OC_AVR_PARM_B__A, 0x0006));
CHK_ERROR(Write16_0(state, FEC_OC_TMD_HI_MARGIN__A, 0x0680)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, FEC_OC_TMD_LO_MARGIN__A, 0x0080)); (state, FEC_OC_TMD_HI_MARGIN__A, 0x0680));
CHK_ERROR(Write16_0
(state, FEC_OC_TMD_LO_MARGIN__A, 0x0080));
CHK_ERROR(Write16_0(state, FEC_OC_TMD_COUNT__A, 0x03F4)); CHK_ERROR(Write16_0(state, FEC_OC_TMD_COUNT__A, 0x03F4));
/* Additional configuration */ /* Additional configuration */
...@@ -1716,7 +1743,8 @@ static int MPEGTSDtoInit(struct drxk_state *state) ...@@ -1716,7 +1743,8 @@ static int MPEGTSDtoInit(struct drxk_state *state)
return status; return status;
} }
static int MPEGTSDtoSetup(struct drxk_state *state, enum OperationMode oMode) static int MPEGTSDtoSetup(struct drxk_state *state,
enum OperationMode oMode)
{ {
int status = -1; int status = -1;
...@@ -1745,7 +1773,7 @@ static int MPEGTSDtoSetup(struct drxk_state *state, enum OperationMode oMode) ...@@ -1745,7 +1773,7 @@ static int MPEGTSDtoSetup(struct drxk_state *state, enum OperationMode oMode)
/* MVAL disable during parity bytes */ /* MVAL disable during parity bytes */
fecOcRegIprMode |= FEC_OC_IPR_MODE_MVAL_DIS_PAR__M; fecOcRegIprMode |= FEC_OC_IPR_MODE_MVAL_DIS_PAR__M;
/* TS burst length to 204 */ /* TS burst length to 204 */
fecOcDtoBurstLen = 204 ; fecOcDtoBurstLen = 204;
} }
/* Check serial or parrallel output */ /* Check serial or parrallel output */
...@@ -1775,7 +1803,7 @@ static int MPEGTSDtoSetup(struct drxk_state *state, enum OperationMode oMode) ...@@ -1775,7 +1803,7 @@ static int MPEGTSDtoSetup(struct drxk_state *state, enum OperationMode oMode)
CHK_ERROR(status); CHK_ERROR(status);
/* Configure DTO's */ /* Configure DTO's */
if (staticCLK ) { if (staticCLK) {
u32 bitRate = 0; u32 bitRate = 0;
/* Rational DTO for MCLK source (static MCLK rate), /* Rational DTO for MCLK source (static MCLK rate),
...@@ -1789,8 +1817,7 @@ static int MPEGTSDtoSetup(struct drxk_state *state, enum OperationMode oMode) ...@@ -1789,8 +1817,7 @@ static int MPEGTSDtoSetup(struct drxk_state *state, enum OperationMode oMode)
/* Check user defined bitrate */ /* Check user defined bitrate */
bitRate = maxBitRate; bitRate = maxBitRate;
if (bitRate > 75900000UL) if (bitRate > 75900000UL) { /* max is 75.9 Mb/s */
{ /* max is 75.9 Mb/s */
bitRate = 75900000UL; bitRate = 75900000UL;
} }
/* Rational DTO period: /* Rational DTO period:
...@@ -1822,14 +1849,13 @@ static int MPEGTSDtoSetup(struct drxk_state *state, enum OperationMode oMode) ...@@ -1822,14 +1849,13 @@ static int MPEGTSDtoSetup(struct drxk_state *state, enum OperationMode oMode)
fecOcDtoMode)); fecOcDtoMode));
CHK_ERROR(Write16_0(state, FEC_OC_FCT_MODE__A, CHK_ERROR(Write16_0(state, FEC_OC_FCT_MODE__A,
fecOcFctMode)); fecOcFctMode));
CHK_ERROR(Write16_0(state, FEC_OC_MODE__A, CHK_ERROR(Write16_0(state, FEC_OC_MODE__A, fecOcRegMode));
fecOcRegMode));
CHK_ERROR(Write16_0(state, FEC_OC_IPR_MODE__A, CHK_ERROR(Write16_0(state, FEC_OC_IPR_MODE__A,
fecOcRegIprMode)); fecOcRegIprMode));
/* Rate integration settings */ /* Rate integration settings */
CHK_ERROR(Write32(state, FEC_OC_RCN_CTL_RATE_LO__A, CHK_ERROR(Write32(state, FEC_OC_RCN_CTL_RATE_LO__A,
fecOcRcnCtlRate ,0)); fecOcRcnCtlRate, 0));
CHK_ERROR(Write16_0(state, FEC_OC_TMD_INT_UPD_RATE__A, CHK_ERROR(Write16_0(state, FEC_OC_TMD_INT_UPD_RATE__A,
fecOcTmdIntUpdRate)); fecOcTmdIntUpdRate));
CHK_ERROR(Write16_0(state, FEC_OC_TMD_MODE__A, CHK_ERROR(Write16_0(state, FEC_OC_TMD_MODE__A,
...@@ -1866,7 +1892,7 @@ static int MPEGTSConfigurePolarity(struct drxk_state *state) ...@@ -1866,7 +1892,7 @@ static int MPEGTSConfigurePolarity(struct drxk_state *state)
fecOcRegIprInvert &= (~(FEC_OC_IPR_INVERT_MCLK__M)); fecOcRegIprInvert &= (~(FEC_OC_IPR_INVERT_MCLK__M));
if (state->m_invertCLK == true) if (state->m_invertCLK == true)
fecOcRegIprInvert |= FEC_OC_IPR_INVERT_MCLK__M; fecOcRegIprInvert |= FEC_OC_IPR_INVERT_MCLK__M;
status = Write16_0(state,FEC_OC_IPR_INVERT__A, fecOcRegIprInvert); status = Write16_0(state, FEC_OC_IPR_INVERT__A, fecOcRegIprInvert);
return status; return status;
} }
...@@ -1888,7 +1914,7 @@ static int SetAgcRf(struct drxk_state *state, ...@@ -1888,7 +1914,7 @@ static int SetAgcRf(struct drxk_state *state,
case DRXK_AGC_CTRL_AUTO: case DRXK_AGC_CTRL_AUTO:
/* Enable RF AGC DAC */ /* Enable RF AGC DAC */
CHK_ERROR(Read16_0(state, IQM_AF_STDBY__A , &data)); CHK_ERROR(Read16_0(state, IQM_AF_STDBY__A, &data));
data &= ~IQM_AF_STDBY_STDBY_TAGC_RF_STANDBY; data &= ~IQM_AF_STDBY_STDBY_TAGC_RF_STANDBY;
CHK_ERROR(Write16_0(state, IQM_AF_STDBY__A, data)); CHK_ERROR(Write16_0(state, IQM_AF_STDBY__A, data));
...@@ -1962,19 +1988,21 @@ static int SetAgcRf(struct drxk_state *state, ...@@ -1962,19 +1988,21 @@ static int SetAgcRf(struct drxk_state *state,
data)); data));
/* SCU c.o.c. to 0, enabling full control range */ /* SCU c.o.c. to 0, enabling full control range */
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_RF_IACCU_HI_CO__A, CHK_ERROR(Write16_0
(state, SCU_RAM_AGC_RF_IACCU_HI_CO__A,
0)); 0));
/* Write value to output pin */ /* Write value to output pin */
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_RF_IACCU_HI__A, CHK_ERROR(Write16_0
(state, SCU_RAM_AGC_RF_IACCU_HI__A,
pAgcCfg->outputLevel)); pAgcCfg->outputLevel));
break; break;
case DRXK_AGC_CTRL_OFF: case DRXK_AGC_CTRL_OFF:
/* Disable RF AGC DAC */ /* Disable RF AGC DAC */
CHK_ERROR(Read16_0(state, IQM_AF_STDBY__A , &data)); CHK_ERROR(Read16_0(state, IQM_AF_STDBY__A, &data));
data |= IQM_AF_STDBY_STDBY_TAGC_RF_STANDBY; data |= IQM_AF_STDBY_STDBY_TAGC_RF_STANDBY;
CHK_ERROR(Write16_0(state, IQM_AF_STDBY__A , data)); CHK_ERROR(Write16_0(state, IQM_AF_STDBY__A, data));
/* Disable SCU RF AGC loop */ /* Disable SCU RF AGC loop */
CHK_ERROR(Read16_0(state, CHK_ERROR(Read16_0(state,
...@@ -1988,13 +2016,13 @@ static int SetAgcRf(struct drxk_state *state, ...@@ -1988,13 +2016,13 @@ static int SetAgcRf(struct drxk_state *state,
return -1; return -1;
} /* switch (agcsettings->ctrlMode) */ } /* switch (agcsettings->ctrlMode) */
} while(0); } while (0);
return status; return status;
} }
#define SCU_RAM_AGC_KI_INV_IF_POL__M 0x2000 #define SCU_RAM_AGC_KI_INV_IF_POL__M 0x2000
static int SetAgcIf (struct drxk_state *state, static int SetAgcIf(struct drxk_state *state,
struct SCfgAgc *pAgcCfg, bool isDTV) struct SCfgAgc *pAgcCfg, bool isDTV)
{ {
u16 data = 0; u16 data = 0;
...@@ -2006,9 +2034,9 @@ static int SetAgcIf (struct drxk_state *state, ...@@ -2006,9 +2034,9 @@ static int SetAgcIf (struct drxk_state *state,
case DRXK_AGC_CTRL_AUTO: case DRXK_AGC_CTRL_AUTO:
/* Enable IF AGC DAC */ /* Enable IF AGC DAC */
CHK_ERROR(Read16_0(state, IQM_AF_STDBY__A , &data)); CHK_ERROR(Read16_0(state, IQM_AF_STDBY__A, &data));
data &= ~IQM_AF_STDBY_STDBY_TAGC_IF_STANDBY; data &= ~IQM_AF_STDBY_STDBY_TAGC_IF_STANDBY;
CHK_ERROR(Write16_0(state, IQM_AF_STDBY__A , data)); CHK_ERROR(Write16_0(state, IQM_AF_STDBY__A, data));
CHK_ERROR(Read16_0(state, SCU_RAM_AGC_CONFIG__A, CHK_ERROR(Read16_0(state, SCU_RAM_AGC_CONFIG__A,
&data)); &data));
...@@ -2032,7 +2060,7 @@ static int SetAgcIf (struct drxk_state *state, ...@@ -2032,7 +2060,7 @@ static int SetAgcIf (struct drxk_state *state,
SCU_RAM_AGC_KI_RED_IAGC_RED__B) SCU_RAM_AGC_KI_RED_IAGC_RED__B)
& SCU_RAM_AGC_KI_RED_IAGC_RED__M); & SCU_RAM_AGC_KI_RED_IAGC_RED__M);
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_KI_RED__A , CHK_ERROR(Write16_0(state, SCU_RAM_AGC_KI_RED__A,
data)); data));
if (IsQAM(state)) if (IsQAM(state))
...@@ -2050,9 +2078,9 @@ static int SetAgcIf (struct drxk_state *state, ...@@ -2050,9 +2078,9 @@ static int SetAgcIf (struct drxk_state *state,
case DRXK_AGC_CTRL_USER: case DRXK_AGC_CTRL_USER:
/* Enable IF AGC DAC */ /* Enable IF AGC DAC */
CHK_ERROR(Read16_0(state, IQM_AF_STDBY__A , &data)); CHK_ERROR(Read16_0(state, IQM_AF_STDBY__A, &data));
data &= ~IQM_AF_STDBY_STDBY_TAGC_IF_STANDBY; data &= ~IQM_AF_STDBY_STDBY_TAGC_IF_STANDBY;
CHK_ERROR(Write16_0(state, IQM_AF_STDBY__A , data)); CHK_ERROR(Write16_0(state, IQM_AF_STDBY__A, data));
CHK_ERROR(Read16_0(state, CHK_ERROR(Read16_0(state,
SCU_RAM_AGC_CONFIG__A, &data)); SCU_RAM_AGC_CONFIG__A, &data));
...@@ -2077,9 +2105,9 @@ static int SetAgcIf (struct drxk_state *state, ...@@ -2077,9 +2105,9 @@ static int SetAgcIf (struct drxk_state *state,
case DRXK_AGC_CTRL_OFF: case DRXK_AGC_CTRL_OFF:
/* Disable If AGC DAC */ /* Disable If AGC DAC */
CHK_ERROR(Read16_0(state, IQM_AF_STDBY__A , &data)); CHK_ERROR(Read16_0(state, IQM_AF_STDBY__A, &data));
data |= IQM_AF_STDBY_STDBY_TAGC_IF_STANDBY; data |= IQM_AF_STDBY_STDBY_TAGC_IF_STANDBY;
CHK_ERROR(Write16_0(state, IQM_AF_STDBY__A , data)); CHK_ERROR(Write16_0(state, IQM_AF_STDBY__A, data));
/* Disable SCU IF AGC loop */ /* Disable SCU IF AGC loop */
CHK_ERROR(Read16_0(state, CHK_ERROR(Read16_0(state,
...@@ -2096,7 +2124,7 @@ static int SetAgcIf (struct drxk_state *state, ...@@ -2096,7 +2124,7 @@ static int SetAgcIf (struct drxk_state *state,
pAgcCfg->top)); pAgcCfg->top));
} while(0); } while (0);
return status; return status;
} }
...@@ -2107,19 +2135,20 @@ static int ReadIFAgc(struct drxk_state *state, u32 *pValue) ...@@ -2107,19 +2135,20 @@ static int ReadIFAgc(struct drxk_state *state, u32 *pValue)
*pValue = 0; *pValue = 0;
if (status==0) { if (status == 0) {
u16 Level = 0; u16 Level = 0;
if (agcDacLvl > DRXK_AGC_DAC_OFFSET) if (agcDacLvl > DRXK_AGC_DAC_OFFSET)
Level = agcDacLvl - DRXK_AGC_DAC_OFFSET; Level = agcDacLvl - DRXK_AGC_DAC_OFFSET;
if (Level < 14000) if (Level < 14000)
*pValue = (14000 - Level) / 4 ; *pValue = (14000 - Level) / 4;
else else
*pValue = 0; *pValue = 0;
} }
return status; return status;
} }
static int GetQAMSignalToNoise(struct drxk_state *state, s32 *pSignalToNoise) static int GetQAMSignalToNoise(struct drxk_state *state,
s32 *pSignalToNoise)
{ {
int status = 0; int status = 0;
...@@ -2132,9 +2161,10 @@ static int GetQAMSignalToNoise(struct drxk_state *state, s32 *pSignalToNoise) ...@@ -2132,9 +2161,10 @@ static int GetQAMSignalToNoise(struct drxk_state *state, s32 *pSignalToNoise)
u32 qamSlMer = 0; /* QAM MER */ u32 qamSlMer = 0; /* QAM MER */
/* get the register value needed for MER */ /* get the register value needed for MER */
CHK_ERROR(Read16_0(state,QAM_SL_ERR_POWER__A, &qamSlErrPower)); CHK_ERROR(Read16_0
(state, QAM_SL_ERR_POWER__A, &qamSlErrPower));
switch(state->param.u.qam.modulation) { switch (state->param.u.qam.modulation) {
case QAM_16: case QAM_16:
qamSlSigPower = DRXK_QAM_SL_SIG_POWER_QAM16 << 2; qamSlSigPower = DRXK_QAM_SL_SIG_POWER_QAM16 << 2;
break; break;
...@@ -2158,11 +2188,12 @@ static int GetQAMSignalToNoise(struct drxk_state *state, s32 *pSignalToNoise) ...@@ -2158,11 +2188,12 @@ static int GetQAMSignalToNoise(struct drxk_state *state, s32 *pSignalToNoise)
Log10Times100((u32) qamSlErrPower); Log10Times100((u32) qamSlErrPower);
} }
*pSignalToNoise = qamSlMer; *pSignalToNoise = qamSlMer;
} while(0); } while (0);
return status; return status;
} }
static int GetDVBTSignalToNoise(struct drxk_state *state, s32 *pSignalToNoise) static int GetDVBTSignalToNoise(struct drxk_state *state,
s32 *pSignalToNoise)
{ {
int status = 0; int status = 0;
...@@ -2195,15 +2226,15 @@ static int GetDVBTSignalToNoise(struct drxk_state *state, s32 *pSignalToNoise) ...@@ -2195,15 +2226,15 @@ static int GetDVBTSignalToNoise(struct drxk_state *state, s32 *pSignalToNoise)
(EqRegTdSqrErrI < 0x00000FFFUL)) { (EqRegTdSqrErrI < 0x00000FFFUL)) {
EqRegTdSqrErrI += 0x00010000UL; EqRegTdSqrErrI += 0x00010000UL;
} }
CHK_ERROR(Read16_0(state,OFDM_EQ_TOP_TD_SQR_ERR_Q__A, CHK_ERROR(Read16_0(state, OFDM_EQ_TOP_TD_SQR_ERR_Q__A,
&regData)); &regData));
/* Extend SQR_ERR_Q operational range */ /* Extend SQR_ERR_Q operational range */
EqRegTdSqrErrQ = (u32)regData; EqRegTdSqrErrQ = (u32) regData;
if ((EqRegTdSqrErrExp > 11) && if ((EqRegTdSqrErrExp > 11) &&
(EqRegTdSqrErrQ < 0x00000FFFUL)) (EqRegTdSqrErrQ < 0x00000FFFUL))
EqRegTdSqrErrQ += 0x00010000UL; EqRegTdSqrErrQ += 0x00010000UL;
CHK_ERROR(Read16_0(state,OFDM_SC_RA_RAM_OP_PARAM__A, CHK_ERROR(Read16_0(state, OFDM_SC_RA_RAM_OP_PARAM__A,
&transmissionParams)); &transmissionParams));
/* Check input data for MER */ /* Check input data for MER */
...@@ -2237,9 +2268,10 @@ static int GetDVBTSignalToNoise(struct drxk_state *state, s32 *pSignalToNoise) ...@@ -2237,9 +2268,10 @@ static int GetDVBTSignalToNoise(struct drxk_state *state, s32 *pSignalToNoise)
*/ */
/* log(x) x = 9bits * 9bits->18 bits */ /* log(x) x = 9bits * 9bits->18 bits */
a = Log10Times100(EqRegTdTpsPwrOfs*EqRegTdTpsPwrOfs); a = Log10Times100(EqRegTdTpsPwrOfs *
EqRegTdTpsPwrOfs);
/* log(x) x = 16bits * 7bits->23 bits */ /* log(x) x = 16bits * 7bits->23 bits */
b = Log10Times100(EqRegTdReqSmbCnt*tpsCnt); b = Log10Times100(EqRegTdReqSmbCnt * tpsCnt);
/* log(x) x = (16bits + 16bits) << 15 ->32 bits */ /* log(x) x = (16bits + 16bits) << 15 ->32 bits */
c = Log10Times100(SqrErrIQ); c = Log10Times100(SqrErrIQ);
...@@ -2251,7 +2283,7 @@ static int GetDVBTSignalToNoise(struct drxk_state *state, s32 *pSignalToNoise) ...@@ -2251,7 +2283,7 @@ static int GetDVBTSignalToNoise(struct drxk_state *state, s32 *pSignalToNoise)
iMER = 0; iMER = 0;
} }
*pSignalToNoise = iMER; *pSignalToNoise = iMER;
} while(0); } while (0);
return status; return status;
} }
...@@ -2259,7 +2291,7 @@ static int GetDVBTSignalToNoise(struct drxk_state *state, s32 *pSignalToNoise) ...@@ -2259,7 +2291,7 @@ static int GetDVBTSignalToNoise(struct drxk_state *state, s32 *pSignalToNoise)
static int GetSignalToNoise(struct drxk_state *state, s32 *pSignalToNoise) static int GetSignalToNoise(struct drxk_state *state, s32 *pSignalToNoise)
{ {
*pSignalToNoise = 0; *pSignalToNoise = 0;
switch(state->m_OperationMode) { switch (state->m_OperationMode) {
case OM_DVBT: case OM_DVBT:
return GetDVBTSignalToNoise(state, pSignalToNoise); return GetDVBTSignalToNoise(state, pSignalToNoise);
case OM_QAM_ITU_A: case OM_QAM_ITU_A:
...@@ -2277,23 +2309,22 @@ static int GetDVBTQuality(struct drxk_state *state, s32 *pQuality) ...@@ -2277,23 +2309,22 @@ static int GetDVBTQuality(struct drxk_state *state, s32 *pQuality)
/* SNR Values for quasi errorfree reception rom Nordig 2.2 */ /* SNR Values for quasi errorfree reception rom Nordig 2.2 */
int status = 0; int status = 0;
static s32 QE_SN[] = static s32 QE_SN[] = {
{ 51, /* QPSK 1/2 */
51, // QPSK 1/2 69, /* QPSK 2/3 */
69, // QPSK 2/3 79, /* QPSK 3/4 */
79, // QPSK 3/4 89, /* QPSK 5/6 */
89, // QPSK 5/6 97, /* QPSK 7/8 */
97, // QPSK 7/8 108, /* 16-QAM 1/2 */
108, // 16-QAM 1/2 131, /* 16-QAM 2/3 */
131, // 16-QAM 2/3 146, /* 16-QAM 3/4 */
146, // 16-QAM 3/4 156, /* 16-QAM 5/6 */
156, // 16-QAM 5/6 160, /* 16-QAM 7/8 */
160, // 16-QAM 7/8 165, /* 64-QAM 1/2 */
165, // 64-QAM 1/2 187, /* 64-QAM 2/3 */
187, // 64-QAM 2/3 202, /* 64-QAM 3/4 */
202, // 64-QAM 3/4 216, /* 64-QAM 5/6 */
216, // 64-QAM 5/6 225, /* 64-QAM 7/8 */
225, // 64-QAM 7/8
}; };
*pQuality = 0; *pQuality = 0;
...@@ -2305,12 +2336,12 @@ static int GetDVBTQuality(struct drxk_state *state, s32 *pQuality) ...@@ -2305,12 +2336,12 @@ static int GetDVBTQuality(struct drxk_state *state, s32 *pQuality)
u32 SignalToNoiseRel; u32 SignalToNoiseRel;
u32 BERQuality; u32 BERQuality;
CHK_ERROR(GetDVBTSignalToNoise(state,&SignalToNoise)); CHK_ERROR(GetDVBTSignalToNoise(state, &SignalToNoise));
CHK_ERROR(Read16_0(state,OFDM_EQ_TOP_TD_TPS_CONST__A, CHK_ERROR(Read16_0(state, OFDM_EQ_TOP_TD_TPS_CONST__A,
&Constellation)); &Constellation));
Constellation &= OFDM_EQ_TOP_TD_TPS_CONST__M; Constellation &= OFDM_EQ_TOP_TD_TPS_CONST__M;
CHK_ERROR(Read16_0(state,OFDM_EQ_TOP_TD_TPS_CODE_HP__A, CHK_ERROR(Read16_0(state, OFDM_EQ_TOP_TD_TPS_CODE_HP__A,
&CodeRate)); &CodeRate));
CodeRate &= OFDM_EQ_TOP_TD_TPS_CODE_HP__M; CodeRate &= OFDM_EQ_TOP_TD_TPS_CODE_HP__M;
...@@ -2321,13 +2352,14 @@ static int GetDVBTQuality(struct drxk_state *state, s32 *pQuality) ...@@ -2321,13 +2352,14 @@ static int GetDVBTQuality(struct drxk_state *state, s32 *pQuality)
QE_SN[Constellation * 5 + CodeRate]; QE_SN[Constellation * 5 + CodeRate];
BERQuality = 100; BERQuality = 100;
if (SignalToNoiseRel < -70) *pQuality = 0; if (SignalToNoiseRel < -70)
*pQuality = 0;
else if (SignalToNoiseRel < 30) else if (SignalToNoiseRel < 30)
*pQuality = ((SignalToNoiseRel + 70) * *pQuality = ((SignalToNoiseRel + 70) *
BERQuality) / 100; BERQuality) / 100;
else else
*pQuality = BERQuality; *pQuality = BERQuality;
} while(0); } while (0);
return 0; return 0;
}; };
...@@ -2343,7 +2375,7 @@ static int GetDVBCQuality(struct drxk_state *state, s32 *pQuality) ...@@ -2343,7 +2375,7 @@ static int GetDVBCQuality(struct drxk_state *state, s32 *pQuality)
CHK_ERROR(GetQAMSignalToNoise(state, &SignalToNoise)); CHK_ERROR(GetQAMSignalToNoise(state, &SignalToNoise));
switch(state->param.u.qam.modulation) { switch (state->param.u.qam.modulation) {
case QAM_16: case QAM_16:
SignalToNoiseRel = SignalToNoise - 200; SignalToNoiseRel = SignalToNoise - 200;
break; break;
...@@ -2369,14 +2401,14 @@ static int GetDVBCQuality(struct drxk_state *state, s32 *pQuality) ...@@ -2369,14 +2401,14 @@ static int GetDVBCQuality(struct drxk_state *state, s32 *pQuality)
BERQuality) / 100; BERQuality) / 100;
else else
*pQuality = BERQuality; *pQuality = BERQuality;
} while(0); } while (0);
return status; return status;
} }
static int GetQuality(struct drxk_state *state, s32 *pQuality) static int GetQuality(struct drxk_state *state, s32 *pQuality)
{ {
switch(state->m_OperationMode) { switch (state->m_OperationMode) {
case OM_DVBT: case OM_DVBT:
return GetDVBTQuality(state, pQuality); return GetDVBTQuality(state, pQuality);
case OM_QAM_ITU_A: case OM_QAM_ITU_A:
...@@ -2422,16 +2454,18 @@ static int ConfigureI2CBridge(struct drxk_state *state, bool bEnableBridge) ...@@ -2422,16 +2454,18 @@ static int ConfigureI2CBridge(struct drxk_state *state, bool bEnableBridge)
SIO_HI_RA_RAM_PAR_2_BRD_CFG_OPEN)); SIO_HI_RA_RAM_PAR_2_BRD_CFG_OPEN));
} }
CHK_ERROR(HI_Command(state, SIO_HI_RA_RAM_CMD_BRDCTRL,0)); CHK_ERROR(HI_Command(state, SIO_HI_RA_RAM_CMD_BRDCTRL, 0));
} while(0); } while (0);
return status; return status;
} }
static int SetPreSaw(struct drxk_state *state, struct SCfgPreSaw *pPreSawCfg) static int SetPreSaw(struct drxk_state *state,
struct SCfgPreSaw *pPreSawCfg)
{ {
int status; int status;
if ((pPreSawCfg == NULL) || (pPreSawCfg->reference>IQM_AF_PDREF__M)) if ((pPreSawCfg == NULL)
|| (pPreSawCfg->reference > IQM_AF_PDREF__M))
return -1; return -1;
status = Write16_0(state, IQM_AF_PDREF__A, pPreSawCfg->reference); status = Write16_0(state, IQM_AF_PDREF__A, pPreSawCfg->reference);
...@@ -2442,31 +2476,34 @@ static int BLDirectCmd(struct drxk_state *state, u32 targetAddr, ...@@ -2442,31 +2476,34 @@ static int BLDirectCmd(struct drxk_state *state, u32 targetAddr,
u16 romOffset, u16 nrOfElements, u32 timeOut) u16 romOffset, u16 nrOfElements, u32 timeOut)
{ {
u16 blStatus = 0; u16 blStatus = 0;
u16 offset = (u16)((targetAddr >> 0) & 0x00FFFF); u16 offset = (u16) ((targetAddr >> 0) & 0x00FFFF);
u16 blockbank = (u16)((targetAddr >> 16) & 0x000FFF); u16 blockbank = (u16) ((targetAddr >> 16) & 0x000FFF);
int status ; int status;
unsigned long end; unsigned long end;
mutex_lock(&state->mutex); mutex_lock(&state->mutex);
do { do {
CHK_ERROR(Write16_0(state, SIO_BL_MODE__A, SIO_BL_MODE_DIRECT)); CHK_ERROR(Write16_0
(state, SIO_BL_MODE__A, SIO_BL_MODE_DIRECT));
CHK_ERROR(Write16_0(state, SIO_BL_TGT_HDR__A, blockbank)); CHK_ERROR(Write16_0(state, SIO_BL_TGT_HDR__A, blockbank));
CHK_ERROR(Write16_0(state, SIO_BL_TGT_ADDR__A, offset)); CHK_ERROR(Write16_0(state, SIO_BL_TGT_ADDR__A, offset));
CHK_ERROR(Write16_0(state, SIO_BL_SRC_ADDR__A, romOffset)); CHK_ERROR(Write16_0(state, SIO_BL_SRC_ADDR__A, romOffset));
CHK_ERROR(Write16_0(state, SIO_BL_SRC_LEN__A, nrOfElements)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SIO_BL_ENABLE__A, SIO_BL_ENABLE_ON)); (state, SIO_BL_SRC_LEN__A, nrOfElements));
CHK_ERROR(Write16_0
(state, SIO_BL_ENABLE__A, SIO_BL_ENABLE_ON));
end=jiffies+msecs_to_jiffies(timeOut); end = jiffies + msecs_to_jiffies(timeOut);
do { do {
CHK_ERROR(Read16_0(state, SIO_BL_STATUS__A, &blStatus)); CHK_ERROR(Read16_0
} while ((blStatus == 0x1) && (state, SIO_BL_STATUS__A, &blStatus));
time_is_after_jiffies(end)); } while ((blStatus == 0x1) && time_is_after_jiffies(end));
if (blStatus == 0x1) { if (blStatus == 0x1) {
printk("SIO not ready\n"); printk(KERN_ERR "SIO not ready\n");
mutex_unlock(&state->mutex); mutex_unlock(&state->mutex);
return -1; return -1;
} }
} while(0); } while (0);
mutex_unlock(&state->mutex); mutex_unlock(&state->mutex);
return status; return status;
...@@ -2481,19 +2518,19 @@ static int ADCSyncMeasurement(struct drxk_state *state, u16 *count) ...@@ -2481,19 +2518,19 @@ static int ADCSyncMeasurement(struct drxk_state *state, u16 *count)
/* Start measurement */ /* Start measurement */
CHK_ERROR(Write16_0(state, IQM_AF_COMM_EXEC__A, CHK_ERROR(Write16_0(state, IQM_AF_COMM_EXEC__A,
IQM_AF_COMM_EXEC_ACTIVE)); IQM_AF_COMM_EXEC_ACTIVE));
CHK_ERROR(Write16_0(state,IQM_AF_START_LOCK__A, 1)); CHK_ERROR(Write16_0(state, IQM_AF_START_LOCK__A, 1));
*count = 0; *count = 0;
CHK_ERROR(Read16_0(state,IQM_AF_PHASE0__A, &data)); CHK_ERROR(Read16_0(state, IQM_AF_PHASE0__A, &data));
if (data == 127) if (data == 127)
*count = *count+1; *count = *count + 1;
CHK_ERROR(Read16_0(state,IQM_AF_PHASE1__A, &data)); CHK_ERROR(Read16_0(state, IQM_AF_PHASE1__A, &data));
if (data == 127) if (data == 127)
*count = *count+1; *count = *count + 1;
CHK_ERROR(Read16_0(state,IQM_AF_PHASE2__A, &data)); CHK_ERROR(Read16_0(state, IQM_AF_PHASE2__A, &data));
if (data == 127) if (data == 127)
*count = *count+1; *count = *count + 1;
} while(0); } while (0);
return status; return status;
} }
...@@ -2505,11 +2542,12 @@ static int ADCSynchronization(struct drxk_state *state) ...@@ -2505,11 +2542,12 @@ static int ADCSynchronization(struct drxk_state *state)
do { do {
CHK_ERROR(ADCSyncMeasurement(state, &count)); CHK_ERROR(ADCSyncMeasurement(state, &count));
if (count==1) { if (count == 1) {
/* Try sampling on a diffrent edge */ /* Try sampling on a diffrent edge */
u16 clkNeg = 0; u16 clkNeg = 0;
CHK_ERROR(Read16_0(state, IQM_AF_CLKNEG__A, &clkNeg)); CHK_ERROR(Read16_0
(state, IQM_AF_CLKNEG__A, &clkNeg));
if ((clkNeg | IQM_AF_CLKNEG_CLKNEGDATA__M) == if ((clkNeg | IQM_AF_CLKNEG_CLKNEGDATA__M) ==
IQM_AF_CLKNEG_CLKNEGDATA_CLK_ADC_DATA_POS) { IQM_AF_CLKNEG_CLKNEGDATA_CLK_ADC_DATA_POS) {
clkNeg &= (~(IQM_AF_CLKNEG_CLKNEGDATA__M)); clkNeg &= (~(IQM_AF_CLKNEG_CLKNEGDATA__M));
...@@ -2520,7 +2558,8 @@ static int ADCSynchronization(struct drxk_state *state) ...@@ -2520,7 +2558,8 @@ static int ADCSynchronization(struct drxk_state *state)
clkNeg |= clkNeg |=
IQM_AF_CLKNEG_CLKNEGDATA_CLK_ADC_DATA_POS; IQM_AF_CLKNEG_CLKNEGDATA_CLK_ADC_DATA_POS;
} }
CHK_ERROR(Write16_0(state, IQM_AF_CLKNEG__A, clkNeg)); CHK_ERROR(Write16_0
(state, IQM_AF_CLKNEG__A, clkNeg));
CHK_ERROR(ADCSyncMeasurement(state, &count)); CHK_ERROR(ADCSyncMeasurement(state, &count));
} }
...@@ -2532,8 +2571,7 @@ static int ADCSynchronization(struct drxk_state *state) ...@@ -2532,8 +2571,7 @@ static int ADCSynchronization(struct drxk_state *state)
static int SetFrequencyShifter(struct drxk_state *state, static int SetFrequencyShifter(struct drxk_state *state,
u16 intermediateFreqkHz, u16 intermediateFreqkHz,
s32 tunerFreqOffset, s32 tunerFreqOffset, bool isDTV)
bool isDTV)
{ {
bool selectPosImage = false; bool selectPosImage = false;
u32 rfFreqResidual = tunerFreqOffset; u32 rfFreqResidual = tunerFreqOffset;
...@@ -2543,7 +2581,7 @@ static int SetFrequencyShifter(struct drxk_state *state, ...@@ -2543,7 +2581,7 @@ static int SetFrequencyShifter(struct drxk_state *state,
bool adcFlip; bool adcFlip;
int status; int status;
u32 ifFreqActual; u32 ifFreqActual;
u32 samplingFrequency = (u32)(state->m_sysClockFreq / 3); u32 samplingFrequency = (u32) (state->m_sysClockFreq / 3);
u32 frequencyShift; u32 frequencyShift;
bool imageToSelect; bool imageToSelect;
...@@ -2580,14 +2618,15 @@ static int SetFrequencyShifter(struct drxk_state *state, ...@@ -2580,14 +2618,15 @@ static int SetFrequencyShifter(struct drxk_state *state,
frequencyShift = adcFreq; frequencyShift = adcFreq;
imageToSelect = state->m_rfmirror ^ tunerMirror ^ imageToSelect = state->m_rfmirror ^ tunerMirror ^
adcFlip ^ selectPosImage; adcFlip ^ selectPosImage;
state->m_IqmFsRateOfs = Frac28a((frequencyShift), samplingFrequency); state->m_IqmFsRateOfs =
Frac28a((frequencyShift), samplingFrequency);
if (imageToSelect) if (imageToSelect)
state->m_IqmFsRateOfs = ~state->m_IqmFsRateOfs + 1; state->m_IqmFsRateOfs = ~state->m_IqmFsRateOfs + 1;
/* Program frequency shifter with tuner offset compensation */ /* Program frequency shifter with tuner offset compensation */
/* frequencyShift += tunerFreqOffset; TODO */ /* frequencyShift += tunerFreqOffset; TODO */
status = Write32(state, IQM_FS_RATE_OFS_LO__A , status = Write32(state, IQM_FS_RATE_OFS_LO__A,
state->m_IqmFsRateOfs, 0); state->m_IqmFsRateOfs, 0);
return status; return status;
} }
...@@ -2623,11 +2662,11 @@ static int InitAGC(struct drxk_state *state, bool isDTV) ...@@ -2623,11 +2662,11 @@ static int InitAGC(struct drxk_state *state, bool isDTV)
if (IsQAM(state)) { if (IsQAM(state)) {
/* Standard specific settings */ /* Standard specific settings */
clpSumMin = 8; clpSumMin = 8;
clpDirTo = (u16) - 9; clpDirTo = (u16) -9;
clpCtrlMode = 0; clpCtrlMode = 0;
snsSumMin = 8; snsSumMin = 8;
snsDirTo = (u16) - 9; snsDirTo = (u16) -9;
kiInnergainMin = (u16) - 1030; kiInnergainMin = (u16) -1030;
} else } else
status = -1; status = -1;
CHK_ERROR((status)); CHK_ERROR((status));
...@@ -2648,7 +2687,8 @@ static int InitAGC(struct drxk_state *state, bool isDTV) ...@@ -2648,7 +2687,8 @@ static int InitAGC(struct drxk_state *state, bool isDTV)
fastClpCtrlDelay = fastClpCtrlDelay =
state->m_dvbtIfAgcCfg.FastClipCtrlDelay; state->m_dvbtIfAgcCfg.FastClipCtrlDelay;
} }
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_FAST_CLP_CTRL_DELAY__A, CHK_ERROR(Write16_0
(state, SCU_RAM_AGC_FAST_CLP_CTRL_DELAY__A,
fastClpCtrlDelay)); fastClpCtrlDelay));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_CLP_CTRL_MODE__A, CHK_ERROR(Write16_0(state, SCU_RAM_AGC_CLP_CTRL_MODE__A,
...@@ -2659,9 +2699,11 @@ static int InitAGC(struct drxk_state *state, bool isDTV) ...@@ -2659,9 +2699,11 @@ static int InitAGC(struct drxk_state *state, bool isDTV)
ingainTgtMin)); ingainTgtMin));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_INGAIN_TGT_MAX__A, CHK_ERROR(Write16_0(state, SCU_RAM_AGC_INGAIN_TGT_MAX__A,
ingainTgtMax)); ingainTgtMax));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_IF_IACCU_HI_TGT_MIN__A, CHK_ERROR(Write16_0
(state, SCU_RAM_AGC_IF_IACCU_HI_TGT_MIN__A,
ifIaccuHiTgtMin)); ifIaccuHiTgtMin));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_IF_IACCU_HI_TGT_MAX__A, CHK_ERROR(Write16_0
(state, SCU_RAM_AGC_IF_IACCU_HI_TGT_MAX__A,
ifIaccuHiTgtMax)); ifIaccuHiTgtMax));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_IF_IACCU_HI__A, 0)); CHK_ERROR(Write16_0(state, SCU_RAM_AGC_IF_IACCU_HI__A, 0));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_IF_IACCU_LO__A, 0)); CHK_ERROR(Write16_0(state, SCU_RAM_AGC_IF_IACCU_LO__A, 0));
...@@ -2683,8 +2725,8 @@ static int InitAGC(struct drxk_state *state, bool isDTV) ...@@ -2683,8 +2725,8 @@ static int InitAGC(struct drxk_state *state, bool isDTV)
1023)); 1023));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_RF_SNS_DEV_MIN__A, CHK_ERROR(Write16_0(state, SCU_RAM_AGC_RF_SNS_DEV_MIN__A,
(u16) -1023)); (u16) -1023));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_FAST_SNS_CTRL_DELAY__A, CHK_ERROR(Write16_0
50)); (state, SCU_RAM_AGC_FAST_SNS_CTRL_DELAY__A, 50));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_KI_MAXMINGAIN_TH__A, CHK_ERROR(Write16_0(state, SCU_RAM_AGC_KI_MAXMINGAIN_TH__A,
20)); 20));
...@@ -2696,8 +2738,10 @@ static int InitAGC(struct drxk_state *state, bool isDTV) ...@@ -2696,8 +2738,10 @@ static int InitAGC(struct drxk_state *state, bool isDTV)
clpDirTo)); clpDirTo));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_SNS_DIR_TO__A, CHK_ERROR(Write16_0(state, SCU_RAM_AGC_SNS_DIR_TO__A,
snsDirTo)); snsDirTo));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_KI_MINGAIN__A, 0x7fff)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_KI_MAXGAIN__A, 0x0)); (state, SCU_RAM_AGC_KI_MINGAIN__A, 0x7fff));
CHK_ERROR(Write16_0
(state, SCU_RAM_AGC_KI_MAXGAIN__A, 0x0));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_KI_MIN__A, 0x0117)); CHK_ERROR(Write16_0(state, SCU_RAM_AGC_KI_MIN__A, 0x0117));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_KI_MAX__A, 0x0657)); CHK_ERROR(Write16_0(state, SCU_RAM_AGC_KI_MAX__A, 0x0657));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_CLP_SUM__A, 0)); CHK_ERROR(Write16_0(state, SCU_RAM_AGC_CLP_SUM__A, 0));
...@@ -2708,7 +2752,8 @@ static int InitAGC(struct drxk_state *state, bool isDTV) ...@@ -2708,7 +2752,8 @@ static int InitAGC(struct drxk_state *state, bool isDTV)
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_SNS_CYCCNT__A, 0)); CHK_ERROR(Write16_0(state, SCU_RAM_AGC_SNS_CYCCNT__A, 0));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_SNS_DIR_WD__A, 0)); CHK_ERROR(Write16_0(state, SCU_RAM_AGC_SNS_DIR_WD__A, 0));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_SNS_DIR_STP__A, 1)); CHK_ERROR(Write16_0(state, SCU_RAM_AGC_SNS_DIR_STP__A, 1));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_SNS_CYCLEN__A, 500)); CHK_ERROR(Write16_0
(state, SCU_RAM_AGC_SNS_CYCLEN__A, 500));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_KI_CYCLEN__A, 500)); CHK_ERROR(Write16_0(state, SCU_RAM_AGC_KI_CYCLEN__A, 500));
/* Initialize inner-loop KI gain factors */ /* Initialize inner-loop KI gain factors */
...@@ -2721,11 +2766,11 @@ static int InitAGC(struct drxk_state *state, bool isDTV) ...@@ -2721,11 +2766,11 @@ static int InitAGC(struct drxk_state *state, bool isDTV)
data |= (DRXK_KI_IAGC_QAM << SCU_RAM_AGC_KI_IF__B); data |= (DRXK_KI_IAGC_QAM << SCU_RAM_AGC_KI_IF__B);
} }
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_KI__A, data)); CHK_ERROR(Write16_0(state, SCU_RAM_AGC_KI__A, data));
} while(0); } while (0);
return status; return status;
} }
static int DVBTQAMGetAccPktErr(struct drxk_state *state, u16 * packetErr) static int DVBTQAMGetAccPktErr(struct drxk_state *state, u16 *packetErr)
{ {
int status; int status;
...@@ -2761,7 +2806,7 @@ static int DVBTScCommand(struct drxk_state *state, ...@@ -2761,7 +2806,7 @@ static int DVBTScCommand(struct drxk_state *state,
} }
/* Wait until sc is ready to receive command */ /* Wait until sc is ready to receive command */
retryCnt =0; retryCnt = 0;
do { do {
msleep(1); msleep(1);
status = Read16_0(state, OFDM_SC_RA_RAM_CMD__A, &curCmd); status = Read16_0(state, OFDM_SC_RA_RAM_CMD__A, &curCmd);
...@@ -2775,7 +2820,8 @@ static int DVBTScCommand(struct drxk_state *state, ...@@ -2775,7 +2820,8 @@ static int DVBTScCommand(struct drxk_state *state,
case OFDM_SC_RA_RAM_CMD_PROC_START: case OFDM_SC_RA_RAM_CMD_PROC_START:
case OFDM_SC_RA_RAM_CMD_SET_PREF_PARAM: case OFDM_SC_RA_RAM_CMD_SET_PREF_PARAM:
case OFDM_SC_RA_RAM_CMD_PROGRAM_PARAM: case OFDM_SC_RA_RAM_CMD_PROGRAM_PARAM:
status = Write16_0(state, OFDM_SC_RA_RAM_CMD_ADDR__A, subcmd); status =
Write16_0(state, OFDM_SC_RA_RAM_CMD_ADDR__A, subcmd);
break; break;
default: default:
/* Do nothing */ /* Do nothing */
...@@ -2791,11 +2837,13 @@ static int DVBTScCommand(struct drxk_state *state, ...@@ -2791,11 +2837,13 @@ static int DVBTScCommand(struct drxk_state *state,
case OFDM_SC_RA_RAM_CMD_PROC_START: case OFDM_SC_RA_RAM_CMD_PROC_START:
case OFDM_SC_RA_RAM_CMD_SET_PREF_PARAM: case OFDM_SC_RA_RAM_CMD_SET_PREF_PARAM:
case OFDM_SC_RA_RAM_CMD_PROGRAM_PARAM: case OFDM_SC_RA_RAM_CMD_PROGRAM_PARAM:
status = Write16_0(state, OFDM_SC_RA_RAM_PARAM1__A, param1); status =
Write16_0(state, OFDM_SC_RA_RAM_PARAM1__A, param1);
/* All commands using 1 parameters */ /* All commands using 1 parameters */
case OFDM_SC_RA_RAM_CMD_SET_ECHO_TIMING: case OFDM_SC_RA_RAM_CMD_SET_ECHO_TIMING:
case OFDM_SC_RA_RAM_CMD_USER_IO: case OFDM_SC_RA_RAM_CMD_USER_IO:
status = Write16_0(state, OFDM_SC_RA_RAM_PARAM0__A, param0); status =
Write16_0(state, OFDM_SC_RA_RAM_PARAM0__A, param0);
/* All commands using 0 parameters */ /* All commands using 0 parameters */
case OFDM_SC_RA_RAM_CMD_GET_OP_PARAM: case OFDM_SC_RA_RAM_CMD_GET_OP_PARAM:
case OFDM_SC_RA_RAM_CMD_NULL: case OFDM_SC_RA_RAM_CMD_NULL:
...@@ -2809,7 +2857,7 @@ static int DVBTScCommand(struct drxk_state *state, ...@@ -2809,7 +2857,7 @@ static int DVBTScCommand(struct drxk_state *state,
/* Wait until sc is ready processing command */ /* Wait until sc is ready processing command */
retryCnt = 0; retryCnt = 0;
do{ do {
msleep(1); msleep(1);
status = Read16_0(state, OFDM_SC_RA_RAM_CMD__A, &curCmd); status = Read16_0(state, OFDM_SC_RA_RAM_CMD__A, &curCmd);
retryCnt++; retryCnt++;
...@@ -2819,8 +2867,7 @@ static int DVBTScCommand(struct drxk_state *state, ...@@ -2819,8 +2867,7 @@ static int DVBTScCommand(struct drxk_state *state,
/* Check for illegal cmd */ /* Check for illegal cmd */
status = Read16_0(state, OFDM_SC_RA_RAM_CMD_ADDR__A, &errCode); status = Read16_0(state, OFDM_SC_RA_RAM_CMD_ADDR__A, &errCode);
if (errCode == 0xFFFF) if (errCode == 0xFFFF) {
{
/* illegal command */ /* illegal command */
return -EINVAL; return -EINVAL;
} }
...@@ -2834,7 +2881,8 @@ static int DVBTScCommand(struct drxk_state *state, ...@@ -2834,7 +2881,8 @@ static int DVBTScCommand(struct drxk_state *state,
/* All commands yielding 1 result */ /* All commands yielding 1 result */
case OFDM_SC_RA_RAM_CMD_USER_IO: case OFDM_SC_RA_RAM_CMD_USER_IO:
case OFDM_SC_RA_RAM_CMD_GET_OP_PARAM: case OFDM_SC_RA_RAM_CMD_GET_OP_PARAM:
status = Read16_0(state, OFDM_SC_RA_RAM_PARAM0__A, &(param0)); status =
Read16_0(state, OFDM_SC_RA_RAM_PARAM0__A, &(param0));
/* All commands yielding 0 results */ /* All commands yielding 0 results */
case OFDM_SC_RA_RAM_CMD_SET_ECHO_TIMING: case OFDM_SC_RA_RAM_CMD_SET_ECHO_TIMING:
case OFDM_SC_RA_RAM_CMD_SET_TIMER: case OFDM_SC_RA_RAM_CMD_SET_TIMER:
...@@ -2851,9 +2899,9 @@ static int DVBTScCommand(struct drxk_state *state, ...@@ -2851,9 +2899,9 @@ static int DVBTScCommand(struct drxk_state *state,
return status; return status;
} }
static int PowerUpDVBT (struct drxk_state *state) static int PowerUpDVBT(struct drxk_state *state)
{ {
DRXPowerMode_t powerMode = DRX_POWER_UP; enum DRXPowerMode powerMode = DRX_POWER_UP;
int status; int status;
do { do {
...@@ -2862,92 +2910,75 @@ static int PowerUpDVBT (struct drxk_state *state) ...@@ -2862,92 +2910,75 @@ static int PowerUpDVBT (struct drxk_state *state)
return status; return status;
} }
static int DVBTCtrlSetIncEnable (struct drxk_state *state, bool* enabled) static int DVBTCtrlSetIncEnable(struct drxk_state *state, bool *enabled)
{ {
int status; int status;
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ "\n"));
if (*enabled == true) if (*enabled == true)
{
status = Write16_0(state, IQM_CF_BYPASSDET__A, 0); status = Write16_0(state, IQM_CF_BYPASSDET__A, 0);
}
else else
{
status = Write16_0(state, IQM_CF_BYPASSDET__A, 1); status = Write16_0(state, IQM_CF_BYPASSDET__A, 1);
}
if (status<0)
{
//KdPrintEx((MSG_ERROR " - " __FUNCTION__ " status - %08x\n",status));
}
return status; return status;
} }
#define DEFAULT_FR_THRES_8K 4000
static int DVBTCtrlSetFrEnable (struct drxk_state *state, bool* enabled) #define DEFAULT_FR_THRES_8K 4000
static int DVBTCtrlSetFrEnable(struct drxk_state *state, bool *enabled)
{ {
int status; int status;
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ "\n"));
if (*enabled == true) if (*enabled == true) {
{
/* write mask to 1 */ /* write mask to 1 */
status = Write16_0(state, OFDM_SC_RA_RAM_FR_THRES_8K__A, status = Write16_0(state, OFDM_SC_RA_RAM_FR_THRES_8K__A,
DEFAULT_FR_THRES_8K); DEFAULT_FR_THRES_8K);
} } else {
else
{
/* write mask to 0 */ /* write mask to 0 */
status = Write16_0(state, OFDM_SC_RA_RAM_FR_THRES_8K__A, 0); status = Write16_0(state, OFDM_SC_RA_RAM_FR_THRES_8K__A, 0);
} }
if (status<0)
{
//KdPrintEx((MSG_ERROR " - " __FUNCTION__ " status - %08x\n",status));
}
return status; return status;
} }
static int DVBTCtrlSetEchoThreshold (struct drxk_state *state, static int DVBTCtrlSetEchoThreshold(struct drxk_state *state,
struct DRXKCfgDvbtEchoThres_t* echoThres) struct DRXKCfgDvbtEchoThres_t *echoThres)
{ {
u16 data = 0; u16 data = 0;
int status; int status;
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ "\n"));
do { do {
CHK_ERROR(Read16_0(state, OFDM_SC_RA_RAM_ECHO_THRES__A, &data)); CHK_ERROR(Read16_0
(state, OFDM_SC_RA_RAM_ECHO_THRES__A, &data));
switch (echoThres->fftMode) switch (echoThres->fftMode) {
{
case DRX_FFTMODE_2K: case DRX_FFTMODE_2K:
data &= ~ OFDM_SC_RA_RAM_ECHO_THRES_2K__M; data &= ~OFDM_SC_RA_RAM_ECHO_THRES_2K__M;
data |= ((echoThres->threshold << OFDM_SC_RA_RAM_ECHO_THRES_2K__B) & data |=
(OFDM_SC_RA_RAM_ECHO_THRES_2K__M)); ((echoThres->threshold <<
OFDM_SC_RA_RAM_ECHO_THRES_2K__B)
& (OFDM_SC_RA_RAM_ECHO_THRES_2K__M));
break; break;
case DRX_FFTMODE_8K: case DRX_FFTMODE_8K:
data &= ~ OFDM_SC_RA_RAM_ECHO_THRES_8K__M; data &= ~OFDM_SC_RA_RAM_ECHO_THRES_8K__M;
data |= ((echoThres->threshold << OFDM_SC_RA_RAM_ECHO_THRES_8K__B) & data |=
(OFDM_SC_RA_RAM_ECHO_THRES_8K__M)); ((echoThres->threshold <<
OFDM_SC_RA_RAM_ECHO_THRES_8K__B)
& (OFDM_SC_RA_RAM_ECHO_THRES_8K__M));
break; break;
default: default:
return -1; return -1;
break; break;
} }
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_ECHO_THRES__A, data)); CHK_ERROR(Write16_0
(state, OFDM_SC_RA_RAM_ECHO_THRES__A, data));
} while (0); } while (0);
if (status<0)
{
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ " status - %08x\n",status));
}
return status; return status;
} }
static int DVBTCtrlSetSqiSpeed(struct drxk_state *state, static int DVBTCtrlSetSqiSpeed(struct drxk_state *state,
enum DRXKCfgDvbtSqiSpeed* speed) enum DRXKCfgDvbtSqiSpeed *speed)
{ {
int status; int status;
...@@ -2959,7 +2990,7 @@ static int DVBTCtrlSetSqiSpeed(struct drxk_state *state, ...@@ -2959,7 +2990,7 @@ static int DVBTCtrlSetSqiSpeed(struct drxk_state *state,
default: default:
return -EINVAL; return -EINVAL;
} }
status = Write16_0 (state,SCU_RAM_FEC_PRE_RS_BER_FILTER_SH__A, status = Write16_0(state, SCU_RAM_FEC_PRE_RS_BER_FILTER_SH__A,
(u16) *speed); (u16) *speed);
return status; return status;
} }
...@@ -2974,33 +3005,27 @@ static int DVBTCtrlSetSqiSpeed(struct drxk_state *state, ...@@ -2974,33 +3005,27 @@ static int DVBTCtrlSetSqiSpeed(struct drxk_state *state,
* Called in DVBTSetStandard * Called in DVBTSetStandard
* *
*/ */
static int DVBTActivatePresets (struct drxk_state *state) static int DVBTActivatePresets(struct drxk_state *state)
{ {
int status; int status;
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ "\n")); struct DRXKCfgDvbtEchoThres_t echoThres2k = { 0, DRX_FFTMODE_2K };
struct DRXKCfgDvbtEchoThres_t echoThres8k = { 0, DRX_FFTMODE_8K };
struct DRXKCfgDvbtEchoThres_t echoThres2k = {0, DRX_FFTMODE_2K};
struct DRXKCfgDvbtEchoThres_t echoThres8k = {0, DRX_FFTMODE_8K};
do { do {
bool setincenable = false; bool setincenable = false;
bool setfrenable = true; bool setfrenable = true;
CHK_ERROR(DVBTCtrlSetIncEnable (state, &setincenable)); CHK_ERROR(DVBTCtrlSetIncEnable(state, &setincenable));
CHK_ERROR(DVBTCtrlSetFrEnable (state, &setfrenable)); CHK_ERROR(DVBTCtrlSetFrEnable(state, &setfrenable));
CHK_ERROR(DVBTCtrlSetEchoThreshold(state, &echoThres2k)); CHK_ERROR(DVBTCtrlSetEchoThreshold(state, &echoThres2k));
CHK_ERROR(DVBTCtrlSetEchoThreshold(state, &echoThres8k)); CHK_ERROR(DVBTCtrlSetEchoThreshold(state, &echoThres8k));
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_INGAIN_TGT_MAX__A, CHK_ERROR(Write16_0(state, SCU_RAM_AGC_INGAIN_TGT_MAX__A,
state->m_dvbtIfAgcCfg.IngainTgtMax)); state->m_dvbtIfAgcCfg.IngainTgtMax));
} while (0); } while (0);
if (status<0)
{
//KdPrintEx((MSG_ERROR " - " __FUNCTION__ " status - %08x\n",status));
}
return status; return status;
} }
/*============================================================================*/ /*============================================================================*/
/** /**
...@@ -3011,29 +3036,41 @@ static int DVBTActivatePresets (struct drxk_state *state) ...@@ -3011,29 +3036,41 @@ static int DVBTActivatePresets (struct drxk_state *state)
* For ROM code channel filter taps are loaded from the bootloader. For microcode * For ROM code channel filter taps are loaded from the bootloader. For microcode
* the DVB-T taps from the drxk_filters.h are used. * the DVB-T taps from the drxk_filters.h are used.
*/ */
static int SetDVBTStandard (struct drxk_state *state,enum OperationMode oMode) static int SetDVBTStandard(struct drxk_state *state,
enum OperationMode oMode)
{ {
u16 cmdResult = 0; u16 cmdResult = 0;
u16 data = 0; u16 data = 0;
int status; int status;
//printk("%s\n", __FUNCTION__);
PowerUpDVBT(state); PowerUpDVBT(state);
do { do {
/* added antenna switch */ /* added antenna switch */
SwitchAntennaToDVBT(state); SwitchAntennaToDVBT(state);
/* send OFDM reset command */ /* send OFDM reset command */
CHK_ERROR(scu_command(state,SCU_RAM_COMMAND_STANDARD_OFDM | SCU_RAM_COMMAND_CMD_DEMOD_RESET,0,NULL,1,&cmdResult)); CHK_ERROR(scu_command
(state,
SCU_RAM_COMMAND_STANDARD_OFDM |
SCU_RAM_COMMAND_CMD_DEMOD_RESET, 0, NULL, 1,
&cmdResult));
/* send OFDM setenv command */ /* send OFDM setenv command */
CHK_ERROR(scu_command(state,SCU_RAM_COMMAND_STANDARD_OFDM | SCU_RAM_COMMAND_CMD_DEMOD_SET_ENV,0,NULL,1,&cmdResult)); CHK_ERROR(scu_command
(state,
SCU_RAM_COMMAND_STANDARD_OFDM |
SCU_RAM_COMMAND_CMD_DEMOD_SET_ENV, 0, NULL, 1,
&cmdResult));
/* reset datapath for OFDM, processors first */ /* reset datapath for OFDM, processors first */
CHK_ERROR(Write16_0(state, OFDM_SC_COMM_EXEC__A, OFDM_SC_COMM_EXEC_STOP)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, OFDM_LC_COMM_EXEC__A, OFDM_LC_COMM_EXEC_STOP)); (state, OFDM_SC_COMM_EXEC__A,
CHK_ERROR(Write16_0(state, IQM_COMM_EXEC__A, IQM_COMM_EXEC_B_STOP )); OFDM_SC_COMM_EXEC_STOP));
CHK_ERROR(Write16_0
(state, OFDM_LC_COMM_EXEC__A,
OFDM_LC_COMM_EXEC_STOP));
CHK_ERROR(Write16_0
(state, IQM_COMM_EXEC__A, IQM_COMM_EXEC_B_STOP));
/* IQM setup */ /* IQM setup */
/* synchronize on ofdstate->m_festart */ /* synchronize on ofdstate->m_festart */
...@@ -3043,8 +3080,9 @@ static int SetDVBTStandard (struct drxk_state *state,enum OperationMode oMode) ...@@ -3043,8 +3080,9 @@ static int SetDVBTStandard (struct drxk_state *state,enum OperationMode oMode)
/* window size for for sense pre-SAW detection */ /* window size for for sense pre-SAW detection */
CHK_ERROR(Write16_0(state, IQM_AF_SNS_LEN__A, 0)); CHK_ERROR(Write16_0(state, IQM_AF_SNS_LEN__A, 0));
/* sense threshold for sense pre-SAW detection */ /* sense threshold for sense pre-SAW detection */
CHK_ERROR(Write16_0(state, IQM_AF_AMUX__A, IQM_AF_AMUX_SIGNAL2ADC)); CHK_ERROR(Write16_0
CHK_ERROR(SetIqmAf(state,true)); (state, IQM_AF_AMUX__A, IQM_AF_AMUX_SIGNAL2ADC));
CHK_ERROR(SetIqmAf(state, true));
CHK_ERROR(Write16_0(state, IQM_AF_AGC_RF__A, 0)); CHK_ERROR(Write16_0(state, IQM_AF_AGC_RF__A, 0));
...@@ -3072,37 +3110,47 @@ static int SetDVBTStandard (struct drxk_state *state,enum OperationMode oMode) ...@@ -3072,37 +3110,47 @@ static int SetDVBTStandard (struct drxk_state *state,enum OperationMode oMode)
CHK_ERROR(Write16_0(state, IQM_CF_POW_MEAS_LEN__A, 2)); CHK_ERROR(Write16_0(state, IQM_CF_POW_MEAS_LEN__A, 2));
/* enable power measurement interrupt */ /* enable power measurement interrupt */
CHK_ERROR(Write16_0(state, IQM_CF_COMM_INT_MSK__A, 1)); CHK_ERROR(Write16_0(state, IQM_CF_COMM_INT_MSK__A, 1));
CHK_ERROR(Write16_0(state, IQM_COMM_EXEC__A, IQM_COMM_EXEC_B_ACTIVE)); CHK_ERROR(Write16_0
(state, IQM_COMM_EXEC__A,
IQM_COMM_EXEC_B_ACTIVE));
/* IQM will not be reset from here, sync ADC and update/init AGC */ /* IQM will not be reset from here, sync ADC and update/init AGC */
CHK_ERROR(ADCSynchronization(state)); CHK_ERROR(ADCSynchronization(state));
CHK_ERROR(SetPreSaw(state, &state->m_dvbtPreSawCfg)); CHK_ERROR(SetPreSaw(state, &state->m_dvbtPreSawCfg));
/* Halt SCU to enable safe non-atomic accesses */ /* Halt SCU to enable safe non-atomic accesses */
CHK_ERROR(Write16_0(state,SCU_COMM_EXEC__A, SCU_COMM_EXEC_HOLD)); CHK_ERROR(Write16_0
(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_HOLD));
CHK_ERROR(SetAgcRf(state, &state->m_dvbtRfAgcCfg, true)) ; CHK_ERROR(SetAgcRf(state, &state->m_dvbtRfAgcCfg, true));
CHK_ERROR(SetAgcIf (state, &state->m_dvbtIfAgcCfg, true)); CHK_ERROR(SetAgcIf(state, &state->m_dvbtIfAgcCfg, true));
/* Set Noise Estimation notch width and enable DC fix */ /* Set Noise Estimation notch width and enable DC fix */
CHK_ERROR(Read16_0(state, OFDM_SC_RA_RAM_CONFIG__A, &data)); CHK_ERROR(Read16_0
(state, OFDM_SC_RA_RAM_CONFIG__A, &data));
data |= OFDM_SC_RA_RAM_CONFIG_NE_FIX_ENABLE__M; data |= OFDM_SC_RA_RAM_CONFIG_NE_FIX_ENABLE__M;
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_CONFIG__A, data)); CHK_ERROR(Write16_0
(state, OFDM_SC_RA_RAM_CONFIG__A, data));
/* Activate SCU to enable SCU commands */ /* Activate SCU to enable SCU commands */
CHK_ERROR(Write16_0(state,SCU_COMM_EXEC__A, SCU_COMM_EXEC_ACTIVE)); CHK_ERROR(Write16_0
(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_ACTIVE));
if (!state->m_DRXK_A3_ROM_CODE) if (!state->m_DRXK_A3_ROM_CODE) {
{
/* AGCInit() is not done for DVBT, so set agcFastClipCtrlDelay */ /* AGCInit() is not done for DVBT, so set agcFastClipCtrlDelay */
CHK_ERROR(Write16_0(state, SCU_RAM_AGC_FAST_CLP_CTRL_DELAY__A, CHK_ERROR(Write16_0
state->m_dvbtIfAgcCfg.FastClipCtrlDelay)); (state,
SCU_RAM_AGC_FAST_CLP_CTRL_DELAY__A,
state->
m_dvbtIfAgcCfg.FastClipCtrlDelay));
} }
/* OFDM_SC setup */ /* OFDM_SC setup */
#ifdef COMPILE_FOR_NONRT #ifdef COMPILE_FOR_NONRT
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_BE_OPT_DELAY__A, 1)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_BE_OPT_INIT_DELAY__A, 2)); (state, OFDM_SC_RA_RAM_BE_OPT_DELAY__A, 1));
CHK_ERROR(Write16_0
(state, OFDM_SC_RA_RAM_BE_OPT_INIT_DELAY__A, 2));
#endif #endif
/* FEC setup */ /* FEC setup */
...@@ -3110,23 +3158,24 @@ static int SetDVBTStandard (struct drxk_state *state,enum OperationMode oMode) ...@@ -3110,23 +3158,24 @@ static int SetDVBTStandard (struct drxk_state *state,enum OperationMode oMode)
#ifdef COMPILE_FOR_NONRT #ifdef COMPILE_FOR_NONRT
CHK_ERROR(Write16_0(state, FEC_RS_MEASUREMENT_PERIOD__A , 0x400)); CHK_ERROR(Write16_0
(state, FEC_RS_MEASUREMENT_PERIOD__A, 0x400));
#else #else
CHK_ERROR(Write16_0(state, FEC_RS_MEASUREMENT_PERIOD__A , 0x1000)); CHK_ERROR(Write16_0
(state, FEC_RS_MEASUREMENT_PERIOD__A, 0x1000));
#endif #endif
CHK_ERROR(Write16_0(state, FEC_RS_MEASUREMENT_PRESCALE__A , 0x0001)); CHK_ERROR(Write16_0
(state, FEC_RS_MEASUREMENT_PRESCALE__A, 0x0001));
/* Setup MPEG bus */ /* Setup MPEG bus */
CHK_ERROR(MPEGTSDtoSetup (state,OM_DVBT)); CHK_ERROR(MPEGTSDtoSetup(state, OM_DVBT));
/* Set DVBT Presets */ /* Set DVBT Presets */
CHK_ERROR (DVBTActivatePresets (state)); CHK_ERROR(DVBTActivatePresets(state));
} while (0); } while (0);
if (status<0) if (status < 0)
{ printk(KERN_ERR "%s status - %08x\n", __func__, status);
printk("%s status - %08x\n",__FUNCTION__,status);
}
return status; return status;
} }
...@@ -3140,21 +3189,23 @@ static int SetDVBTStandard (struct drxk_state *state,enum OperationMode oMode) ...@@ -3140,21 +3189,23 @@ static int SetDVBTStandard (struct drxk_state *state,enum OperationMode oMode)
static int DVBTStart(struct drxk_state *state) static int DVBTStart(struct drxk_state *state)
{ {
u16 param1; u16 param1;
int status; int status;
// DRXKOfdmScCmd_t scCmd; /* DRXKOfdmScCmd_t scCmd; */
//printk("%s\n",__FUNCTION__);
/* Start correct processes to get in lock */ /* Start correct processes to get in lock */
/* DRXK: OFDM_SC_RA_RAM_PROC_LOCKTRACK is no longer in mapfile! */ /* DRXK: OFDM_SC_RA_RAM_PROC_LOCKTRACK is no longer in mapfile! */
do { do {
param1 = OFDM_SC_RA_RAM_LOCKTRACK_MIN; param1 = OFDM_SC_RA_RAM_LOCKTRACK_MIN;
CHK_ERROR(DVBTScCommand(state,OFDM_SC_RA_RAM_CMD_PROC_START,0,OFDM_SC_RA_RAM_SW_EVENT_RUN_NMASK__M,param1,0,0,0)); CHK_ERROR(DVBTScCommand
(state, OFDM_SC_RA_RAM_CMD_PROC_START, 0,
OFDM_SC_RA_RAM_SW_EVENT_RUN_NMASK__M, param1, 0,
0, 0));
/* Start FEC OC */ /* Start FEC OC */
CHK_ERROR(MPEGTSStart(state)); CHK_ERROR(MPEGTSStart(state));
CHK_ERROR(Write16_0(state,FEC_COMM_EXEC__A, FEC_COMM_EXEC_ACTIVE)); CHK_ERROR(Write16_0
(state, FEC_COMM_EXEC__A, FEC_COMM_EXEC_ACTIVE));
} while (0); } while (0);
return (status); return status;
} }
...@@ -3166,7 +3217,8 @@ static int DVBTStart(struct drxk_state *state) ...@@ -3166,7 +3217,8 @@ static int DVBTStart(struct drxk_state *state)
* \return DRXStatus_t. * \return DRXStatus_t.
* // original DVBTSetChannel() * // original DVBTSetChannel()
*/ */
static int SetDVBT (struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerFreqOffset) static int SetDVBT(struct drxk_state *state, u16 IntermediateFreqkHz,
s32 tunerFreqOffset)
{ {
u16 cmdResult = 0; u16 cmdResult = 0;
u16 transmissionParams = 0; u16 transmissionParams = 0;
...@@ -3176,139 +3228,171 @@ static int SetDVBT (struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerF ...@@ -3176,139 +3228,171 @@ static int SetDVBT (struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerF
u16 param1; u16 param1;
int status; int status;
//printk("%s IF =%d, TFO = %d\n",__FUNCTION__,IntermediateFreqkHz,tunerFreqOffset); /* printk(KERN_DEBUG "%s IF =%d, TFO = %d\n", __func__, IntermediateFreqkHz, tunerFreqOffset); */
do { do {
CHK_ERROR(scu_command(state,SCU_RAM_COMMAND_STANDARD_OFDM | CHK_ERROR(scu_command
SCU_RAM_COMMAND_CMD_DEMOD_STOP, (state,
0,NULL,1,&cmdResult)); SCU_RAM_COMMAND_STANDARD_OFDM |
SCU_RAM_COMMAND_CMD_DEMOD_STOP, 0, NULL, 1,
&cmdResult));
/* Halt SCU to enable safe non-atomic accesses */ /* Halt SCU to enable safe non-atomic accesses */
CHK_ERROR(Write16_0(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_HOLD)); CHK_ERROR(Write16_0
(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_HOLD));
/* Stop processors */ /* Stop processors */
CHK_ERROR(Write16_0(state, OFDM_SC_COMM_EXEC__A, OFDM_SC_COMM_EXEC_STOP)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, OFDM_LC_COMM_EXEC__A, OFDM_LC_COMM_EXEC_STOP)); (state, OFDM_SC_COMM_EXEC__A,
OFDM_SC_COMM_EXEC_STOP));
CHK_ERROR(Write16_0
(state, OFDM_LC_COMM_EXEC__A,
OFDM_LC_COMM_EXEC_STOP));
/* Mandatory fix, always stop CP, required to set spl offset back to /* Mandatory fix, always stop CP, required to set spl offset back to
hardware default (is set to 0 by ucode during pilot detection */ hardware default (is set to 0 by ucode during pilot detection */
CHK_ERROR(Write16_0(state, OFDM_CP_COMM_EXEC__A, OFDM_CP_COMM_EXEC_STOP)); CHK_ERROR(Write16_0
(state, OFDM_CP_COMM_EXEC__A,
OFDM_CP_COMM_EXEC_STOP));
/*== Write channel settings to device =====================================*/ /*== Write channel settings to device =====================================*/
/* mode */ /* mode */
switch(state->param.u.ofdm.transmission_mode) { switch (state->param.u.ofdm.transmission_mode) {
case TRANSMISSION_MODE_AUTO: case TRANSMISSION_MODE_AUTO:
default: default:
operationMode |= OFDM_SC_RA_RAM_OP_AUTO_MODE__M; operationMode |= OFDM_SC_RA_RAM_OP_AUTO_MODE__M;
/* fall through , try first guess DRX_FFTMODE_8K */ /* fall through , try first guess DRX_FFTMODE_8K */
case TRANSMISSION_MODE_8K: case TRANSMISSION_MODE_8K:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_MODE_8K; transmissionParams |=
OFDM_SC_RA_RAM_OP_PARAM_MODE_8K;
break; break;
case TRANSMISSION_MODE_2K: case TRANSMISSION_MODE_2K:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_MODE_2K; transmissionParams |=
OFDM_SC_RA_RAM_OP_PARAM_MODE_2K;
break; break;
} }
/* guard */ /* guard */
switch(state->param.u.ofdm.guard_interval) { switch (state->param.u.ofdm.guard_interval) {
default: default:
case GUARD_INTERVAL_AUTO: case GUARD_INTERVAL_AUTO:
operationMode |= OFDM_SC_RA_RAM_OP_AUTO_GUARD__M; operationMode |= OFDM_SC_RA_RAM_OP_AUTO_GUARD__M;
/* fall through , try first guess DRX_GUARD_1DIV4 */ /* fall through , try first guess DRX_GUARD_1DIV4 */
case GUARD_INTERVAL_1_4: case GUARD_INTERVAL_1_4:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_GUARD_4; transmissionParams |=
OFDM_SC_RA_RAM_OP_PARAM_GUARD_4;
break; break;
case GUARD_INTERVAL_1_32: case GUARD_INTERVAL_1_32:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_GUARD_32; transmissionParams |=
OFDM_SC_RA_RAM_OP_PARAM_GUARD_32;
break; break;
case GUARD_INTERVAL_1_16: case GUARD_INTERVAL_1_16:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_GUARD_16; transmissionParams |=
OFDM_SC_RA_RAM_OP_PARAM_GUARD_16;
break; break;
case GUARD_INTERVAL_1_8: case GUARD_INTERVAL_1_8:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_GUARD_8; transmissionParams |=
OFDM_SC_RA_RAM_OP_PARAM_GUARD_8;
break; break;
} }
/* hierarchy */ /* hierarchy */
switch(state->param.u.ofdm.hierarchy_information) { switch (state->param.u.ofdm.hierarchy_information) {
case HIERARCHY_AUTO: case HIERARCHY_AUTO:
case HIERARCHY_NONE: case HIERARCHY_NONE:
default: default:
operationMode |= OFDM_SC_RA_RAM_OP_AUTO_HIER__M; operationMode |= OFDM_SC_RA_RAM_OP_AUTO_HIER__M;
/* fall through , try first guess SC_RA_RAM_OP_PARAM_HIER_NO */ /* fall through , try first guess SC_RA_RAM_OP_PARAM_HIER_NO */
// transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_HIER_NO; /* transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_HIER_NO; */
//break; /* break; */
case HIERARCHY_1: case HIERARCHY_1:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_HIER_A1; transmissionParams |=
OFDM_SC_RA_RAM_OP_PARAM_HIER_A1;
break; break;
case HIERARCHY_2: case HIERARCHY_2:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_HIER_A2; transmissionParams |=
OFDM_SC_RA_RAM_OP_PARAM_HIER_A2;
break; break;
case HIERARCHY_4: case HIERARCHY_4:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_HIER_A4; transmissionParams |=
OFDM_SC_RA_RAM_OP_PARAM_HIER_A4;
break; break;
} }
/* constellation */ /* constellation */
switch(state->param.u.ofdm.constellation) { switch (state->param.u.ofdm.constellation) {
case QAM_AUTO: case QAM_AUTO:
default: default:
operationMode |= OFDM_SC_RA_RAM_OP_AUTO_CONST__M; operationMode |= OFDM_SC_RA_RAM_OP_AUTO_CONST__M;
/* fall through , try first guess DRX_CONSTELLATION_QAM64 */ /* fall through , try first guess DRX_CONSTELLATION_QAM64 */
case QAM_64: case QAM_64:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_CONST_QAM64; transmissionParams |=
OFDM_SC_RA_RAM_OP_PARAM_CONST_QAM64;
break; break;
case QPSK: case QPSK:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_CONST_QPSK; transmissionParams |=
OFDM_SC_RA_RAM_OP_PARAM_CONST_QPSK;
break; break;
case QAM_16: case QAM_16:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_CONST_QAM16; transmissionParams |=
OFDM_SC_RA_RAM_OP_PARAM_CONST_QAM16;
break; break;
} }
#if 0 #if 0
// No hierachical channels support in BDA /* No hierachical channels support in BDA */
/* Priority (only for hierarchical channels) */ /* Priority (only for hierarchical channels) */
switch (channel->priority) { switch (channel->priority) {
case DRX_PRIORITY_LOW : case DRX_PRIORITY_LOW:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_PRIO_LO; transmissionParams |=
WR16(devAddr, OFDM_EC_SB_PRIOR__A, OFDM_EC_SB_PRIOR_LO); OFDM_SC_RA_RAM_OP_PARAM_PRIO_LO;
WR16(devAddr, OFDM_EC_SB_PRIOR__A,
OFDM_EC_SB_PRIOR_LO);
break; break;
case DRX_PRIORITY_HIGH : case DRX_PRIORITY_HIGH:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_PRIO_HI; transmissionParams |=
WR16(devAddr, OFDM_EC_SB_PRIOR__A, OFDM_EC_SB_PRIOR_HI)); OFDM_SC_RA_RAM_OP_PARAM_PRIO_HI;
WR16(devAddr, OFDM_EC_SB_PRIOR__A,
OFDM_EC_SB_PRIOR_HI));
break; break;
case DRX_PRIORITY_UNKNOWN : /* fall through */ case DRX_PRIORITY_UNKNOWN: /* fall through */
default: default:
return (DRX_STS_INVALID_ARG); return DRX_STS_INVALID_ARG;
break; break;
} }
#else #else
// Set Priorty high /* Set Priorty high */
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_PRIO_HI; transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_PRIO_HI;
CHK_ERROR(Write16_0(state, OFDM_EC_SB_PRIOR__A, OFDM_EC_SB_PRIOR_HI)); CHK_ERROR(Write16_0
(state, OFDM_EC_SB_PRIOR__A,
OFDM_EC_SB_PRIOR_HI));
#endif #endif
/* coderate */ /* coderate */
switch(state->param.u.ofdm.code_rate_HP) { switch (state->param.u.ofdm.code_rate_HP) {
case FEC_AUTO: case FEC_AUTO:
default: default:
operationMode |= OFDM_SC_RA_RAM_OP_AUTO_RATE__M; operationMode |= OFDM_SC_RA_RAM_OP_AUTO_RATE__M;
/* fall through , try first guess DRX_CODERATE_2DIV3 */ /* fall through , try first guess DRX_CODERATE_2DIV3 */
case FEC_2_3 : case FEC_2_3:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_RATE_2_3; transmissionParams |=
OFDM_SC_RA_RAM_OP_PARAM_RATE_2_3;
break; break;
case FEC_1_2 : case FEC_1_2:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_RATE_1_2; transmissionParams |=
OFDM_SC_RA_RAM_OP_PARAM_RATE_1_2;
break; break;
case FEC_3_4 : case FEC_3_4:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_RATE_3_4; transmissionParams |=
OFDM_SC_RA_RAM_OP_PARAM_RATE_3_4;
break; break;
case FEC_5_6 : case FEC_5_6:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_RATE_5_6; transmissionParams |=
OFDM_SC_RA_RAM_OP_PARAM_RATE_5_6;
break; break;
case FEC_7_8 : case FEC_7_8:
transmissionParams |= OFDM_SC_RA_RAM_OP_PARAM_RATE_7_8; transmissionParams |=
OFDM_SC_RA_RAM_OP_PARAM_RATE_7_8;
break; break;
} }
...@@ -3319,39 +3403,83 @@ static int SetDVBT (struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerF ...@@ -3319,39 +3403,83 @@ static int SetDVBT (struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerF
/* Also set parameters for EC_OC fix, note EC_OC_REG_TMD_HIL_MAR is changed /* Also set parameters for EC_OC fix, note EC_OC_REG_TMD_HIL_MAR is changed
by SC for fix for some 8K,1/8 guard but is restored by InitEC and ResetEC by SC for fix for some 8K,1/8 guard but is restored by InitEC and ResetEC
functions */ functions */
switch(state->param.u.ofdm.bandwidth) { switch (state->param.u.ofdm.bandwidth) {
case BANDWIDTH_AUTO: case BANDWIDTH_AUTO:
case BANDWIDTH_8_MHZ: case BANDWIDTH_8_MHZ:
bandwidth = DRXK_BANDWIDTH_8MHZ_IN_HZ; bandwidth = DRXK_BANDWIDTH_8MHZ_IN_HZ;
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_SRMM_FIX_FACT_8K__A, 3052)); CHK_ERROR(Write16_0
(state,
OFDM_SC_RA_RAM_SRMM_FIX_FACT_8K__A,
3052));
/* cochannel protection for PAL 8 MHz */ /* cochannel protection for PAL 8 MHz */
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_NI_INIT_8K_PER_LEFT__A, 7)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_NI_INIT_8K_PER_RIGHT__A, 7)); (state,
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_NI_INIT_2K_PER_LEFT__A, 7)); OFDM_SC_RA_RAM_NI_INIT_8K_PER_LEFT__A,
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_NI_INIT_2K_PER_RIGHT__A, 1)); 7));
CHK_ERROR(Write16_0
(state,
OFDM_SC_RA_RAM_NI_INIT_8K_PER_RIGHT__A,
7));
CHK_ERROR(Write16_0
(state,
OFDM_SC_RA_RAM_NI_INIT_2K_PER_LEFT__A,
7));
CHK_ERROR(Write16_0
(state,
OFDM_SC_RA_RAM_NI_INIT_2K_PER_RIGHT__A,
1));
break; break;
case BANDWIDTH_7_MHZ: case BANDWIDTH_7_MHZ:
bandwidth = DRXK_BANDWIDTH_7MHZ_IN_HZ; bandwidth = DRXK_BANDWIDTH_7MHZ_IN_HZ;
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_SRMM_FIX_FACT_8K__A, 3491)); CHK_ERROR(Write16_0
(state,
OFDM_SC_RA_RAM_SRMM_FIX_FACT_8K__A,
3491));
/* cochannel protection for PAL 7 MHz */ /* cochannel protection for PAL 7 MHz */
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_NI_INIT_8K_PER_LEFT__A, 8)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_NI_INIT_8K_PER_RIGHT__A, 8)); (state,
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_NI_INIT_2K_PER_LEFT__A, 4)); OFDM_SC_RA_RAM_NI_INIT_8K_PER_LEFT__A,
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_NI_INIT_2K_PER_RIGHT__A, 1)); 8));
CHK_ERROR(Write16_0
(state,
OFDM_SC_RA_RAM_NI_INIT_8K_PER_RIGHT__A,
8));
CHK_ERROR(Write16_0
(state,
OFDM_SC_RA_RAM_NI_INIT_2K_PER_LEFT__A,
4));
CHK_ERROR(Write16_0
(state,
OFDM_SC_RA_RAM_NI_INIT_2K_PER_RIGHT__A,
1));
break; break;
case BANDWIDTH_6_MHZ: case BANDWIDTH_6_MHZ:
bandwidth = DRXK_BANDWIDTH_6MHZ_IN_HZ; bandwidth = DRXK_BANDWIDTH_6MHZ_IN_HZ;
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_SRMM_FIX_FACT_8K__A, 4073)); CHK_ERROR(Write16_0
(state,
OFDM_SC_RA_RAM_SRMM_FIX_FACT_8K__A,
4073));
/* cochannel protection for NTSC 6 MHz */ /* cochannel protection for NTSC 6 MHz */
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_NI_INIT_8K_PER_LEFT__A, 19)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_NI_INIT_8K_PER_RIGHT__A, 19)); (state,
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_NI_INIT_2K_PER_LEFT__A, 14)); OFDM_SC_RA_RAM_NI_INIT_8K_PER_LEFT__A,
CHK_ERROR(Write16_0(state, OFDM_SC_RA_RAM_NI_INIT_2K_PER_RIGHT__A, 1)); 19));
CHK_ERROR(Write16_0
(state,
OFDM_SC_RA_RAM_NI_INIT_8K_PER_RIGHT__A,
19));
CHK_ERROR(Write16_0
(state,
OFDM_SC_RA_RAM_NI_INIT_2K_PER_LEFT__A,
14));
CHK_ERROR(Write16_0
(state,
OFDM_SC_RA_RAM_NI_INIT_2K_PER_RIGHT__A,
1));
break; break;
} }
if (iqmRcRateOfs == 0) if (iqmRcRateOfs == 0) {
{
/* Now compute IQM_RC_RATE_OFS /* Now compute IQM_RC_RATE_OFS
(((SysFreq/BandWidth)/2)/2) -1) * 2^23) (((SysFreq/BandWidth)/2)/2) -1) * 2^23)
=> =>
...@@ -3361,53 +3489,61 @@ static int SetDVBT (struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerF ...@@ -3361,53 +3489,61 @@ static int SetDVBT (struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerF
/* assert (MAX(sysClk)/MIN(bandwidth) < 16) /* assert (MAX(sysClk)/MIN(bandwidth) < 16)
=> assert(MAX(sysClk) < 16*MIN(bandwidth)) => assert(MAX(sysClk) < 16*MIN(bandwidth))
=> assert(109714272 > 48000000) = true so Frac 28 can be used */ => assert(109714272 > 48000000) = true so Frac 28 can be used */
iqmRcRateOfs = Frac28a((u32)((state->m_sysClockFreq * 1000)/3), bandwidth); iqmRcRateOfs = Frac28a((u32)
((state->m_sysClockFreq *
1000) / 3), bandwidth);
/* (SysFreq / BandWidth) * (2^21), rounding before truncating */ /* (SysFreq / BandWidth) * (2^21), rounding before truncating */
if ((iqmRcRateOfs & 0x7fL) >= 0x40) if ((iqmRcRateOfs & 0x7fL) >= 0x40)
{
iqmRcRateOfs += 0x80L; iqmRcRateOfs += 0x80L;
} iqmRcRateOfs = iqmRcRateOfs >> 7;
iqmRcRateOfs = iqmRcRateOfs >> 7 ;
/* ((SysFreq / BandWidth) * (2^21)) - (2^23) */ /* ((SysFreq / BandWidth) * (2^21)) - (2^23) */
iqmRcRateOfs = iqmRcRateOfs - (1<<23); iqmRcRateOfs = iqmRcRateOfs - (1 << 23);
} }
iqmRcRateOfs &= ((((u32)IQM_RC_RATE_OFS_HI__M)<<IQM_RC_RATE_OFS_LO__W) | iqmRcRateOfs &=
IQM_RC_RATE_OFS_LO__M); ((((u32) IQM_RC_RATE_OFS_HI__M) <<
CHK_ERROR(Write32(state, IQM_RC_RATE_OFS_LO__A, iqmRcRateOfs,0)); IQM_RC_RATE_OFS_LO__W) | IQM_RC_RATE_OFS_LO__M);
CHK_ERROR(Write32
(state, IQM_RC_RATE_OFS_LO__A, iqmRcRateOfs, 0));
/* Bandwidth setting done */ /* Bandwidth setting done */
// CHK_ERROR(DVBTSetFrequencyShift(demod, channel, tunerOffset)); /* CHK_ERROR(DVBTSetFrequencyShift(demod, channel, tunerOffset)); */
CHK_ERROR (SetFrequencyShifter (state, IntermediateFreqkHz, tunerFreqOffset, true)); CHK_ERROR(SetFrequencyShifter
(state, IntermediateFreqkHz, tunerFreqOffset,
true));
/*== Start SC, write channel settings to SC ===============================*/ /*== Start SC, write channel settings to SC ===============================*/
/* Activate SCU to enable SCU commands */ /* Activate SCU to enable SCU commands */
CHK_ERROR(Write16_0(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_ACTIVE)); CHK_ERROR(Write16_0
(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_ACTIVE));
/* Enable SC after setting all other parameters */ /* Enable SC after setting all other parameters */
CHK_ERROR(Write16_0(state, OFDM_SC_COMM_STATE__A, 0)); CHK_ERROR(Write16_0(state, OFDM_SC_COMM_STATE__A, 0));
CHK_ERROR(Write16_0(state, OFDM_SC_COMM_EXEC__A, 1)); CHK_ERROR(Write16_0(state, OFDM_SC_COMM_EXEC__A, 1));
CHK_ERROR(scu_command(state,SCU_RAM_COMMAND_STANDARD_OFDM | CHK_ERROR(scu_command
SCU_RAM_COMMAND_CMD_DEMOD_START,0,NULL,1,&cmdResult)); (state,
SCU_RAM_COMMAND_STANDARD_OFDM |
SCU_RAM_COMMAND_CMD_DEMOD_START, 0, NULL, 1,
&cmdResult));
/* Write SC parameter registers, set all AUTO flags in operation mode */ /* Write SC parameter registers, set all AUTO flags in operation mode */
param1 = (OFDM_SC_RA_RAM_OP_AUTO_MODE__M | param1 = (OFDM_SC_RA_RAM_OP_AUTO_MODE__M |
OFDM_SC_RA_RAM_OP_AUTO_GUARD__M | OFDM_SC_RA_RAM_OP_AUTO_GUARD__M |
OFDM_SC_RA_RAM_OP_AUTO_CONST__M | OFDM_SC_RA_RAM_OP_AUTO_CONST__M |
OFDM_SC_RA_RAM_OP_AUTO_HIER__M | OFDM_SC_RA_RAM_OP_AUTO_HIER__M |
OFDM_SC_RA_RAM_OP_AUTO_RATE__M ); OFDM_SC_RA_RAM_OP_AUTO_RATE__M);
status = DVBTScCommand(state,OFDM_SC_RA_RAM_CMD_SET_PREF_PARAM,0,transmissionParams,param1,0,0,0); status =
DVBTScCommand(state, OFDM_SC_RA_RAM_CMD_SET_PREF_PARAM,
0, transmissionParams, param1, 0, 0, 0);
if (!state->m_DRXK_A3_ROM_CODE) if (!state->m_DRXK_A3_ROM_CODE)
CHK_ERROR (DVBTCtrlSetSqiSpeed(state,&state->m_sqiSpeed)); CHK_ERROR(DVBTCtrlSetSqiSpeed
(state, &state->m_sqiSpeed));
} while(0); } while (0);
if (status<0) {
//printk("%s status - %08x\n",__FUNCTION__,status);
}
return status; return status;
} }
...@@ -3426,9 +3562,9 @@ static int GetDVBTLockStatus(struct drxk_state *state, u32 *pLockStatus) ...@@ -3426,9 +3562,9 @@ static int GetDVBTLockStatus(struct drxk_state *state, u32 *pLockStatus)
{ {
int status; int status;
const u16 mpeg_lock_mask = (OFDM_SC_RA_RAM_LOCK_MPEG__M | const u16 mpeg_lock_mask = (OFDM_SC_RA_RAM_LOCK_MPEG__M |
OFDM_SC_RA_RAM_LOCK_FEC__M ); OFDM_SC_RA_RAM_LOCK_FEC__M);
const u16 fec_lock_mask = (OFDM_SC_RA_RAM_LOCK_FEC__M); const u16 fec_lock_mask = (OFDM_SC_RA_RAM_LOCK_FEC__M);
const u16 demod_lock_mask = OFDM_SC_RA_RAM_LOCK_DEMOD__M ; const u16 demod_lock_mask = OFDM_SC_RA_RAM_LOCK_DEMOD__M;
u16 ScRaRamLock = 0; u16 ScRaRamLock = 0;
u16 ScCommExec = 0; u16 ScCommExec = 0;
...@@ -3436,92 +3572,73 @@ static int GetDVBTLockStatus(struct drxk_state *state, u32 *pLockStatus) ...@@ -3436,92 +3572,73 @@ static int GetDVBTLockStatus(struct drxk_state *state, u32 *pLockStatus)
/* driver 0.9.0 */ /* driver 0.9.0 */
/* Check if SC is running */ /* Check if SC is running */
status = Read16_0(state, OFDM_SC_COMM_EXEC__A, &ScCommExec); status = Read16_0(state, OFDM_SC_COMM_EXEC__A, &ScCommExec);
if (ScCommExec == OFDM_SC_COMM_EXEC_STOP) if (ScCommExec == OFDM_SC_COMM_EXEC_STOP) {
{
/* SC not active; return DRX_NOT_LOCKED */ /* SC not active; return DRX_NOT_LOCKED */
*pLockStatus = NOT_LOCKED; *pLockStatus = NOT_LOCKED;
return status; return status;
} }
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ "\n"));
status = Read16_0(state, OFDM_SC_RA_RAM_LOCK__A, &ScRaRamLock); status = Read16_0(state, OFDM_SC_RA_RAM_LOCK__A, &ScRaRamLock);
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ "RamLock: %04X\n",ScRaRamLock)); if ((ScRaRamLock & mpeg_lock_mask) == mpeg_lock_mask)
if ((ScRaRamLock & mpeg_lock_mask) == mpeg_lock_mask) {
*pLockStatus = MPEG_LOCK; *pLockStatus = MPEG_LOCK;
} else if ((ScRaRamLock & fec_lock_mask) == fec_lock_mask) { else if ((ScRaRamLock & fec_lock_mask) == fec_lock_mask)
*pLockStatus = FEC_LOCK; *pLockStatus = FEC_LOCK;
} else if ((ScRaRamLock & demod_lock_mask) == demod_lock_mask) { else if ((ScRaRamLock & demod_lock_mask) == demod_lock_mask)
*pLockStatus = DEMOD_LOCK; *pLockStatus = DEMOD_LOCK;
} else if (ScRaRamLock & OFDM_SC_RA_RAM_LOCK_NODVBT__M) { else if (ScRaRamLock & OFDM_SC_RA_RAM_LOCK_NODVBT__M)
*pLockStatus = NEVER_LOCK; *pLockStatus = NEVER_LOCK;
} else { else
*pLockStatus = NOT_LOCKED; *pLockStatus = NOT_LOCKED;
}
if (status<0)
{
//KdPrintEx((MSG_ERROR " - " __FUNCTION__ " status - %08x\n",status));
}
return status; return status;
} }
static int PowerUpQAM (struct drxk_state *state) static int PowerUpQAM(struct drxk_state *state)
{ {
DRXPowerMode_t powerMode = DRXK_POWER_DOWN_OFDM; enum DRXPowerMode powerMode = DRXK_POWER_DOWN_OFDM;
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ "\n"));
int status = 0; int status = 0;
do
{ do {
CHK_ERROR(CtrlPowerMode(state, &powerMode)); CHK_ERROR(CtrlPowerMode(state, &powerMode));
}while(0); } while (0);
if (status<0)
{
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ " status - %08x\n",status));
}
return status; return status;
} }
/// Power Down QAM /** Power Down QAM */
static int PowerDownQAM(struct drxk_state *state) static int PowerDownQAM(struct drxk_state *state)
{ {
u16 data = 0; u16 data = 0;
u16 cmdResult; u16 cmdResult;
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ "\n"));
int status = 0; int status = 0;
do
{ do {
CHK_ERROR(Read16_0(state, SCU_COMM_EXEC__A, &data)); CHK_ERROR(Read16_0(state, SCU_COMM_EXEC__A, &data));
if (data == SCU_COMM_EXEC_ACTIVE) if (data == SCU_COMM_EXEC_ACTIVE) {
{
/* /*
STOP demodulator STOP demodulator
QAM and HW blocks QAM and HW blocks
*/ */
/* stop all comstate->m_exec */ /* stop all comstate->m_exec */
CHK_ERROR(Write16_0(state, QAM_COMM_EXEC__A, QAM_COMM_EXEC_STOP)); CHK_ERROR(Write16_0
CHK_ERROR(scu_command(state,SCU_RAM_COMMAND_STANDARD_QAM | SCU_RAM_COMMAND_CMD_DEMOD_STOP,0,NULL,1,&cmdResult)); (state, QAM_COMM_EXEC__A,
QAM_COMM_EXEC_STOP));
CHK_ERROR(scu_command
(state,
SCU_RAM_COMMAND_STANDARD_QAM |
SCU_RAM_COMMAND_CMD_DEMOD_STOP, 0, NULL,
1, &cmdResult));
} }
/* powerdown AFE */ /* powerdown AFE */
CHK_ERROR(SetIqmAf(state, false)); CHK_ERROR(SetIqmAf(state, false));
} } while (0);
while(0);
if (status<0)
{
//KdPrintEx((MSG_ERROR " - " __FUNCTION__ " status - %08x\n",status));
}
return status; return status;
} }
/*============================================================================*/ /*============================================================================*/
/** /**
...@@ -3539,8 +3656,6 @@ static int SetQAMMeasurement(struct drxk_state *state, ...@@ -3539,8 +3656,6 @@ static int SetQAMMeasurement(struct drxk_state *state,
enum EDrxkConstellation constellation, enum EDrxkConstellation constellation,
u32 symbolRate) u32 symbolRate)
{ {
//KdPrintEx((MSG_ERROR " - " __FUNCTION__ "(%d,%d) om = %d\n", constellation, symbolRate,state->m_OperationMode));
u32 fecBitsDesired = 0; /* BER accounting period */ u32 fecBitsDesired = 0; /* BER accounting period */
u32 fecRsPeriodTotal = 0; /* Total period */ u32 fecRsPeriodTotal = 0; /* Total period */
u16 fecRsPrescale = 0; /* ReedSolomon Measurement Prescale */ u16 fecRsPrescale = 0; /* ReedSolomon Measurement Prescale */
...@@ -3557,8 +3672,7 @@ static int SetQAMMeasurement(struct drxk_state *state, ...@@ -3557,8 +3672,7 @@ static int SetQAMMeasurement(struct drxk_state *state,
SyncLoss (== 1) * SyncLoss (== 1) *
ViterbiLoss (==1) ViterbiLoss (==1)
*/ */
switch (constellation) switch (constellation) {
{
case DRX_CONSTELLATION_QAM16: case DRX_CONSTELLATION_QAM16:
fecBitsDesired = 4 * symbolRate; fecBitsDesired = 4 * symbolRate;
break; break;
...@@ -3584,7 +3698,7 @@ static int SetQAMMeasurement(struct drxk_state *state, ...@@ -3584,7 +3698,7 @@ static int SetQAMMeasurement(struct drxk_state *state,
/* Annex A/C: bits/RsPeriod = 204 * 8 = 1632 */ /* Annex A/C: bits/RsPeriod = 204 * 8 = 1632 */
/* fecRsPeriodTotal = fecBitsDesired / 1632 */ /* fecRsPeriodTotal = fecBitsDesired / 1632 */
fecRsPeriodTotal = (fecBitsDesired / 1632UL) + 1; /* roughly ceil*/ fecRsPeriodTotal = (fecBitsDesired / 1632UL) + 1; /* roughly ceil */
/* fecRsPeriodTotal = fecRsPrescale * fecRsPeriod */ /* fecRsPeriodTotal = fecRsPrescale * fecRsPeriod */
fecRsPrescale = 1 + (u16) (fecRsPeriodTotal >> 16); fecRsPrescale = 1 + (u16) (fecRsPeriodTotal >> 16);
...@@ -3593,36 +3707,47 @@ static int SetQAMMeasurement(struct drxk_state *state, ...@@ -3593,36 +3707,47 @@ static int SetQAMMeasurement(struct drxk_state *state,
status = -1; status = -1;
} }
CHK_ERROR(status); CHK_ERROR(status);
fecRsPeriod = ((u16) fecRsPeriodTotal + (fecRsPrescale >> 1)) / fecRsPeriod =
fecRsPrescale; ((u16) fecRsPeriodTotal +
(fecRsPrescale >> 1)) / fecRsPrescale;
/* write corresponding registers */ /* write corresponding registers */
CHK_ERROR(Write16_0(state, FEC_RS_MEASUREMENT_PERIOD__A, fecRsPeriod)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, FEC_RS_MEASUREMENT_PRESCALE__A, fecRsPrescale)); (state, FEC_RS_MEASUREMENT_PERIOD__A,
CHK_ERROR(Write16_0(state, FEC_OC_SNC_FAIL_PERIOD__A, fecRsPeriod)); fecRsPeriod));
CHK_ERROR(Write16_0
(state, FEC_RS_MEASUREMENT_PRESCALE__A,
fecRsPrescale));
CHK_ERROR(Write16_0
(state, FEC_OC_SNC_FAIL_PERIOD__A, fecRsPeriod));
} while (0); } while (0);
if (status<0) { if (status < 0)
printk("%s: status - %08x\n",__FUNCTION__,status); printk(KERN_ERR "%s: status - %08x\n", __func__, status);
}
return status; return status;
} }
static int SetQAM16 (struct drxk_state *state) static int SetQAM16(struct drxk_state *state)
{ {
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ "\n"));
int status = 0; int status = 0;
do
{ do {
/* QAM Equalizer Setup */ /* QAM Equalizer Setup */
/* Equalizer */ /* Equalizer */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD0__A, 13517)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD1__A, 13517)); (state, SCU_RAM_QAM_EQ_CMA_RAD0__A, 13517));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD2__A, 13517)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD3__A, 13517)); (state, SCU_RAM_QAM_EQ_CMA_RAD1__A, 13517));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD4__A, 13517)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD5__A, 13517)); (state, SCU_RAM_QAM_EQ_CMA_RAD2__A, 13517));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_EQ_CMA_RAD3__A, 13517));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_EQ_CMA_RAD4__A, 13517));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_EQ_CMA_RAD5__A, 13517));
/* Decision Feedback Equalizer */ /* Decision Feedback Equalizer */
CHK_ERROR(Write16_0(state, QAM_DQ_QUAL_FUN0__A, 2)); CHK_ERROR(Write16_0(state, QAM_DQ_QUAL_FUN0__A, 2));
CHK_ERROR(Write16_0(state, QAM_DQ_QUAL_FUN1__A, 2)); CHK_ERROR(Write16_0(state, QAM_DQ_QUAL_FUN1__A, 2));
...@@ -3636,30 +3761,45 @@ static int SetQAM16 (struct drxk_state *state) ...@@ -3636,30 +3761,45 @@ static int SetQAM16 (struct drxk_state *state)
CHK_ERROR(Write16_0(state, QAM_SY_SYNC_LWM__A, 3)); CHK_ERROR(Write16_0(state, QAM_SY_SYNC_LWM__A, 3));
/* QAM Slicer Settings */ /* QAM Slicer Settings */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_SL_SIG_POWER__A, DRXK_QAM_SL_SIG_POWER_QAM16)); CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_SL_SIG_POWER__A,
DRXK_QAM_SL_SIG_POWER_QAM16));
/* QAM Loop Controller Coeficients */ /* QAM Loop Controller Coeficients */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CA_FINE__A, 15)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CA_FINE__A, 15));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CA_COARSE__A, 40)); CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CA_COARSE__A, 40));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_FINE__A, 12)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_FINE__A, 12));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_COARSE__A, 24)); (state, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_EP_COARSE__A, 24));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_FINE__A, 12)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_FINE__A, 12));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_COARSE__A, 16)); (state, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_EI_COARSE__A, 16));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_FINE__A, 5)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_FINE__A, 5));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_MEDIUM__A, 20)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_COARSE__A, 80)); (state, SCU_RAM_QAM_LC_CP_MEDIUM__A, 20));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CP_COARSE__A, 80));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_FINE__A, 5)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_FINE__A, 5));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_MEDIUM__A, 20)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_COARSE__A, 50)); (state, SCU_RAM_QAM_LC_CI_MEDIUM__A, 20));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CI_COARSE__A, 50));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_FINE__A, 16)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_FINE__A, 16));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_MEDIUM__A, 16)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_COARSE__A, 32)); (state, SCU_RAM_QAM_LC_CF_MEDIUM__A, 16));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CF_COARSE__A, 32));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_FINE__A, 5)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_FINE__A, 5));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 10)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_COARSE__A, 10)); (state, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 10));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CF1_COARSE__A, 10));
/* QAM State Machine (FSM) Thresholds */ /* QAM State Machine (FSM) Thresholds */
...@@ -3671,26 +3811,39 @@ static int SetQAM16 (struct drxk_state *state) ...@@ -3671,26 +3811,39 @@ static int SetQAM16 (struct drxk_state *state)
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_QTH__A, 230)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_QTH__A, 230));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_MTH__A, 105)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_MTH__A, 105));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_RATE_LIM__A, 40)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_COUNT_LIM__A, 4)); (state, SCU_RAM_QAM_FSM_RATE_LIM__A, 40));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_FREQ_LIM__A, 24)); CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_COUNT_LIM__A, 4));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_FREQ_LIM__A, 24));
/* QAM FSM Tracking Parameters */ /* QAM FSM Tracking Parameters */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A, (u16) 16)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A, (u16) 220)); (state, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A,
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A, (u16) 25)); (u16) 16));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A, (u16) 6)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A, (u16) -24)); (state, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A,
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A, (u16) -65)); (u16) 220));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A, (u16)-127)); CHK_ERROR(Write16_0
}while(0); (state, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A,
(u16) 25));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A,
(u16) 6));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A,
(u16) -24));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A,
(u16) -65));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A,
(u16) -127));
} while (0);
if (status<0)
{
//KdPrintEx((MSG_ERROR " - " __FUNCTION__ " status - %08x\n",status));
}
return status; return status;
} }
...@@ -3701,20 +3854,25 @@ static int SetQAM16 (struct drxk_state *state) ...@@ -3701,20 +3854,25 @@ static int SetQAM16 (struct drxk_state *state)
* \param demod instance of demod. * \param demod instance of demod.
* \return DRXStatus_t. * \return DRXStatus_t.
*/ */
static int SetQAM32 (struct drxk_state *state) static int SetQAM32(struct drxk_state *state)
{ {
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ "\n"));
int status = 0; int status = 0;
do
{ do {
/* QAM Equalizer Setup */ /* QAM Equalizer Setup */
/* Equalizer */ /* Equalizer */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD0__A, 6707)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD1__A, 6707)); (state, SCU_RAM_QAM_EQ_CMA_RAD0__A, 6707));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD2__A, 6707)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD3__A, 6707)); (state, SCU_RAM_QAM_EQ_CMA_RAD1__A, 6707));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD4__A, 6707)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD5__A, 6707)); (state, SCU_RAM_QAM_EQ_CMA_RAD2__A, 6707));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_EQ_CMA_RAD3__A, 6707));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_EQ_CMA_RAD4__A, 6707));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_EQ_CMA_RAD5__A, 6707));
/* Decision Feedback Equalizer */ /* Decision Feedback Equalizer */
CHK_ERROR(Write16_0(state, QAM_DQ_QUAL_FUN0__A, 3)); CHK_ERROR(Write16_0(state, QAM_DQ_QUAL_FUN0__A, 3));
...@@ -3730,32 +3888,47 @@ static int SetQAM32 (struct drxk_state *state) ...@@ -3730,32 +3888,47 @@ static int SetQAM32 (struct drxk_state *state)
/* QAM Slicer Settings */ /* QAM Slicer Settings */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_SL_SIG_POWER__A, DRXK_QAM_SL_SIG_POWER_QAM32)); CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_SL_SIG_POWER__A,
DRXK_QAM_SL_SIG_POWER_QAM32));
/* QAM Loop Controller Coeficients */ /* QAM Loop Controller Coeficients */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CA_FINE__A, 15)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CA_FINE__A, 15));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CA_COARSE__A, 40)); CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CA_COARSE__A, 40));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_FINE__A, 12)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_FINE__A, 12));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_COARSE__A, 24)); (state, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_EP_COARSE__A, 24));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_FINE__A, 12)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_FINE__A, 12));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_COARSE__A, 16)); (state, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_EI_COARSE__A, 16));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_FINE__A, 5)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_FINE__A, 5));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_MEDIUM__A, 20)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_COARSE__A, 80)); (state, SCU_RAM_QAM_LC_CP_MEDIUM__A, 20));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CP_COARSE__A, 80));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_FINE__A, 5)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_FINE__A, 5));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_MEDIUM__A, 20)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_COARSE__A, 50)); (state, SCU_RAM_QAM_LC_CI_MEDIUM__A, 20));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CI_COARSE__A, 50));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_FINE__A, 16)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_FINE__A, 16));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_MEDIUM__A, 16)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_COARSE__A, 16)); (state, SCU_RAM_QAM_LC_CF_MEDIUM__A, 16));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CF_COARSE__A, 16));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_FINE__A, 5)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_FINE__A, 5));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 10)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_COARSE__A, 0)); (state, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 10));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CF1_COARSE__A, 0));
/* QAM State Machine (FSM) Thresholds */ /* QAM State Machine (FSM) Thresholds */
...@@ -3767,26 +3940,39 @@ static int SetQAM32 (struct drxk_state *state) ...@@ -3767,26 +3940,39 @@ static int SetQAM32 (struct drxk_state *state)
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_QTH__A, 170)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_QTH__A, 170));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_MTH__A, 100)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_MTH__A, 100));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_RATE_LIM__A, 40)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_COUNT_LIM__A, 4)); (state, SCU_RAM_QAM_FSM_RATE_LIM__A, 40));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_FREQ_LIM__A, 10)); CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_COUNT_LIM__A, 4));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_FREQ_LIM__A, 10));
/* QAM FSM Tracking Parameters */ /* QAM FSM Tracking Parameters */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A, (u16) 12)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A, (u16) 140)); (state, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A,
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A, (u16) -8)); (u16) 12));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A, (u16) -16)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A, (u16) -26)); (state, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A,
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A, (u16) -56)); (u16) 140));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A, (u16) -86)); CHK_ERROR(Write16_0
}while(0); (state, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A,
(u16) -8));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A,
(u16) -16));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A,
(u16) -26));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A,
(u16) -56));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A,
(u16) -86));
} while (0);
if (status<0)
{
//KdPrintEx((MSG_ERROR " - " __FUNCTION__ " status - %08x\n",status));
}
return status; return status;
} }
...@@ -3797,20 +3983,25 @@ static int SetQAM32 (struct drxk_state *state) ...@@ -3797,20 +3983,25 @@ static int SetQAM32 (struct drxk_state *state)
* \param demod instance of demod. * \param demod instance of demod.
* \return DRXStatus_t. * \return DRXStatus_t.
*/ */
static int SetQAM64 (struct drxk_state *state) static int SetQAM64(struct drxk_state *state)
{ {
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ "\n"));
int status = 0; int status = 0;
do
{ do {
/* QAM Equalizer Setup */ /* QAM Equalizer Setup */
/* Equalizer */ /* Equalizer */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD0__A, 13336)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD1__A, 12618)); (state, SCU_RAM_QAM_EQ_CMA_RAD0__A, 13336));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD2__A, 11988)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD3__A, 13809)); (state, SCU_RAM_QAM_EQ_CMA_RAD1__A, 12618));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD4__A, 13809)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD5__A, 15609)); (state, SCU_RAM_QAM_EQ_CMA_RAD2__A, 11988));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_EQ_CMA_RAD3__A, 13809));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_EQ_CMA_RAD4__A, 13809));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_EQ_CMA_RAD5__A, 15609));
/* Decision Feedback Equalizer */ /* Decision Feedback Equalizer */
CHK_ERROR(Write16_0(state, QAM_DQ_QUAL_FUN0__A, 4)); CHK_ERROR(Write16_0(state, QAM_DQ_QUAL_FUN0__A, 4));
...@@ -3825,32 +4016,47 @@ static int SetQAM64 (struct drxk_state *state) ...@@ -3825,32 +4016,47 @@ static int SetQAM64 (struct drxk_state *state)
CHK_ERROR(Write16_0(state, QAM_SY_SYNC_LWM__A, 3)); CHK_ERROR(Write16_0(state, QAM_SY_SYNC_LWM__A, 3));
/* QAM Slicer Settings */ /* QAM Slicer Settings */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_SL_SIG_POWER__A, DRXK_QAM_SL_SIG_POWER_QAM64)); CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_SL_SIG_POWER__A,
DRXK_QAM_SL_SIG_POWER_QAM64));
/* QAM Loop Controller Coeficients */ /* QAM Loop Controller Coeficients */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CA_FINE__A, 15)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CA_FINE__A, 15));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CA_COARSE__A, 40)); CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CA_COARSE__A, 40));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_FINE__A, 12)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_FINE__A, 12));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_COARSE__A, 24)); (state, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_EP_COARSE__A, 24));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_FINE__A, 12)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_FINE__A, 12));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_COARSE__A, 16)); (state, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_EI_COARSE__A, 16));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_FINE__A, 5)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_FINE__A, 5));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_MEDIUM__A, 30)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_COARSE__A, 100)); (state, SCU_RAM_QAM_LC_CP_MEDIUM__A, 30));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CP_COARSE__A, 100));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_FINE__A, 5)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_FINE__A, 5));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_MEDIUM__A, 30)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_COARSE__A, 50)); (state, SCU_RAM_QAM_LC_CI_MEDIUM__A, 30));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CI_COARSE__A, 50));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_FINE__A, 16)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_FINE__A, 16));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_MEDIUM__A, 25)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_COARSE__A, 48)); (state, SCU_RAM_QAM_LC_CF_MEDIUM__A, 25));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CF_COARSE__A, 48));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_FINE__A, 5)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_FINE__A, 5));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 10)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_COARSE__A, 10)); (state, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 10));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CF1_COARSE__A, 10));
/* QAM State Machine (FSM) Thresholds */ /* QAM State Machine (FSM) Thresholds */
...@@ -3862,26 +4068,39 @@ static int SetQAM64 (struct drxk_state *state) ...@@ -3862,26 +4068,39 @@ static int SetQAM64 (struct drxk_state *state)
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_QTH__A, 200)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_QTH__A, 200));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_MTH__A, 95)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_MTH__A, 95));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_RATE_LIM__A, 40)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_COUNT_LIM__A, 4)); (state, SCU_RAM_QAM_FSM_RATE_LIM__A, 40));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_FREQ_LIM__A, 15)); CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_COUNT_LIM__A, 4));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_FREQ_LIM__A, 15));
/* QAM FSM Tracking Parameters */ /* QAM FSM Tracking Parameters */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A, (u16) 12)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A, (u16) 141)); (state, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A,
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A, (u16) 7)); (u16) 12));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A, (u16) 0)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A, (u16) -15)); (state, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A,
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A, (u16) -45)); (u16) 141));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A, (u16) -80)); CHK_ERROR(Write16_0
}while(0); (state, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A,
(u16) 7));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A,
(u16) 0));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A,
(u16) -15));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A,
(u16) -45));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A,
(u16) -80));
} while (0);
if (status<0)
{
//KdPrintEx((MSG_ERROR " - " __FUNCTION__ " status - %08x\n",status));
}
return status; return status;
} }
...@@ -3894,18 +4113,23 @@ static int SetQAM64 (struct drxk_state *state) ...@@ -3894,18 +4113,23 @@ static int SetQAM64 (struct drxk_state *state)
*/ */
static int SetQAM128(struct drxk_state *state) static int SetQAM128(struct drxk_state *state)
{ {
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ "\n"));
int status = 0; int status = 0;
do
{ do {
/* QAM Equalizer Setup */ /* QAM Equalizer Setup */
/* Equalizer */ /* Equalizer */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD0__A, 6564)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD1__A, 6598)); (state, SCU_RAM_QAM_EQ_CMA_RAD0__A, 6564));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD2__A, 6394)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD3__A, 6409)); (state, SCU_RAM_QAM_EQ_CMA_RAD1__A, 6598));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD4__A, 6656)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD5__A, 7238)); (state, SCU_RAM_QAM_EQ_CMA_RAD2__A, 6394));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_EQ_CMA_RAD3__A, 6409));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_EQ_CMA_RAD4__A, 6656));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_EQ_CMA_RAD5__A, 7238));
/* Decision Feedback Equalizer */ /* Decision Feedback Equalizer */
CHK_ERROR(Write16_0(state, QAM_DQ_QUAL_FUN0__A, 6)); CHK_ERROR(Write16_0(state, QAM_DQ_QUAL_FUN0__A, 6));
...@@ -3922,32 +4146,47 @@ static int SetQAM128(struct drxk_state *state) ...@@ -3922,32 +4146,47 @@ static int SetQAM128(struct drxk_state *state)
/* QAM Slicer Settings */ /* QAM Slicer Settings */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_SL_SIG_POWER__A,DRXK_QAM_SL_SIG_POWER_QAM128)); CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_SL_SIG_POWER__A,
DRXK_QAM_SL_SIG_POWER_QAM128));
/* QAM Loop Controller Coeficients */ /* QAM Loop Controller Coeficients */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CA_FINE__A, 15)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CA_FINE__A, 15));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CA_COARSE__A, 40)); CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CA_COARSE__A, 40));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_FINE__A, 12)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_FINE__A, 12));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_COARSE__A, 24)); (state, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_EP_COARSE__A, 24));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_FINE__A, 12)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_FINE__A, 12));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_COARSE__A, 16)); (state, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_EI_COARSE__A, 16));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_FINE__A, 5)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_FINE__A, 5));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_MEDIUM__A, 40)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_COARSE__A, 120)); (state, SCU_RAM_QAM_LC_CP_MEDIUM__A, 40));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CP_COARSE__A, 120));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_FINE__A, 5)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_FINE__A, 5));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_MEDIUM__A, 40)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_COARSE__A, 60)); (state, SCU_RAM_QAM_LC_CI_MEDIUM__A, 40));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CI_COARSE__A, 60));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_FINE__A, 16)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_FINE__A, 16));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_MEDIUM__A, 25)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_COARSE__A, 64)); (state, SCU_RAM_QAM_LC_CF_MEDIUM__A, 25));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CF_COARSE__A, 64));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_FINE__A, 5)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_FINE__A, 5));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 10)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_COARSE__A, 0)); (state, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 10));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CF1_COARSE__A, 0));
/* QAM State Machine (FSM) Thresholds */ /* QAM State Machine (FSM) Thresholds */
...@@ -3959,26 +4198,39 @@ static int SetQAM128(struct drxk_state *state) ...@@ -3959,26 +4198,39 @@ static int SetQAM128(struct drxk_state *state)
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_QTH__A, 140)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_QTH__A, 140));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_MTH__A, 100)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_MTH__A, 100));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_RATE_LIM__A, 40)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_COUNT_LIM__A, 5)); (state, SCU_RAM_QAM_FSM_RATE_LIM__A, 40));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_COUNT_LIM__A, 5));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_FREQ_LIM__A, 12)); CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_FREQ_LIM__A, 12));
/* QAM FSM Tracking Parameters */ /* QAM FSM Tracking Parameters */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A, (u16) 8)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A, (u16) 65)); (state, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A,
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A, (u16) 5)); (u16) 8));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A, (u16) 3)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A, (u16) -1)); (state, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A,
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A, (u16) -12)); (u16) 65));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A, (u16) -23)); CHK_ERROR(Write16_0
}while(0); (state, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A,
(u16) 5));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A,
(u16) 3));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A,
(u16) -1));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A,
(u16) -12));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A,
(u16) -23));
} while (0);
if (status<0)
{
//KdPrintEx((MSG_ERROR " - " __FUNCTION__ " status - %08x\n",status));
}
return status; return status;
} }
...@@ -3991,18 +4243,23 @@ static int SetQAM128(struct drxk_state *state) ...@@ -3991,18 +4243,23 @@ static int SetQAM128(struct drxk_state *state)
*/ */
static int SetQAM256(struct drxk_state *state) static int SetQAM256(struct drxk_state *state)
{ {
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ "\n"));
int status = 0; int status = 0;
do
{ do {
/* QAM Equalizer Setup */ /* QAM Equalizer Setup */
/* Equalizer */ /* Equalizer */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD0__A, 11502)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD1__A, 12084)); (state, SCU_RAM_QAM_EQ_CMA_RAD0__A, 11502));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD2__A, 12543)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD3__A, 12931)); (state, SCU_RAM_QAM_EQ_CMA_RAD1__A, 12084));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD4__A, 13629)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_EQ_CMA_RAD5__A, 15385)); (state, SCU_RAM_QAM_EQ_CMA_RAD2__A, 12543));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_EQ_CMA_RAD3__A, 12931));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_EQ_CMA_RAD4__A, 13629));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_EQ_CMA_RAD5__A, 15385));
/* Decision Feedback Equalizer */ /* Decision Feedback Equalizer */
CHK_ERROR(Write16_0(state, QAM_DQ_QUAL_FUN0__A, 8)); CHK_ERROR(Write16_0(state, QAM_DQ_QUAL_FUN0__A, 8));
...@@ -4018,32 +4275,47 @@ static int SetQAM256(struct drxk_state *state) ...@@ -4018,32 +4275,47 @@ static int SetQAM256(struct drxk_state *state)
/* QAM Slicer Settings */ /* QAM Slicer Settings */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_SL_SIG_POWER__A,DRXK_QAM_SL_SIG_POWER_QAM256)); CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_SL_SIG_POWER__A,
DRXK_QAM_SL_SIG_POWER_QAM256));
/* QAM Loop Controller Coeficients */ /* QAM Loop Controller Coeficients */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CA_FINE__A, 15)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CA_FINE__A, 15));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CA_COARSE__A, 40)); CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CA_COARSE__A, 40));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_FINE__A, 12)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_FINE__A, 12));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EP_COARSE__A, 24)); (state, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_EP_COARSE__A, 24));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_FINE__A, 12)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_FINE__A, 12));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_EI_COARSE__A, 16)); (state, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_EI_COARSE__A, 16));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_FINE__A, 5)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_FINE__A, 5));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_MEDIUM__A, 50)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CP_COARSE__A, 250)); (state, SCU_RAM_QAM_LC_CP_MEDIUM__A, 50));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CP_COARSE__A, 250));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_FINE__A, 5)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_FINE__A, 5));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_MEDIUM__A, 50)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CI_COARSE__A, 125)); (state, SCU_RAM_QAM_LC_CI_MEDIUM__A, 50));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CI_COARSE__A, 125));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_FINE__A, 16)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_FINE__A, 16));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_MEDIUM__A, 25)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF_COARSE__A, 48)); (state, SCU_RAM_QAM_LC_CF_MEDIUM__A, 25));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CF_COARSE__A, 48));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_FINE__A, 5)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_FINE__A, 5));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 10)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_LC_CF1_COARSE__A, 10)); (state, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 10));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_LC_CF1_COARSE__A, 10));
/* QAM State Machine (FSM) Thresholds */ /* QAM State Machine (FSM) Thresholds */
...@@ -4055,26 +4327,39 @@ static int SetQAM256(struct drxk_state *state) ...@@ -4055,26 +4327,39 @@ static int SetQAM256(struct drxk_state *state)
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_QTH__A, 150)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_QTH__A, 150));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_MTH__A, 110)); CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_MTH__A, 110));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_RATE_LIM__A, 40)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_COUNT_LIM__A, 4)); (state, SCU_RAM_QAM_FSM_RATE_LIM__A, 40));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_FREQ_LIM__A, 12)); CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_COUNT_LIM__A, 4));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_FREQ_LIM__A, 12));
/* QAM FSM Tracking Parameters */ /* QAM FSM Tracking Parameters */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A, (u16) 8)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A, (u16) 74)); (state, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A,
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A, (u16) 18)); (u16) 8));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A, (u16) 13)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A, (u16) 7)); (state, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A,
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A, (u16) 0)); (u16) 74));
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A, (u16) -8)); CHK_ERROR(Write16_0
}while(0); (state, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A,
(u16) 18));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A,
(u16) 13));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A,
(u16) 7));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A,
(u16) 0));
CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A,
(u16) -8));
} while (0);
if (status<0)
{
//KdPrintEx((MSG_ERROR " - " __FUNCTION__ " status - %08x\n",status));
}
return status; return status;
} }
...@@ -4091,13 +4376,16 @@ static int QAMResetQAM(struct drxk_state *state) ...@@ -4091,13 +4376,16 @@ static int QAMResetQAM(struct drxk_state *state)
int status; int status;
u16 cmdResult; u16 cmdResult;
//printk("%s\n", __FUNCTION__); do {
do
{
/* Stop QAM comstate->m_exec */ /* Stop QAM comstate->m_exec */
CHK_ERROR(Write16_0(state, QAM_COMM_EXEC__A, QAM_COMM_EXEC_STOP)); CHK_ERROR(Write16_0
(state, QAM_COMM_EXEC__A, QAM_COMM_EXEC_STOP));
CHK_ERROR(scu_command(state,SCU_RAM_COMMAND_STANDARD_QAM | SCU_RAM_COMMAND_CMD_DEMOD_RESET,0,NULL,1,&cmdResult));
CHK_ERROR(scu_command
(state,
SCU_RAM_COMMAND_STANDARD_QAM |
SCU_RAM_COMMAND_CMD_DEMOD_RESET, 0, NULL, 1,
&cmdResult));
} while (0); } while (0);
/* All done, all OK */ /* All done, all OK */
...@@ -4121,57 +4409,49 @@ static int QAMSetSymbolrate(struct drxk_state *state) ...@@ -4121,57 +4409,49 @@ static int QAMSetSymbolrate(struct drxk_state *state)
u32 lcSymbRate = 0; u32 lcSymbRate = 0;
int status; int status;
do do {
{
/* Select & calculate correct IQM rate */ /* Select & calculate correct IQM rate */
adcFrequency = (state->m_sysClockFreq * 1000) / 3; adcFrequency = (state->m_sysClockFreq * 1000) / 3;
ratesel = 0; ratesel = 0;
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ " state->m_SymbolRate = %d\n",state->m_SymbolRate)); /* printk(KERN_DEBUG "SR %d\n", state->param.u.qam.symbol_rate); */
//printk("SR %d\n", state->param.u.qam.symbol_rate);
if (state->param.u.qam.symbol_rate <= 1188750) if (state->param.u.qam.symbol_rate <= 1188750)
{
ratesel = 3; ratesel = 3;
}
else if (state->param.u.qam.symbol_rate <= 2377500) else if (state->param.u.qam.symbol_rate <= 2377500)
{
ratesel = 2; ratesel = 2;
}
else if (state->param.u.qam.symbol_rate <= 4755000) else if (state->param.u.qam.symbol_rate <= 4755000)
{
ratesel = 1; ratesel = 1;
} CHK_ERROR(Write16_0(state, IQM_FD_RATESEL__A, ratesel));
CHK_ERROR(Write16_0(state,IQM_FD_RATESEL__A, ratesel));
/* /*
IqmRcRate = ((Fadc / (symbolrate * (4<<ratesel))) - 1) * (1<<23) IqmRcRate = ((Fadc / (symbolrate * (4<<ratesel))) - 1) * (1<<23)
*/ */
symbFreq = state->param.u.qam.symbol_rate * (1 << ratesel); symbFreq = state->param.u.qam.symbol_rate * (1 << ratesel);
if (symbFreq == 0) if (symbFreq == 0) {
{
/* Divide by zero */ /* Divide by zero */
return -1; return -1;
} }
iqmRcRate = (adcFrequency / symbFreq) * (1 << 21) + iqmRcRate = (adcFrequency / symbFreq) * (1 << 21) +
(Frac28a((adcFrequency % symbFreq), symbFreq) >> 7) - (Frac28a((adcFrequency % symbFreq), symbFreq) >> 7) -
(1 << 23); (1 << 23);
CHK_ERROR(Write32(state, IQM_RC_RATE_OFS_LO__A, iqmRcRate,0)); CHK_ERROR(Write32
(state, IQM_RC_RATE_OFS_LO__A, iqmRcRate, 0));
state->m_iqmRcRate = iqmRcRate; state->m_iqmRcRate = iqmRcRate;
/* /*
LcSymbFreq = round (.125 * symbolrate / adcFreq * (1<<15)) LcSymbFreq = round (.125 * symbolrate / adcFreq * (1<<15))
*/ */
symbFreq = state->param.u.qam.symbol_rate; symbFreq = state->param.u.qam.symbol_rate;
if (adcFrequency == 0) if (adcFrequency == 0) {
{
/* Divide by zero */ /* Divide by zero */
return -1; return -1;
} }
lcSymbRate = (symbFreq / adcFrequency) * (1 << 12) + lcSymbRate = (symbFreq / adcFrequency) * (1 << 12) +
(Frac28a((symbFreq % adcFrequency), adcFrequency) >> 16); (Frac28a((symbFreq % adcFrequency), adcFrequency) >>
16);
if (lcSymbRate > 511) if (lcSymbRate > 511)
{
lcSymbRate = 511; lcSymbRate = 511;
} CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, QAM_LC_SYMBOL_FREQ__A, (u16) lcSymbRate)); (state, QAM_LC_SYMBOL_FREQ__A,
(u16) lcSymbRate));
} while (0); } while (0);
return status; return status;
...@@ -4189,30 +4469,26 @@ static int QAMSetSymbolrate(struct drxk_state *state) ...@@ -4189,30 +4469,26 @@ static int QAMSetSymbolrate(struct drxk_state *state)
static int GetQAMLockStatus(struct drxk_state *state, u32 *pLockStatus) static int GetQAMLockStatus(struct drxk_state *state, u32 *pLockStatus)
{ {
int status; int status;
u16 Result[2] = {0,0}; u16 Result[2] = { 0, 0 };
status = scu_command(state,SCU_RAM_COMMAND_STANDARD_QAM|SCU_RAM_COMMAND_CMD_DEMOD_GET_LOCK, 0, NULL, 2, Result); status =
if (status<0) scu_command(state,
{ SCU_RAM_COMMAND_STANDARD_QAM |
printk("%s status = %08x\n",__FUNCTION__,status); SCU_RAM_COMMAND_CMD_DEMOD_GET_LOCK, 0, NULL, 2,
} Result);
if (Result[1] < SCU_RAM_QAM_LOCKED_LOCKED_DEMOD_LOCKED) if (status < 0)
{ printk(KERN_ERR "%s status = %08x\n", __func__, status);
if (Result[1] < SCU_RAM_QAM_LOCKED_LOCKED_DEMOD_LOCKED) {
/* 0x0000 NOT LOCKED */ /* 0x0000 NOT LOCKED */
*pLockStatus = NOT_LOCKED; *pLockStatus = NOT_LOCKED;
} } else if (Result[1] < SCU_RAM_QAM_LOCKED_LOCKED_LOCKED) {
else if (Result[1] < SCU_RAM_QAM_LOCKED_LOCKED_LOCKED)
{
/* 0x4000 DEMOD LOCKED */ /* 0x4000 DEMOD LOCKED */
*pLockStatus = DEMOD_LOCK; *pLockStatus = DEMOD_LOCK;
} } else if (Result[1] < SCU_RAM_QAM_LOCKED_LOCKED_NEVER_LOCK) {
else if (Result[1] < SCU_RAM_QAM_LOCKED_LOCKED_NEVER_LOCK)
{
/* 0x8000 DEMOD + FEC LOCKED (system lock) */ /* 0x8000 DEMOD + FEC LOCKED (system lock) */
*pLockStatus = MPEG_LOCK; *pLockStatus = MPEG_LOCK;
} } else {
else
{
/* 0xC000 NEVER LOCKED */ /* 0xC000 NEVER LOCKED */
/* (system will never be able to lock to the signal) */ /* (system will never be able to lock to the signal) */
/* TODO: check this, intermediate & standard specific lock states are not /* TODO: check this, intermediate & standard specific lock states are not
...@@ -4229,17 +4505,15 @@ static int GetQAMLockStatus(struct drxk_state *state, u32 *pLockStatus) ...@@ -4229,17 +4505,15 @@ static int GetQAMLockStatus(struct drxk_state *state, u32 *pLockStatus)
#define QAM_LOCKRANGE__M 0x10 #define QAM_LOCKRANGE__M 0x10
#define QAM_LOCKRANGE_NORMAL 0x10 #define QAM_LOCKRANGE_NORMAL 0x10
static int SetQAM(struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerFreqOffset) static int SetQAM(struct drxk_state *state, u16 IntermediateFreqkHz,
s32 tunerFreqOffset)
{ {
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ "\n"));
int status = 0; int status = 0;
u8 parameterLen; u8 parameterLen;
u16 setEnvParameters[5]; u16 setEnvParameters[5];
u16 setParamParameters[4]={0,0,0,0}; u16 setParamParameters[4] = { 0, 0, 0, 0 };
u16 cmdResult; u16 cmdResult;
//printk("%s\n", __FUNCTION__);
do { do {
/* /*
STEP 1: reset demodulator STEP 1: reset demodulator
...@@ -4247,8 +4521,12 @@ static int SetQAM(struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerFre ...@@ -4247,8 +4521,12 @@ static int SetQAM(struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerFre
resets QAM block resets QAM block
resets SCU variables resets SCU variables
*/ */
CHK_ERROR(Write16_0(state, FEC_DI_COMM_EXEC__A, FEC_DI_COMM_EXEC_STOP)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, FEC_RS_COMM_EXEC__A, FEC_RS_COMM_EXEC_STOP)); (state, FEC_DI_COMM_EXEC__A,
FEC_DI_COMM_EXEC_STOP));
CHK_ERROR(Write16_0
(state, FEC_RS_COMM_EXEC__A,
FEC_RS_COMM_EXEC_STOP));
CHK_ERROR(QAMResetQAM(state)); CHK_ERROR(QAMResetQAM(state));
/* /*
...@@ -4261,17 +4539,14 @@ static int SetQAM(struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerFre ...@@ -4261,17 +4539,14 @@ static int SetQAM(struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerFre
/* Env parameters */ /* Env parameters */
setEnvParameters[2] = QAM_TOP_ANNEX_A; /* Annex */ setEnvParameters[2] = QAM_TOP_ANNEX_A; /* Annex */
if (state->m_OperationMode == OM_QAM_ITU_C) if (state->m_OperationMode == OM_QAM_ITU_C)
{
setEnvParameters[2] = QAM_TOP_ANNEX_C; /* Annex */ setEnvParameters[2] = QAM_TOP_ANNEX_C; /* Annex */
}
setParamParameters[3] |= (QAM_MIRROR_AUTO_ON); setParamParameters[3] |= (QAM_MIRROR_AUTO_ON);
// check for LOCKRANGE Extented /* check for LOCKRANGE Extented */
// setParamParameters[3] |= QAM_LOCKRANGE_NORMAL; /* setParamParameters[3] |= QAM_LOCKRANGE_NORMAL; */
parameterLen = 4; parameterLen = 4;
/* Set params */ /* Set params */
switch(state->param.u.qam.modulation) switch (state->param.u.qam.modulation) {
{
case QAM_256: case QAM_256:
state->m_Constellation = DRX_CONSTELLATION_QAM256; state->m_Constellation = DRX_CONSTELLATION_QAM256;
break; break;
...@@ -4296,22 +4571,32 @@ static int SetQAM(struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerFre ...@@ -4296,22 +4571,32 @@ static int SetQAM(struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerFre
setParamParameters[0] = state->m_Constellation; /* constellation */ setParamParameters[0] = state->m_Constellation; /* constellation */
setParamParameters[1] = DRXK_QAM_I12_J17; /* interleave mode */ setParamParameters[1] = DRXK_QAM_I12_J17; /* interleave mode */
CHK_ERROR(scu_command(state,SCU_RAM_COMMAND_STANDARD_QAM | SCU_RAM_COMMAND_CMD_DEMOD_SET_PARAM,4,setParamParameters,1,&cmdResult)); CHK_ERROR(scu_command
(state,
SCU_RAM_COMMAND_STANDARD_QAM |
SCU_RAM_COMMAND_CMD_DEMOD_SET_PARAM, 4,
setParamParameters, 1, &cmdResult));
/* STEP 3: enable the system in a mode where the ADC provides valid signal /* STEP 3: enable the system in a mode where the ADC provides valid signal
setup constellation independent registers */ setup constellation independent registers */
// CHK_ERROR (SetFrequency (channel, tunerFreqOffset)); /* CHK_ERROR (SetFrequency (channel, tunerFreqOffset)); */
CHK_ERROR (SetFrequencyShifter (state, IntermediateFreqkHz, tunerFreqOffset, true)); CHK_ERROR(SetFrequencyShifter
(state, IntermediateFreqkHz, tunerFreqOffset,
true));
/* Setup BER measurement */ /* Setup BER measurement */
CHK_ERROR(SetQAMMeasurement (state, CHK_ERROR(SetQAMMeasurement(state,
state->m_Constellation, state->m_Constellation,
state->param.u.qam.symbol_rate)); state->param.u.
qam.symbol_rate));
/* Reset default values */ /* Reset default values */
CHK_ERROR(Write16_0(state, IQM_CF_SCALE_SH__A, IQM_CF_SCALE_SH__PRE)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, QAM_SY_TIMEOUT__A, QAM_SY_TIMEOUT__PRE)); (state, IQM_CF_SCALE_SH__A,
IQM_CF_SCALE_SH__PRE));
CHK_ERROR(Write16_0
(state, QAM_SY_TIMEOUT__A, QAM_SY_TIMEOUT__PRE));
/* Reset default LC values */ /* Reset default LC values */
CHK_ERROR(Write16_0(state, QAM_LC_RATE_LIMIT__A, 3)); CHK_ERROR(Write16_0(state, QAM_LC_RATE_LIMIT__A, 3));
...@@ -4336,14 +4621,16 @@ static int SetQAM(struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerFre ...@@ -4336,14 +4621,16 @@ static int SetQAM(struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerFre
CHK_ERROR(Write16_0(state, QAM_LC_QUAL_TAB25__A, 4)); CHK_ERROR(Write16_0(state, QAM_LC_QUAL_TAB25__A, 4));
/* Mirroring, QAM-block starting point not inverted */ /* Mirroring, QAM-block starting point not inverted */
CHK_ERROR(Write16_0(state, QAM_SY_SP_INV__A, QAM_SY_SP_INV_SPECTRUM_INV_DIS)); CHK_ERROR(Write16_0
(state, QAM_SY_SP_INV__A,
QAM_SY_SP_INV_SPECTRUM_INV_DIS));
/* Halt SCU to enable safe non-atomic accesses */ /* Halt SCU to enable safe non-atomic accesses */
CHK_ERROR(Write16_0(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_HOLD)); CHK_ERROR(Write16_0
(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_HOLD));
/* STEP 4: constellation specific setup */ /* STEP 4: constellation specific setup */
switch (state->param.u.qam.modulation) switch (state->param.u.qam.modulation) {
{
case QAM_16: case QAM_16:
CHK_ERROR(SetQAM16(state)); CHK_ERROR(SetQAM16(state));
break; break;
...@@ -4358,7 +4645,6 @@ static int SetQAM(struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerFre ...@@ -4358,7 +4645,6 @@ static int SetQAM(struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerFre
CHK_ERROR(SetQAM128(state)); CHK_ERROR(SetQAM128(state));
break; break;
case QAM_256: case QAM_256:
//printk("SETQAM256\n");
CHK_ERROR(SetQAM256(state)); CHK_ERROR(SetQAM256(state));
break; break;
default: default:
...@@ -4366,38 +4652,44 @@ static int SetQAM(struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerFre ...@@ -4366,38 +4652,44 @@ static int SetQAM(struct drxk_state *state,u16 IntermediateFreqkHz, s32 tunerFre
break; break;
} /* switch */ } /* switch */
/* Activate SCU to enable SCU commands */ /* Activate SCU to enable SCU commands */
CHK_ERROR(Write16_0(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_ACTIVE)); CHK_ERROR(Write16_0
(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_ACTIVE));
/* Re-configure MPEG output, requires knowledge of channel bitrate */ /* Re-configure MPEG output, requires knowledge of channel bitrate */
// extAttr->currentChannel.constellation = channel->constellation; /* extAttr->currentChannel.constellation = channel->constellation; */
// extAttr->currentChannel.symbolrate = channel->symbolrate; /* extAttr->currentChannel.symbolrate = channel->symbolrate; */
CHK_ERROR(MPEGTSDtoSetup(state, state->m_OperationMode)); CHK_ERROR(MPEGTSDtoSetup(state, state->m_OperationMode));
/* Start processes */ /* Start processes */
CHK_ERROR(MPEGTSStart(state)); CHK_ERROR(MPEGTSStart(state));
CHK_ERROR(Write16_0(state, FEC_COMM_EXEC__A, FEC_COMM_EXEC_ACTIVE)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, QAM_COMM_EXEC__A, QAM_COMM_EXEC_ACTIVE)); (state, FEC_COMM_EXEC__A, FEC_COMM_EXEC_ACTIVE));
CHK_ERROR(Write16_0(state, IQM_COMM_EXEC__A, IQM_COMM_EXEC_B_ACTIVE)); CHK_ERROR(Write16_0
(state, QAM_COMM_EXEC__A, QAM_COMM_EXEC_ACTIVE));
CHK_ERROR(Write16_0
(state, IQM_COMM_EXEC__A,
IQM_COMM_EXEC_B_ACTIVE));
/* STEP 5: start QAM demodulator (starts FEC, QAM and IQM HW) */ /* STEP 5: start QAM demodulator (starts FEC, QAM and IQM HW) */
CHK_ERROR(scu_command(state,SCU_RAM_COMMAND_STANDARD_QAM | CHK_ERROR(scu_command(state, SCU_RAM_COMMAND_STANDARD_QAM |
SCU_RAM_COMMAND_CMD_DEMOD_START,0, SCU_RAM_COMMAND_CMD_DEMOD_START, 0,
NULL,1,&cmdResult)); NULL, 1, &cmdResult));
/* update global DRXK data container */ /* update global DRXK data container */
//? extAttr->qamInterleaveMode = DRXK_QAM_I12_J17; /*? extAttr->qamInterleaveMode = DRXK_QAM_I12_J17; */
/* All done, all OK */ /* All done, all OK */
} while(0); } while (0);
if (status < 0)
printk(KERN_ERR "%s %d\n", __func__, status);
if (status<0) {
printk("%s %d\n", __FUNCTION__, status);
}
return status; return status;
} }
static int SetQAMStandard(struct drxk_state *state, enum OperationMode oMode) static int SetQAMStandard(struct drxk_state *state,
enum OperationMode oMode)
{ {
#ifdef DRXK_QAM_TAPS #ifdef DRXK_QAM_TAPS
#define DRXK_QAMA_TAPS_SELECT #define DRXK_QAMA_TAPS_SELECT
...@@ -4407,9 +4699,7 @@ static int SetQAMStandard(struct drxk_state *state, enum OperationMode oMode) ...@@ -4407,9 +4699,7 @@ static int SetQAMStandard(struct drxk_state *state, enum OperationMode oMode)
int status; int status;
#endif #endif
//printk("%s\n", __FUNCTION__); do {
do
{
/* added antenna switch */ /* added antenna switch */
SwitchAntennaToQAM(state); SwitchAntennaToQAM(state);
...@@ -4420,13 +4710,14 @@ static int SetQAMStandard(struct drxk_state *state, enum OperationMode oMode) ...@@ -4420,13 +4710,14 @@ static int SetQAMStandard(struct drxk_state *state, enum OperationMode oMode)
/* Setup IQM */ /* Setup IQM */
CHK_ERROR(Write16_0(state, IQM_COMM_EXEC__A, IQM_COMM_EXEC_B_STOP)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, IQM_AF_AMUX__A, IQM_AF_AMUX_SIGNAL2ADC)); (state, IQM_COMM_EXEC__A, IQM_COMM_EXEC_B_STOP));
CHK_ERROR(Write16_0
(state, IQM_AF_AMUX__A, IQM_AF_AMUX_SIGNAL2ADC));
/* Upload IQM Channel Filter settings by /* Upload IQM Channel Filter settings by
boot loader from ROM table */ boot loader from ROM table */
switch (oMode) switch (oMode) {
{
case OM_QAM_ITU_A: case OM_QAM_ITU_A:
CHK_ERROR(BLChainCmd(state, CHK_ERROR(BLChainCmd(state,
DRXK_BL_ROM_OFFSET_TAPS_ITU_A, DRXK_BL_ROM_OFFSET_TAPS_ITU_A,
...@@ -4444,9 +4735,9 @@ static int SetQAMStandard(struct drxk_state *state, enum OperationMode oMode) ...@@ -4444,9 +4735,9 @@ static int SetQAMStandard(struct drxk_state *state, enum OperationMode oMode)
DRXK_BLC_TIMEOUT)); DRXK_BLC_TIMEOUT));
break; break;
default: default:
status=-EINVAL; status = -EINVAL;
} }
CHK_ERROR (status); CHK_ERROR(status);
CHK_ERROR(Write16_0(state, IQM_CF_OUT_ENA__A, CHK_ERROR(Write16_0(state, IQM_CF_OUT_ENA__A,
(1 << IQM_CF_OUT_ENA_QAM__B))); (1 << IQM_CF_OUT_ENA_QAM__B)));
...@@ -4480,26 +4771,29 @@ static int SetQAMStandard(struct drxk_state *state, enum OperationMode oMode) ...@@ -4480,26 +4771,29 @@ static int SetQAMStandard(struct drxk_state *state, enum OperationMode oMode)
CHK_ERROR(Write16_0(state, IQM_AF_START_LOCK__A, 0x01)); CHK_ERROR(Write16_0(state, IQM_AF_START_LOCK__A, 0x01));
/* IQM will not be reset from here, sync ADC and update/init AGC */ /* IQM will not be reset from here, sync ADC and update/init AGC */
CHK_ERROR(ADCSynchronization (state)); CHK_ERROR(ADCSynchronization(state));
/* Set the FSM step period */ /* Set the FSM step period */
CHK_ERROR(Write16_0(state, SCU_RAM_QAM_FSM_STEP_PERIOD__A, 2000)); CHK_ERROR(Write16_0
(state, SCU_RAM_QAM_FSM_STEP_PERIOD__A, 2000));
/* Halt SCU to enable safe non-atomic accesses */ /* Halt SCU to enable safe non-atomic accesses */
CHK_ERROR(Write16_0(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_HOLD)); CHK_ERROR(Write16_0
(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_HOLD));
/* No more resets of the IQM, current standard correctly set => /* No more resets of the IQM, current standard correctly set =>
now AGCs can be configured. */ now AGCs can be configured. */
CHK_ERROR(InitAGC(state,true)); CHK_ERROR(InitAGC(state, true));
CHK_ERROR(SetPreSaw(state, &(state->m_qamPreSawCfg))); CHK_ERROR(SetPreSaw(state, &(state->m_qamPreSawCfg)));
/* Configure AGC's */ /* Configure AGC's */
CHK_ERROR(SetAgcRf(state, &(state->m_qamRfAgcCfg), true)); CHK_ERROR(SetAgcRf(state, &(state->m_qamRfAgcCfg), true));
CHK_ERROR(SetAgcIf (state, &(state->m_qamIfAgcCfg), true)); CHK_ERROR(SetAgcIf(state, &(state->m_qamIfAgcCfg), true));
/* Activate SCU to enable SCU commands */ /* Activate SCU to enable SCU commands */
CHK_ERROR(Write16_0(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_ACTIVE)); CHK_ERROR(Write16_0
(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_ACTIVE));
} while (0); } while (0);
return status; return status;
} }
...@@ -4524,14 +4818,15 @@ static int WriteGPIO(struct drxk_state *state) ...@@ -4524,14 +4818,15 @@ static int WriteGPIO(struct drxk_state *state)
state->m_GPIOCfg)); state->m_GPIOCfg));
/* use corresponding bit in io data output registar */ /* use corresponding bit in io data output registar */
CHK_ERROR(Read16_0(state, SIO_PDR_UIO_OUT_LO__A, &value)); CHK_ERROR(Read16_0
if (state->m_GPIO == 0) { (state, SIO_PDR_UIO_OUT_LO__A, &value));
if (state->m_GPIO == 0)
value &= 0x7FFF; /* write zero to 15th bit - 1st UIO */ value &= 0x7FFF; /* write zero to 15th bit - 1st UIO */
} else { else
value |= 0x8000; /* write one to 15th bit - 1st UIO */ value |= 0x8000; /* write one to 15th bit - 1st UIO */
}
/* write back to io data output register */ /* write back to io data output register */
CHK_ERROR(Write16_0(state, SIO_PDR_UIO_OUT_LO__A, value)); CHK_ERROR(Write16_0
(state, SIO_PDR_UIO_OUT_LO__A, value));
} }
/* Write magic word to disable pdr reg write */ /* Write magic word to disable pdr reg write */
...@@ -4556,7 +4851,7 @@ static int SwitchAntennaToQAM(struct drxk_state *state) ...@@ -4556,7 +4851,7 @@ static int SwitchAntennaToQAM(struct drxk_state *state)
static int SwitchAntennaToDVBT(struct drxk_state *state) static int SwitchAntennaToDVBT(struct drxk_state *state)
{ {
int status = -1; int status = -1;
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ "\n"));
if (state->m_AntennaSwitchDVBTDVBC != 0) { if (state->m_AntennaSwitchDVBTDVBC != 0) {
if (state->m_GPIO != state->m_AntennaDVBT) { if (state->m_GPIO != state->m_AntennaDVBT) {
state->m_GPIO = state->m_AntennaDVBT; state->m_GPIO = state->m_AntennaDVBT;
...@@ -4578,40 +4873,41 @@ static int PowerDownDevice(struct drxk_state *state) ...@@ -4578,40 +4873,41 @@ static int PowerDownDevice(struct drxk_state *state)
int status; int status;
do { do {
if (state->m_bPDownOpenBridge) { if (state->m_bPDownOpenBridge) {
// Open I2C bridge before power down of DRXK /* Open I2C bridge before power down of DRXK */
CHK_ERROR(ConfigureI2CBridge(state, true)); CHK_ERROR(ConfigureI2CBridge(state, true));
} }
// driver 0.9.0 /* driver 0.9.0 */
CHK_ERROR(DVBTEnableOFDMTokenRing(state, false)); CHK_ERROR(DVBTEnableOFDMTokenRing(state, false));
CHK_ERROR(Write16_0(state, SIO_CC_PWD_MODE__A, SIO_CC_PWD_MODE_LEVEL_CLOCK)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SIO_CC_UPDATE__A , SIO_CC_UPDATE_KEY)); (state, SIO_CC_PWD_MODE__A,
SIO_CC_PWD_MODE_LEVEL_CLOCK));
CHK_ERROR(Write16_0
(state, SIO_CC_UPDATE__A, SIO_CC_UPDATE_KEY));
state->m_HICfgCtrl |= SIO_HI_RA_RAM_PAR_5_CFG_SLEEP_ZZZ; state->m_HICfgCtrl |= SIO_HI_RA_RAM_PAR_5_CFG_SLEEP_ZZZ;
CHK_ERROR(HI_CfgCommand(state)); CHK_ERROR(HI_CfgCommand(state));
} } while (0);
while(0);
if (status<0) { if (status < 0)
//KdPrintEx((MSG_ERROR " - " __FUNCTION__ " status - %08x\n",status));
return -1; return -1;
}
return 0; return 0;
} }
static int load_microcode(struct drxk_state *state, char *mc_name) static int load_microcode(struct drxk_state *state, char *mc_name)
{ {
const struct firmware *fw = NULL; const struct firmware *fw = NULL;
int err=0; int err = 0;
err = request_firmware(&fw, mc_name, state->i2c->dev.parent); err = request_firmware(&fw, mc_name, state->i2c->dev.parent);
if (err < 0) { if (err < 0) {
printk(KERN_ERR printk(KERN_ERR
": Could not load firmware file %s.\n", mc_name); "Could not load firmware file %s.\n", mc_name);
printk(KERN_INFO printk(KERN_INFO
": Copy %s to your hotplug directory!\n", mc_name); "Copy %s to your hotplug directory!\n", mc_name);
return err; return err;
} }
err=DownloadMicrocode(state, fw->data, fw->size); err = DownloadMicrocode(state, fw->data, fw->size);
release_firmware(fw); release_firmware(fw);
return err; return err;
} }
...@@ -4619,20 +4915,21 @@ static int load_microcode(struct drxk_state *state, char *mc_name) ...@@ -4619,20 +4915,21 @@ static int load_microcode(struct drxk_state *state, char *mc_name)
static int init_drxk(struct drxk_state *state) static int init_drxk(struct drxk_state *state)
{ {
int status; int status;
DRXPowerMode_t powerMode = DRXK_POWER_DOWN_OFDM; enum DRXPowerMode powerMode = DRXK_POWER_DOWN_OFDM;
u16 driverVersion; u16 driverVersion;
//printk("init_drxk\n");
if ((state->m_DrxkState == DRXK_UNINITIALIZED)) { if ((state->m_DrxkState == DRXK_UNINITIALIZED)) {
do { do {
CHK_ERROR(PowerUpDevice(state)); CHK_ERROR(PowerUpDevice(state));
CHK_ERROR (DRXX_Open(state)); CHK_ERROR(DRXX_Open(state));
/* Soft reset of OFDM-, sys- and osc-clockdomain */ /* Soft reset of OFDM-, sys- and osc-clockdomain */
CHK_ERROR(Write16_0(state, SIO_CC_SOFT_RST__A, CHK_ERROR(Write16_0(state, SIO_CC_SOFT_RST__A,
SIO_CC_SOFT_RST_OFDM__M | SIO_CC_SOFT_RST_OFDM__M |
SIO_CC_SOFT_RST_SYS__M | SIO_CC_SOFT_RST_SYS__M |
SIO_CC_SOFT_RST_OSC__M)); SIO_CC_SOFT_RST_OSC__M));
CHK_ERROR(Write16_0(state, SIO_CC_UPDATE__A, SIO_CC_UPDATE_KEY)); CHK_ERROR(Write16_0
(state, SIO_CC_UPDATE__A,
SIO_CC_UPDATE_KEY));
/* TODO is this needed, if yes how much delay in worst case scenario */ /* TODO is this needed, if yes how much delay in worst case scenario */
msleep(1); msleep(1);
state->m_DRXK_A3_PATCH_CODE = true; state->m_DRXK_A3_PATCH_CODE = true;
...@@ -4641,36 +4938,52 @@ static int init_drxk(struct drxk_state *state) ...@@ -4641,36 +4938,52 @@ static int init_drxk(struct drxk_state *state)
/* Bridge delay, uses oscilator clock */ /* Bridge delay, uses oscilator clock */
/* Delay = (delay (nano seconds) * oscclk (kHz))/ 1000 */ /* Delay = (delay (nano seconds) * oscclk (kHz))/ 1000 */
/* SDA brdige delay */ /* SDA brdige delay */
state->m_HICfgBridgeDelay = (u16)((state->m_oscClockFreq/1000)* HI_I2C_BRIDGE_DELAY)/1000; state->m_HICfgBridgeDelay =
(u16) ((state->m_oscClockFreq / 1000) *
HI_I2C_BRIDGE_DELAY) / 1000;
/* Clipping */ /* Clipping */
if (state->m_HICfgBridgeDelay > SIO_HI_RA_RAM_PAR_3_CFG_DBL_SDA__M) if (state->m_HICfgBridgeDelay >
{ SIO_HI_RA_RAM_PAR_3_CFG_DBL_SDA__M) {
state->m_HICfgBridgeDelay = SIO_HI_RA_RAM_PAR_3_CFG_DBL_SDA__M; state->m_HICfgBridgeDelay =
SIO_HI_RA_RAM_PAR_3_CFG_DBL_SDA__M;
} }
/* SCL bridge delay, same as SDA for now */ /* SCL bridge delay, same as SDA for now */
state->m_HICfgBridgeDelay += state->m_HICfgBridgeDelay << SIO_HI_RA_RAM_PAR_3_CFG_DBL_SCL__B; state->m_HICfgBridgeDelay +=
state->m_HICfgBridgeDelay <<
SIO_HI_RA_RAM_PAR_3_CFG_DBL_SCL__B;
CHK_ERROR(InitHI(state)); CHK_ERROR(InitHI(state));
/* disable various processes */ /* disable various processes */
#if NOA1ROM #if NOA1ROM
if (!(state->m_DRXK_A1_ROM_CODE) && !(state->m_DRXK_A2_ROM_CODE) ) if (!(state->m_DRXK_A1_ROM_CODE)
&& !(state->m_DRXK_A2_ROM_CODE))
#endif #endif
{ {
CHK_ERROR(Write16_0(state, SCU_RAM_GPIO__A, SCU_RAM_GPIO_HW_LOCK_IND_DISABLE)); CHK_ERROR(Write16_0
(state, SCU_RAM_GPIO__A,
SCU_RAM_GPIO_HW_LOCK_IND_DISABLE));
} }
/* disable MPEG port */ /* disable MPEG port */
CHK_ERROR(MPEGTSDisable(state)); CHK_ERROR(MPEGTSDisable(state));
/* Stop AUD and SCU */ /* Stop AUD and SCU */
CHK_ERROR(Write16_0(state, AUD_COMM_EXEC__A, AUD_COMM_EXEC_STOP)); CHK_ERROR(Write16_0
CHK_ERROR(Write16_0(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_STOP)); (state, AUD_COMM_EXEC__A,
AUD_COMM_EXEC_STOP));
CHK_ERROR(Write16_0
(state, SCU_COMM_EXEC__A,
SCU_COMM_EXEC_STOP));
/* enable token-ring bus through OFDM block for possible ucode upload */ /* enable token-ring bus through OFDM block for possible ucode upload */
CHK_ERROR(Write16_0(state, SIO_OFDM_SH_OFDM_RING_ENABLE__A, SIO_OFDM_SH_OFDM_RING_ENABLE_ON)); CHK_ERROR(Write16_0
(state, SIO_OFDM_SH_OFDM_RING_ENABLE__A,
SIO_OFDM_SH_OFDM_RING_ENABLE_ON));
/* include boot loader section */ /* include boot loader section */
CHK_ERROR(Write16_0(state, SIO_BL_COMM_EXEC__A, SIO_BL_COMM_EXEC_ACTIVE)); CHK_ERROR(Write16_0
(state, SIO_BL_COMM_EXEC__A,
SIO_BL_COMM_EXEC_ACTIVE));
CHK_ERROR(BLChainCmd(state, 0, 6, 100)); CHK_ERROR(BLChainCmd(state, 0, 6, 100));
#if 0 #if 0
...@@ -4688,12 +5001,16 @@ static int init_drxk(struct drxk_state *state) ...@@ -4688,12 +5001,16 @@ static int init_drxk(struct drxk_state *state)
DRXK_A2_microcode_length)); DRXK_A2_microcode_length));
#endif #endif
/* disable token-ring bus through OFDM block for possible ucode upload */ /* disable token-ring bus through OFDM block for possible ucode upload */
CHK_ERROR(Write16_0(state, SIO_OFDM_SH_OFDM_RING_ENABLE__A, SIO_OFDM_SH_OFDM_RING_ENABLE_OFF)); CHK_ERROR(Write16_0
(state, SIO_OFDM_SH_OFDM_RING_ENABLE__A,
SIO_OFDM_SH_OFDM_RING_ENABLE_OFF));
/* Run SCU for a little while to initialize microcode version numbers */ /* Run SCU for a little while to initialize microcode version numbers */
CHK_ERROR(Write16_0(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_ACTIVE)); CHK_ERROR(Write16_0
CHK_ERROR (DRXX_Open(state)); (state, SCU_COMM_EXEC__A,
// added for test SCU_COMM_EXEC_ACTIVE));
CHK_ERROR(DRXX_Open(state));
/* added for test */
msleep(30); msleep(30);
powerMode = DRXK_POWER_DOWN_OFDM; powerMode = DRXK_POWER_DOWN_OFDM;
...@@ -4705,39 +5022,50 @@ static int init_drxk(struct drxk_state *state) ...@@ -4705,39 +5022,50 @@ static int init_drxk(struct drxk_state *state)
Not using SCU command interface for SCU register access since no Not using SCU command interface for SCU register access since no
microcode may be present. microcode may be present.
*/ */
driverVersion = (((DRXK_VERSION_MAJOR/100) % 10) << 12) + driverVersion =
(((DRXK_VERSION_MAJOR/10) % 10) << 8) + (((DRXK_VERSION_MAJOR / 100) % 10) << 12) +
((DRXK_VERSION_MAJOR%10) << 4) + (((DRXK_VERSION_MAJOR / 10) % 10) << 8) +
(DRXK_VERSION_MINOR%10); ((DRXK_VERSION_MAJOR % 10) << 4) +
CHK_ERROR(Write16_0(state, SCU_RAM_DRIVER_VER_HI__A, driverVersion )); (DRXK_VERSION_MINOR % 10);
driverVersion = (((DRXK_VERSION_PATCH/1000) % 10) << 12) + CHK_ERROR(Write16_0
(((DRXK_VERSION_PATCH/100) % 10) << 8) + (state, SCU_RAM_DRIVER_VER_HI__A,
(((DRXK_VERSION_PATCH/10) % 10) << 4) + driverVersion));
(DRXK_VERSION_PATCH%10); driverVersion =
CHK_ERROR(Write16_0(state, SCU_RAM_DRIVER_VER_LO__A, driverVersion )); (((DRXK_VERSION_PATCH / 1000) % 10) << 12) +
(((DRXK_VERSION_PATCH / 100) % 10) << 8) +
printk("DRXK driver version:%d.%d.%d\n", (((DRXK_VERSION_PATCH / 10) % 10) << 4) +
DRXK_VERSION_MAJOR,DRXK_VERSION_MINOR,DRXK_VERSION_PATCH); (DRXK_VERSION_PATCH % 10);
CHK_ERROR(Write16_0
(state, SCU_RAM_DRIVER_VER_LO__A,
driverVersion));
printk(KERN_INFO "DRXK driver version %d.%d.%d\n",
DRXK_VERSION_MAJOR, DRXK_VERSION_MINOR,
DRXK_VERSION_PATCH);
/* Dirty fix of default values for ROM/PATCH microcode /* Dirty fix of default values for ROM/PATCH microcode
Dirty because this fix makes it impossible to setup suitable values Dirty because this fix makes it impossible to setup suitable values
before calling DRX_Open. This solution requires changes to RF AGC speed before calling DRX_Open. This solution requires changes to RF AGC speed
to be done via the CTRL function after calling DRX_Open */ to be done via the CTRL function after calling DRX_Open */
// m_dvbtRfAgcCfg.speed=3; /* m_dvbtRfAgcCfg.speed = 3; */
/* Reset driver debug flags to 0 */ /* Reset driver debug flags to 0 */
CHK_ERROR(Write16_0(state, SCU_RAM_DRIVER_DEBUG__A, 0)); CHK_ERROR(Write16_0
(state, SCU_RAM_DRIVER_DEBUG__A, 0));
/* driver 0.9.0 */ /* driver 0.9.0 */
/* Setup FEC OC: /* Setup FEC OC:
NOTE: No more full FEC resets allowed afterwards!! */ NOTE: No more full FEC resets allowed afterwards!! */
CHK_ERROR(Write16_0(state, FEC_COMM_EXEC__A, FEC_COMM_EXEC_STOP)); CHK_ERROR(Write16_0
// MPEGTS functions are still the same (state, FEC_COMM_EXEC__A,
FEC_COMM_EXEC_STOP));
/* MPEGTS functions are still the same */
CHK_ERROR(MPEGTSDtoInit(state)); CHK_ERROR(MPEGTSDtoInit(state));
CHK_ERROR(MPEGTSStop(state)); CHK_ERROR(MPEGTSStop(state));
CHK_ERROR(MPEGTSConfigurePolarity(state)); CHK_ERROR(MPEGTSConfigurePolarity(state));
CHK_ERROR(MPEGTSConfigurePins(state, state->m_enableMPEGOutput)); CHK_ERROR(MPEGTSConfigurePins
// added: configure GPIO (state, state->m_enableMPEGOutput));
/* added: configure GPIO */
CHK_ERROR(WriteGPIO(state)); CHK_ERROR(WriteGPIO(state));
state->m_DrxkState = DRXK_STOPPED; state->m_DrxkState = DRXK_STOPPED;
...@@ -4745,80 +5073,72 @@ static int init_drxk(struct drxk_state *state) ...@@ -4745,80 +5073,72 @@ static int init_drxk(struct drxk_state *state)
if (state->m_bPowerDown) { if (state->m_bPowerDown) {
CHK_ERROR(PowerDownDevice(state)); CHK_ERROR(PowerDownDevice(state));
state->m_DrxkState = DRXK_POWERED_DOWN; state->m_DrxkState = DRXK_POWERED_DOWN;
} } else
else
state->m_DrxkState = DRXK_STOPPED; state->m_DrxkState = DRXK_STOPPED;
} while(0); } while (0);
//printk("%s=%d\n", __FUNCTION__, status);
}
else
{
//KdPrintEx((MSG_TRACE " - " __FUNCTION__ " - Init already done\n"));
} }
return 0; return 0;
} }
static void drxk_c_release(struct dvb_frontend* fe) static void drxk_c_release(struct dvb_frontend *fe)
{ {
struct drxk_state *state=fe->demodulator_priv; struct drxk_state *state = fe->demodulator_priv;
printk("%s\n", __FUNCTION__);
kfree(state); kfree(state);
} }
static int drxk_c_init (struct dvb_frontend *fe) static int drxk_c_init(struct dvb_frontend *fe)
{ {
struct drxk_state *state=fe->demodulator_priv; struct drxk_state *state = fe->demodulator_priv;
if (mutex_trylock(&state->ctlock)==0) if (mutex_trylock(&state->ctlock) == 0)
return -EBUSY; return -EBUSY;
SetOperationMode(state, OM_QAM_ITU_A); SetOperationMode(state, OM_QAM_ITU_A);
return 0; return 0;
} }
static int drxk_c_sleep(struct dvb_frontend* fe) static int drxk_c_sleep(struct dvb_frontend *fe)
{ {
struct drxk_state *state=fe->demodulator_priv; struct drxk_state *state = fe->demodulator_priv;
ShutDown(state); ShutDown(state);
mutex_unlock(&state->ctlock); mutex_unlock(&state->ctlock);
return 0; return 0;
} }
static int drxk_gate_ctrl(struct dvb_frontend* fe, int enable) static int drxk_gate_ctrl(struct dvb_frontend *fe, int enable)
{ {
struct drxk_state *state = fe->demodulator_priv; struct drxk_state *state = fe->demodulator_priv;
//printk("drxk_gate %d\n", enable); /* printk(KERN_DEBUG "drxk_gate %d\n", enable); */
return ConfigureI2CBridge(state, enable ? true : false); return ConfigureI2CBridge(state, enable ? true : false);
} }
static int drxk_set_parameters (struct dvb_frontend *fe, static int drxk_set_parameters(struct dvb_frontend *fe,
struct dvb_frontend_parameters *p) struct dvb_frontend_parameters *p)
{ {
struct drxk_state *state = fe->demodulator_priv; struct drxk_state *state = fe->demodulator_priv;
u32 IF; u32 IF;
//printk("%s\n", __FUNCTION__);
if (fe->ops.i2c_gate_ctrl) if (fe->ops.i2c_gate_ctrl)
fe->ops.i2c_gate_ctrl(fe, 1); fe->ops.i2c_gate_ctrl(fe, 1);
if (fe->ops.tuner_ops.set_params) if (fe->ops.tuner_ops.set_params)
fe->ops.tuner_ops.set_params(fe, p); fe->ops.tuner_ops.set_params(fe, p);
if (fe->ops.i2c_gate_ctrl) if (fe->ops.i2c_gate_ctrl)
fe->ops.i2c_gate_ctrl(fe, 0); fe->ops.i2c_gate_ctrl(fe, 0);
state->param=*p; state->param = *p;
fe->ops.tuner_ops.get_frequency(fe, &IF); fe->ops.tuner_ops.get_frequency(fe, &IF);
Start(state, 0, IF); Start(state, 0, IF);
//printk("%s IF=%d done\n", __FUNCTION__, IF); /* printk(KERN_DEBUG "%s IF=%d done\n", __func__, IF); */
return 0; return 0;
} }
static int drxk_c_get_frontend(struct dvb_frontend *fe, struct dvb_frontend_parameters *p) static int drxk_c_get_frontend(struct dvb_frontend *fe,
struct dvb_frontend_parameters *p)
{ {
//struct drxk_state *state = fe->demodulator_priv;
//printk("%s\n", __FUNCTION__);
return 0; return 0;
} }
...@@ -4827,31 +5147,31 @@ static int drxk_read_status(struct dvb_frontend *fe, fe_status_t *status) ...@@ -4827,31 +5147,31 @@ static int drxk_read_status(struct dvb_frontend *fe, fe_status_t *status)
struct drxk_state *state = fe->demodulator_priv; struct drxk_state *state = fe->demodulator_priv;
u32 stat; u32 stat;
*status=0; *status = 0;
GetLockStatus(state, &stat, 0); GetLockStatus(state, &stat, 0);
if (stat==MPEG_LOCK) if (stat == MPEG_LOCK)
*status|=0x1f; *status |= 0x1f;
if (stat==FEC_LOCK) if (stat == FEC_LOCK)
*status|=0x0f; *status |= 0x0f;
if (stat==DEMOD_LOCK) if (stat == DEMOD_LOCK)
*status|=0x07; *status |= 0x07;
return 0; return 0;
} }
static int drxk_read_ber(struct dvb_frontend *fe, u32 *ber) static int drxk_read_ber(struct dvb_frontend *fe, u32 *ber)
{ {
//struct drxk_state *state = fe->demodulator_priv; *ber = 0;
*ber=0;
return 0; return 0;
} }
static int drxk_read_signal_strength(struct dvb_frontend *fe, u16 *strength) static int drxk_read_signal_strength(struct dvb_frontend *fe,
u16 *strength)
{ {
struct drxk_state *state = fe->demodulator_priv; struct drxk_state *state = fe->demodulator_priv;
u32 val; u32 val;
ReadIFAgc(state, &val); ReadIFAgc(state, &val);
*strength = val & 0xffff;; *strength = val & 0xffff;
return 0; return 0;
} }
...@@ -4861,7 +5181,7 @@ static int drxk_read_snr(struct dvb_frontend *fe, u16 *snr) ...@@ -4861,7 +5181,7 @@ static int drxk_read_snr(struct dvb_frontend *fe, u16 *snr)
s32 snr2; s32 snr2;
GetSignalToNoise(state, &snr2); GetSignalToNoise(state, &snr2);
*snr = snr2&0xffff; *snr = snr2 & 0xffff;
return 0; return 0;
} }
...@@ -4875,44 +5195,44 @@ static int drxk_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks) ...@@ -4875,44 +5195,44 @@ static int drxk_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks)
return 0; return 0;
} }
static int drxk_c_get_tune_settings(struct dvb_frontend *fe, static int drxk_c_get_tune_settings(struct dvb_frontend *fe, struct dvb_frontend_tune_settings
struct dvb_frontend_tune_settings *sets) *sets)
{ {
sets->min_delay_ms=3000; sets->min_delay_ms = 3000;
sets->max_drift=0; sets->max_drift = 0;
sets->step_size=0; sets->step_size = 0;
return 0; return 0;
} }
static void drxk_t_release(struct dvb_frontend* fe) static void drxk_t_release(struct dvb_frontend *fe)
{ {
//struct drxk_state *state=fe->demodulator_priv; #if 0
//printk("%s\n", __FUNCTION__); struct drxk_state *state = fe->demodulator_priv;
//kfree(state);
printk(KERN_DEBUG "%s\n", __func__);
kfree(state);
#endif
} }
static int drxk_t_init (struct dvb_frontend *fe) static int drxk_t_init(struct dvb_frontend *fe)
{ {
struct drxk_state *state=fe->demodulator_priv; struct drxk_state *state = fe->demodulator_priv;
if (mutex_trylock(&state->ctlock)==0) if (mutex_trylock(&state->ctlock) == 0)
return -EBUSY; return -EBUSY;
//printk("%s\n", __FUNCTION__);
SetOperationMode(state, OM_DVBT); SetOperationMode(state, OM_DVBT);
//printk("%s done\n", __FUNCTION__);
return 0; return 0;
} }
static int drxk_t_sleep(struct dvb_frontend* fe) static int drxk_t_sleep(struct dvb_frontend *fe)
{ {
struct drxk_state *state=fe->demodulator_priv; struct drxk_state *state = fe->demodulator_priv;
mutex_unlock(&state->ctlock); mutex_unlock(&state->ctlock);
return 0; return 0;
} }
static int drxk_t_get_frontend(struct dvb_frontend *fe, struct dvb_frontend_parameters *p) static int drxk_t_get_frontend(struct dvb_frontend *fe,
struct dvb_frontend_parameters *p)
{ {
//struct drxk_state *state = fe->demodulator_priv;
//printk("%s\n", __FUNCTION__);
return 0; return 0;
} }
...@@ -4926,8 +5246,7 @@ static struct dvb_frontend_ops drxk_c_ops = { ...@@ -4926,8 +5246,7 @@ static struct dvb_frontend_ops drxk_c_ops = {
.symbol_rate_min = 870000, .symbol_rate_min = 870000,
.symbol_rate_max = 11700000, .symbol_rate_max = 11700000,
.caps = FE_CAN_QAM_16 | FE_CAN_QAM_32 | FE_CAN_QAM_64 | .caps = FE_CAN_QAM_16 | FE_CAN_QAM_32 | FE_CAN_QAM_64 |
FE_CAN_QAM_128 | FE_CAN_QAM_256 | FE_CAN_FEC_AUTO FE_CAN_QAM_128 | FE_CAN_QAM_256 | FE_CAN_FEC_AUTO},
},
.release = drxk_c_release, .release = drxk_c_release,
.init = drxk_c_init, .init = drxk_c_init,
.sleep = drxk_c_sleep, .sleep = drxk_c_sleep,
...@@ -4959,9 +5278,7 @@ static struct dvb_frontend_ops drxk_t_ops = { ...@@ -4959,9 +5278,7 @@ static struct dvb_frontend_ops drxk_t_ops = {
FE_CAN_QAM_AUTO | FE_CAN_QAM_AUTO |
FE_CAN_TRANSMISSION_MODE_AUTO | FE_CAN_TRANSMISSION_MODE_AUTO |
FE_CAN_GUARD_INTERVAL_AUTO | FE_CAN_GUARD_INTERVAL_AUTO |
FE_CAN_HIERARCHY_AUTO | FE_CAN_RECOVER | FE_CAN_HIERARCHY_AUTO | FE_CAN_RECOVER | FE_CAN_MUTE_TS},
FE_CAN_MUTE_TS
},
.release = drxk_t_release, .release = drxk_t_release,
.init = drxk_t_init, .init = drxk_t_init,
.sleep = drxk_t_sleep, .sleep = drxk_t_sleep,
...@@ -4982,35 +5299,36 @@ struct dvb_frontend *drxk_attach(struct i2c_adapter *i2c, u8 adr, ...@@ -4982,35 +5299,36 @@ struct dvb_frontend *drxk_attach(struct i2c_adapter *i2c, u8 adr,
{ {
struct drxk_state *state = NULL; struct drxk_state *state = NULL;
state=kzalloc(sizeof(struct drxk_state), GFP_KERNEL); state = kzalloc(sizeof(struct drxk_state), GFP_KERNEL);
if (!state) if (!state)
return NULL; return NULL;
state->i2c=i2c; state->i2c = i2c;
state->demod_address=adr; state->demod_address = adr;
mutex_init(&state->mutex); mutex_init(&state->mutex);
mutex_init(&state->ctlock); mutex_init(&state->ctlock);
memcpy(&state->c_frontend.ops, &drxk_c_ops, sizeof(struct dvb_frontend_ops)); memcpy(&state->c_frontend.ops, &drxk_c_ops,
memcpy(&state->t_frontend.ops, &drxk_t_ops, sizeof(struct dvb_frontend_ops)); sizeof(struct dvb_frontend_ops));
state->c_frontend.demodulator_priv=state; memcpy(&state->t_frontend.ops, &drxk_t_ops,
state->t_frontend.demodulator_priv=state; sizeof(struct dvb_frontend_ops));
state->c_frontend.demodulator_priv = state;
state->t_frontend.demodulator_priv = state;
init_state(state); init_state(state);
if (init_drxk(state)<0) if (init_drxk(state) < 0)
goto error; goto error;
*fe_t = &state->t_frontend; *fe_t = &state->t_frontend;
return &state->c_frontend; return &state->c_frontend;
error: error:
printk("drxk: not found\n"); printk(KERN_ERR "drxk: not found\n");
kfree(state); kfree(state);
return NULL; return NULL;
} }
EXPORT_SYMBOL(drxk_attach);
MODULE_DESCRIPTION("DRX-K driver"); MODULE_DESCRIPTION("DRX-K driver");
MODULE_AUTHOR("Ralph Metzler"); MODULE_AUTHOR("Ralph Metzler");
MODULE_LICENSE("GPL"); MODULE_LICENSE("GPL");
EXPORT_SYMBOL(drxk_attach);
drivers/media/dvb/frontends/drxk_hard.h
浏览文件 @ ebc7de22
...@@ -52,7 +52,7 @@ enum OperationMode { ...@@ -52,7 +52,7 @@ enum OperationMode {
OM_DVBT OM_DVBT
}; };
typedef enum { enum DRXPowerMode {
DRX_POWER_UP = 0, DRX_POWER_UP = 0,
DRX_POWER_MODE_1, DRX_POWER_MODE_1,
DRX_POWER_MODE_2, DRX_POWER_MODE_2,
...@@ -72,7 +72,7 @@ typedef enum { ...@@ -72,7 +72,7 @@ typedef enum {
DRX_POWER_MODE_15, DRX_POWER_MODE_15,
DRX_POWER_MODE_16, DRX_POWER_MODE_16,
DRX_POWER_DOWN = 255 DRX_POWER_DOWN = 255
}DRXPowerMode_t, *pDRXPowerMode_t; };
/** /brief Intermediate power mode for DRXK, power down OFDM clock domain */ /** /brief Intermediate power mode for DRXK, power down OFDM clock domain */
...@@ -164,8 +164,7 @@ struct DRXKCfgDvbtEchoThres_t { ...@@ -164,8 +164,7 @@ struct DRXKCfgDvbtEchoThres_t {
enum DRXFftmode_t fftMode; enum DRXFftmode_t fftMode;
} ; } ;
struct SCfgAgc struct SCfgAgc {
{
enum AGC_CTRL_MODE ctrlMode; /* off, user, auto */ enum AGC_CTRL_MODE ctrlMode; /* off, user, auto */
u16 outputLevel; /* range dependent on AGC */ u16 outputLevel; /* range dependent on AGC */
u16 minOutputLevel; /* range dependent on AGC */ u16 minOutputLevel; /* range dependent on AGC */
...@@ -178,14 +177,12 @@ struct SCfgAgc ...@@ -178,14 +177,12 @@ struct SCfgAgc
u16 FastClipCtrlDelay; u16 FastClipCtrlDelay;
}; };
struct SCfgPreSaw struct SCfgPreSaw {
{
u16 reference; /* pre SAW reference value, range 0 .. 31 */ u16 reference; /* pre SAW reference value, range 0 .. 31 */
bool usePreSaw; /* TRUE algorithms must use pre SAW sense */ bool usePreSaw; /* TRUE algorithms must use pre SAW sense */
}; };
struct DRXKOfdmScCmd_t struct DRXKOfdmScCmd_t {
{
u16 cmd; /**< Command number */ u16 cmd; /**< Command number */
u16 subcmd; /**< Sub-command parameter*/ u16 subcmd; /**< Sub-command parameter*/
u16 param0; /**< General purpous param */ u16 param0; /**< General purpous param */
...@@ -208,7 +205,7 @@ struct drxk_state { ...@@ -208,7 +205,7 @@ struct drxk_state {
struct mutex mutex; struct mutex mutex;
struct mutex ctlock; struct mutex ctlock;
u32 m_Instance; ///< Channel 1,2,3 or 4 u32 m_Instance; /**< Channel 1,2,3 or 4 */
int m_ChunkSize; int m_ChunkSize;
u8 Chunk[256]; u8 Chunk[256];
...@@ -229,22 +226,22 @@ struct drxk_state { ...@@ -229,22 +226,22 @@ struct drxk_state {
u16 m_HICfgWakeUpKey; u16 m_HICfgWakeUpKey;
u16 m_HICfgTimeout; u16 m_HICfgTimeout;
u16 m_HICfgCtrl; u16 m_HICfgCtrl;
s32 m_sysClockFreq ; ///< system clock frequency in kHz s32 m_sysClockFreq; /**< system clock frequency in kHz */
enum EDrxkState m_DrxkState; ///< State of Drxk (init,stopped,started) enum EDrxkState m_DrxkState; /**< State of Drxk (init,stopped,started) */
enum OperationMode m_OperationMode; ///< digital standards enum OperationMode m_OperationMode; /**< digital standards */
struct SCfgAgc m_vsbRfAgcCfg; ///< settings for VSB RF-AGC struct SCfgAgc m_vsbRfAgcCfg; /**< settings for VSB RF-AGC */
struct SCfgAgc m_vsbIfAgcCfg; ///< settings for VSB IF-AGC struct SCfgAgc m_vsbIfAgcCfg; /**< settings for VSB IF-AGC */
u16 m_vsbPgaCfg; ///< settings for VSB PGA u16 m_vsbPgaCfg; /**< settings for VSB PGA */
struct SCfgPreSaw m_vsbPreSawCfg; ///< settings for pre SAW sense struct SCfgPreSaw m_vsbPreSawCfg; /**< settings for pre SAW sense */
s32 m_Quality83percent; ///< MER level (*0.1 dB) for 83% quality indication s32 m_Quality83percent; /**< MER level (*0.1 dB) for 83% quality indication */
s32 m_Quality93percent; ///< MER level (*0.1 dB) for 93% quality indication s32 m_Quality93percent; /**< MER level (*0.1 dB) for 93% quality indication */
bool m_smartAntInverted; bool m_smartAntInverted;
bool m_bDebugEnableBridge; bool m_bDebugEnableBridge;
bool m_bPDownOpenBridge; ///< only open DRXK bridge before power-down once it has been accessed bool m_bPDownOpenBridge; /**< only open DRXK bridge before power-down once it has been accessed */
bool m_bPowerDown; ///< Power down when not used bool m_bPowerDown; /**< Power down when not used */
u32 m_IqmFsRateOfs; ///< frequency shift as written to DRXK register (28bit fixpoint) u32 m_IqmFsRateOfs; /**< frequency shift as written to DRXK register (28bit fixpoint) */
bool m_enableMPEGOutput; /**< If TRUE, enable MPEG output */ bool m_enableMPEGOutput; /**< If TRUE, enable MPEG output */
bool m_insertRSByte; /**< If TRUE, insert RS byte */ bool m_insertRSByte; /**< If TRUE, insert RS byte */
...@@ -264,22 +261,22 @@ struct drxk_state { ...@@ -264,22 +261,22 @@ struct drxk_state {
u8 m_TSDataStrength; u8 m_TSDataStrength;
u8 m_TSClockkStrength; u8 m_TSClockkStrength;
enum DRXMPEGStrWidth_t m_widthSTR; /**< MPEG start width**/ enum DRXMPEGStrWidth_t m_widthSTR; /**< MPEG start width */
u32 m_mpegTsStaticBitrate; /**< Maximum bitrate in b/s in case u32 m_mpegTsStaticBitrate; /**< Maximum bitrate in b/s in case
static clockrate is selected */ static clockrate is selected */
//LARGE_INTEGER m_StartTime; ///< Contains the time of the last demod start /* LARGE_INTEGER m_StartTime; */ /**< Contains the time of the last demod start */
s32 m_MpegLockTimeOut; ///< WaitForLockStatus Timeout (counts from start time) s32 m_MpegLockTimeOut; /**< WaitForLockStatus Timeout (counts from start time) */
s32 m_DemodLockTimeOut; ///< WaitForLockStatus Timeout (counts from start time) s32 m_DemodLockTimeOut; /**< WaitForLockStatus Timeout (counts from start time) */
bool m_disableTEIhandling; bool m_disableTEIhandling;
bool m_RfAgcPol; bool m_RfAgcPol;
bool m_IfAgcPol; bool m_IfAgcPol;
struct SCfgAgc m_atvRfAgcCfg; ///< settings for ATV RF-AGC struct SCfgAgc m_atvRfAgcCfg; /**< settings for ATV RF-AGC */
struct SCfgAgc m_atvIfAgcCfg; ///< settings for ATV IF-AGC struct SCfgAgc m_atvIfAgcCfg; /**< settings for ATV IF-AGC */
struct SCfgPreSaw m_atvPreSawCfg; ///< settings for ATV pre SAW sense struct SCfgPreSaw m_atvPreSawCfg; /**< settings for ATV pre SAW sense */
bool m_phaseCorrectionBypass; bool m_phaseCorrectionBypass;
s16 m_atvTopVidPeak; s16 m_atvTopVidPeak;
u16 m_atvTopNoiseTh; u16 m_atvTopNoiseTh;
...@@ -287,13 +284,13 @@ struct drxk_state { ...@@ -287,13 +284,13 @@ struct drxk_state {
bool m_enableCVBSOutput; bool m_enableCVBSOutput;
bool m_enableSIFOutput; bool m_enableSIFOutput;
bool m_bMirrorFreqSpect; bool m_bMirrorFreqSpect;
enum EDrxkConstellation m_Constellation; ///< Constellation type of the channel enum EDrxkConstellation m_Constellation; /**< Constellation type of the channel */
u32 m_CurrSymbolRate; ///< Current QAM symbol rate u32 m_CurrSymbolRate; /**< Current QAM symbol rate */
struct SCfgAgc m_qamRfAgcCfg; ///< settings for QAM RF-AGC struct SCfgAgc m_qamRfAgcCfg; /**< settings for QAM RF-AGC */
struct SCfgAgc m_qamIfAgcCfg; ///< settings for QAM IF-AGC struct SCfgAgc m_qamIfAgcCfg; /**< settings for QAM IF-AGC */
u16 m_qamPgaCfg; ///< settings for QAM PGA u16 m_qamPgaCfg; /**< settings for QAM PGA */
struct SCfgPreSaw m_qamPreSawCfg; ///< settings for QAM pre SAW sense struct SCfgPreSaw m_qamPreSawCfg; /**< settings for QAM pre SAW sense */
enum EDrxkInterleaveMode m_qamInterleaveMode; ///< QAM Interleave mode enum EDrxkInterleaveMode m_qamInterleaveMode; /**< QAM Interleave mode */
u16 m_fecRsPlen; u16 m_fecRsPlen;
u16 m_fecRsPrescale; u16 m_fecRsPrescale;
...@@ -302,9 +299,9 @@ struct drxk_state { ...@@ -302,9 +299,9 @@ struct drxk_state {
u16 m_GPIO; u16 m_GPIO;
u16 m_GPIOCfg; u16 m_GPIOCfg;
struct SCfgAgc m_dvbtRfAgcCfg; ///< settings for QAM RF-AGC struct SCfgAgc m_dvbtRfAgcCfg; /**< settings for QAM RF-AGC */
struct SCfgAgc m_dvbtIfAgcCfg; ///< settings for QAM IF-AGC struct SCfgAgc m_dvbtIfAgcCfg; /**< settings for QAM IF-AGC */
struct SCfgPreSaw m_dvbtPreSawCfg; ///< settings for QAM pre SAW sense struct SCfgPreSaw m_dvbtPreSawCfg; /**< settings for QAM pre SAW sense */
u16 m_agcFastClipCtrlDelay; u16 m_agcFastClipCtrlDelay;
bool m_adcCompPassed; bool m_adcCompPassed;
...@@ -328,7 +325,7 @@ struct drxk_state { ...@@ -328,7 +325,7 @@ struct drxk_state {
u16 m_AntennaDVBT; u16 m_AntennaDVBT;
u16 m_AntennaSwitchDVBTDVBC; u16 m_AntennaSwitchDVBTDVBC;
DRXPowerMode_t m_currentPowerMode; enum DRXPowerMode m_currentPowerMode;
}; };
#define NEVER_LOCK 0 #define NEVER_LOCK 0
......
Markdown is supported
0% 或 .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑！
想要评论请 注册 或