Skip to content

L
linux
Commit 6cacdd46 authored by Devin Heitmueller's avatar Devin Heitmueller Committed by Mauro Carvalho Chehab
Browse files
Options

[media] drxd: Run lindent across sources 

Take a first cleanup pass over the sources to bring them closer to the
Linux coding style.
Signed-off-by: default avatarDevin Heitmueller <dheitmueller@kernellabs.com>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@redhat.com>
parent 9b316d6b
Show whitespace changes
Inline Side-by-side
Showing with 1829 additions and 3685 deletions
drivers/media/dvb/frontends/drxd.h
View file @ 6cacdd46
...@@ -27,8 +27,7 @@ ...@@ -27,8 +27,7 @@
#include <linux/types.h> #include <linux/types.h>
#include <linux/i2c.h> #include <linux/i2c.h>
struct drxd_config struct drxd_config {
{
u8 index; u8 index;
u8 pll_address; u8 pll_address;
...@@ -50,8 +49,8 @@ struct drxd_config ...@@ -50,8 +49,8 @@ struct drxd_config
u32 IF; u32 IF;
int (*pll_set) (void *priv, void *priv_params, int (*pll_set) (void *priv, void *priv_params,
u8 pll_addr, u8 demoda_addr, s32 *off); u8 pll_addr, u8 demoda_addr, s32 * off);
s16 (*osc_deviation) (void *priv, s16 dev, int flag); s16(*osc_deviation) (void *priv, s16 dev, int flag);
}; };
extern extern
......
drivers/media/dvb/frontends/drxd_firm.c
View file @ 6cacdd46
...@@ -46,9 +46,8 @@ ...@@ -46,9 +46,8 @@
#define HI_TR_FUNC_ADDR HI_IF_RAM_USR_BEGIN__A #define HI_TR_FUNC_ADDR HI_IF_RAM_USR_BEGIN__A
#define HI_TR_FUNC_SIZE 9 /* size of this function in instruction words */ #define HI_TR_FUNC_SIZE 9 /* size of this function in instruction words */
u8_t DRXD_InitAtomicRead[] = u8_t DRXD_InitAtomicRead[] = {
{ WRBLOCK(HI_TR_FUNC_ADDR, HI_TR_FUNC_SIZE),
WRBLOCK(HI_TR_FUNC_ADDR,HI_TR_FUNC_SIZE),
0x26, 0x00, /* 0 -> ring.rdy; */ 0x26, 0x00, /* 0 -> ring.rdy; */
0x60, 0x04, /* r0rami.dt -> ring.xba; */ 0x60, 0x04, /* r0rami.dt -> ring.xba; */
0x61, 0x04, /* r0rami.dt -> ring.xad; */ 0x61, 0x04, /* r0rami.dt -> ring.xad; */
...@@ -68,9 +67,8 @@ u8_t DRXD_InitAtomicRead[] = ...@@ -68,9 +67,8 @@ u8_t DRXD_InitAtomicRead[] =
#define HI_RST_FUNC_SIZE 54 /* size of this function in instruction words */ #define HI_RST_FUNC_SIZE 54 /* size of this function in instruction words */
/* D0 Version */ /* D0 Version */
u8_t DRXD_HiI2cPatch_1[] = u8_t DRXD_HiI2cPatch_1[] = {
{ WRBLOCK(HI_RST_FUNC_ADDR, HI_RST_FUNC_SIZE),
WRBLOCK(HI_RST_FUNC_ADDR,HI_RST_FUNC_SIZE),
0xC8, 0x07, 0x01, 0x00, /* MASK -> reg0.dt; */ 0xC8, 0x07, 0x01, 0x00, /* MASK -> reg0.dt; */
0xE0, 0x07, 0x15, 0x02, /* (EC__BLK << 6) + EC_OC_REG__BNK -> ring.xba; */ 0xE0, 0x07, 0x15, 0x02, /* (EC__BLK << 6) + EC_OC_REG__BNK -> ring.xba; */
0xE1, 0x07, 0x12, 0x00, /* EC_OC_REG_OC_MPG_SIO__A -> ring.xad; */ 0xE1, 0x07, 0x12, 0x00, /* EC_OC_REG_OC_MPG_SIO__A -> ring.xad; */
...@@ -115,20 +113,23 @@ u8_t DRXD_HiI2cPatch_1[] = ...@@ -115,20 +113,23 @@ u8_t DRXD_HiI2cPatch_1[] =
0x29, 0x00, /* M_IC_CMD_RESET -> i2c.cmd; */ 0x29, 0x00, /* M_IC_CMD_RESET -> i2c.cmd; */
0xF8, 0x07, 0x2F, 0x00, /* 0x2F -> jumps.ad; */ 0xF8, 0x07, 0x2F, 0x00, /* 0x2F -> jumps.ad; */
WR16((B_HI_IF_RAM_TRP_BPT0__AX+((2*0)+1)),(u16_t)(HI_RST_FUNC_ADDR & 0x3FF)), WR16((B_HI_IF_RAM_TRP_BPT0__AX + ((2 * 0) + 1)),
WR16((B_HI_IF_RAM_TRP_BPT0__AX+((2*1)+1)),(u16_t)(HI_RST_FUNC_ADDR & 0x3FF)), (u16_t) (HI_RST_FUNC_ADDR & 0x3FF)),
WR16((B_HI_IF_RAM_TRP_BPT0__AX+((2*2)+1)),(u16_t)(HI_RST_FUNC_ADDR & 0x3FF)), WR16((B_HI_IF_RAM_TRP_BPT0__AX + ((2 * 1) + 1)),
WR16((B_HI_IF_RAM_TRP_BPT0__AX+((2*3)+1)),(u16_t)(HI_RST_FUNC_ADDR & 0x3FF)), (u16_t) (HI_RST_FUNC_ADDR & 0x3FF)),
WR16((B_HI_IF_RAM_TRP_BPT0__AX + ((2 * 2) + 1)),
(u16_t) (HI_RST_FUNC_ADDR & 0x3FF)),
WR16((B_HI_IF_RAM_TRP_BPT0__AX + ((2 * 3) + 1)),
(u16_t) (HI_RST_FUNC_ADDR & 0x3FF)),
/* Force quick and dirty reset */ /* Force quick and dirty reset */
WR16(B_HI_CT_REG_COMM_STATE__A,0), WR16(B_HI_CT_REG_COMM_STATE__A, 0),
END_OF_TABLE END_OF_TABLE
}; };
/* D0,D1 Version */ /* D0,D1 Version */
u8_t DRXD_HiI2cPatch_3[] = u8_t DRXD_HiI2cPatch_3[] = {
{ WRBLOCK(HI_RST_FUNC_ADDR, HI_RST_FUNC_SIZE),
WRBLOCK(HI_RST_FUNC_ADDR,HI_RST_FUNC_SIZE),
0xC8, 0x07, 0x03, 0x00, /* MASK -> reg0.dt; */ 0xC8, 0x07, 0x03, 0x00, /* MASK -> reg0.dt; */
0xE0, 0x07, 0x15, 0x02, /* (EC__BLK << 6) + EC_OC_REG__BNK -> ring.xba; */ 0xE0, 0x07, 0x15, 0x02, /* (EC__BLK << 6) + EC_OC_REG__BNK -> ring.xba; */
0xE1, 0x07, 0x12, 0x00, /* EC_OC_REG_OC_MPG_SIO__A -> ring.xad; */ 0xE1, 0x07, 0x12, 0x00, /* EC_OC_REG_OC_MPG_SIO__A -> ring.xad; */
...@@ -173,161 +174,162 @@ u8_t DRXD_HiI2cPatch_3[] = ...@@ -173,161 +174,162 @@ u8_t DRXD_HiI2cPatch_3[] =
0x29, 0x00, /* M_IC_CMD_RESET -> i2c.cmd; */ 0x29, 0x00, /* M_IC_CMD_RESET -> i2c.cmd; */
0xF8, 0x07, 0x2F, 0x00, /* 0x2F -> jumps.ad; */ 0xF8, 0x07, 0x2F, 0x00, /* 0x2F -> jumps.ad; */
WR16((B_HI_IF_RAM_TRP_BPT0__AX+((2*0)+1)),(u16_t)(HI_RST_FUNC_ADDR & 0x3FF)), WR16((B_HI_IF_RAM_TRP_BPT0__AX + ((2 * 0) + 1)),
WR16((B_HI_IF_RAM_TRP_BPT0__AX+((2*1)+1)),(u16_t)(HI_RST_FUNC_ADDR & 0x3FF)), (u16_t) (HI_RST_FUNC_ADDR & 0x3FF)),
WR16((B_HI_IF_RAM_TRP_BPT0__AX+((2*2)+1)),(u16_t)(HI_RST_FUNC_ADDR & 0x3FF)), WR16((B_HI_IF_RAM_TRP_BPT0__AX + ((2 * 1) + 1)),
WR16((B_HI_IF_RAM_TRP_BPT0__AX+((2*3)+1)),(u16_t)(HI_RST_FUNC_ADDR & 0x3FF)), (u16_t) (HI_RST_FUNC_ADDR & 0x3FF)),
WR16((B_HI_IF_RAM_TRP_BPT0__AX + ((2 * 2) + 1)),
(u16_t) (HI_RST_FUNC_ADDR & 0x3FF)),
WR16((B_HI_IF_RAM_TRP_BPT0__AX + ((2 * 3) + 1)),
(u16_t) (HI_RST_FUNC_ADDR & 0x3FF)),
/* Force quick and dirty reset */ /* Force quick and dirty reset */
WR16(B_HI_CT_REG_COMM_STATE__A,0), WR16(B_HI_CT_REG_COMM_STATE__A, 0),
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_ResetCEFR[] = u8_t DRXD_ResetCEFR[] = {
{
WRBLOCK(CE_REG_FR_TREAL00__A, 57), WRBLOCK(CE_REG_FR_TREAL00__A, 57),
0x52,0x00, /* CE_REG_FR_TREAL00__A */ 0x52, 0x00, /* CE_REG_FR_TREAL00__A */
0x00,0x00, /* CE_REG_FR_TIMAG00__A */ 0x00, 0x00, /* CE_REG_FR_TIMAG00__A */
0x52,0x00, /* CE_REG_FR_TREAL01__A */ 0x52, 0x00, /* CE_REG_FR_TREAL01__A */
0x00,0x00, /* CE_REG_FR_TIMAG01__A */ 0x00, 0x00, /* CE_REG_FR_TIMAG01__A */
0x52,0x00, /* CE_REG_FR_TREAL02__A */ 0x52, 0x00, /* CE_REG_FR_TREAL02__A */
0x00,0x00, /* CE_REG_FR_TIMAG02__A */ 0x00, 0x00, /* CE_REG_FR_TIMAG02__A */
0x52,0x00, /* CE_REG_FR_TREAL03__A */ 0x52, 0x00, /* CE_REG_FR_TREAL03__A */
0x00,0x00, /* CE_REG_FR_TIMAG03__A */ 0x00, 0x00, /* CE_REG_FR_TIMAG03__A */
0x52,0x00, /* CE_REG_FR_TREAL04__A */ 0x52, 0x00, /* CE_REG_FR_TREAL04__A */
0x00,0x00, /* CE_REG_FR_TIMAG04__A */ 0x00, 0x00, /* CE_REG_FR_TIMAG04__A */
0x52,0x00, /* CE_REG_FR_TREAL05__A */ 0x52, 0x00, /* CE_REG_FR_TREAL05__A */
0x00,0x00, /* CE_REG_FR_TIMAG05__A */ 0x00, 0x00, /* CE_REG_FR_TIMAG05__A */
0x52,0x00, /* CE_REG_FR_TREAL06__A */ 0x52, 0x00, /* CE_REG_FR_TREAL06__A */
0x00,0x00, /* CE_REG_FR_TIMAG06__A */ 0x00, 0x00, /* CE_REG_FR_TIMAG06__A */
0x52,0x00, /* CE_REG_FR_TREAL07__A */ 0x52, 0x00, /* CE_REG_FR_TREAL07__A */
0x00,0x00, /* CE_REG_FR_TIMAG07__A */ 0x00, 0x00, /* CE_REG_FR_TIMAG07__A */
0x52,0x00, /* CE_REG_FR_TREAL08__A */ 0x52, 0x00, /* CE_REG_FR_TREAL08__A */
0x00,0x00, /* CE_REG_FR_TIMAG08__A */ 0x00, 0x00, /* CE_REG_FR_TIMAG08__A */
0x52,0x00, /* CE_REG_FR_TREAL09__A */ 0x52, 0x00, /* CE_REG_FR_TREAL09__A */
0x00,0x00, /* CE_REG_FR_TIMAG09__A */ 0x00, 0x00, /* CE_REG_FR_TIMAG09__A */
0x52,0x00, /* CE_REG_FR_TREAL10__A */ 0x52, 0x00, /* CE_REG_FR_TREAL10__A */
0x00,0x00, /* CE_REG_FR_TIMAG10__A */ 0x00, 0x00, /* CE_REG_FR_TIMAG10__A */
0x52,0x00, /* CE_REG_FR_TREAL11__A */ 0x52, 0x00, /* CE_REG_FR_TREAL11__A */
0x00,0x00, /* CE_REG_FR_TIMAG11__A */ 0x00, 0x00, /* CE_REG_FR_TIMAG11__A */
0x52,0x00, /* CE_REG_FR_MID_TAP__A */ 0x52, 0x00, /* CE_REG_FR_MID_TAP__A */
0x0B,0x00, /* CE_REG_FR_SQS_G00__A */ 0x0B, 0x00, /* CE_REG_FR_SQS_G00__A */
0x0B,0x00, /* CE_REG_FR_SQS_G01__A */ 0x0B, 0x00, /* CE_REG_FR_SQS_G01__A */
0x0B,0x00, /* CE_REG_FR_SQS_G02__A */ 0x0B, 0x00, /* CE_REG_FR_SQS_G02__A */
0x0B,0x00, /* CE_REG_FR_SQS_G03__A */ 0x0B, 0x00, /* CE_REG_FR_SQS_G03__A */
0x0B,0x00, /* CE_REG_FR_SQS_G04__A */ 0x0B, 0x00, /* CE_REG_FR_SQS_G04__A */
0x0B,0x00, /* CE_REG_FR_SQS_G05__A */ 0x0B, 0x00, /* CE_REG_FR_SQS_G05__A */
0x0B,0x00, /* CE_REG_FR_SQS_G06__A */ 0x0B, 0x00, /* CE_REG_FR_SQS_G06__A */
0x0B,0x00, /* CE_REG_FR_SQS_G07__A */ 0x0B, 0x00, /* CE_REG_FR_SQS_G07__A */
0x0B,0x00, /* CE_REG_FR_SQS_G08__A */ 0x0B, 0x00, /* CE_REG_FR_SQS_G08__A */
0x0B,0x00, /* CE_REG_FR_SQS_G09__A */ 0x0B, 0x00, /* CE_REG_FR_SQS_G09__A */
0x0B,0x00, /* CE_REG_FR_SQS_G10__A */ 0x0B, 0x00, /* CE_REG_FR_SQS_G10__A */
0x0B,0x00, /* CE_REG_FR_SQS_G11__A */ 0x0B, 0x00, /* CE_REG_FR_SQS_G11__A */
0x0B,0x00, /* CE_REG_FR_SQS_G12__A */ 0x0B, 0x00, /* CE_REG_FR_SQS_G12__A */
0xFF,0x01, /* CE_REG_FR_RIO_G00__A */ 0xFF, 0x01, /* CE_REG_FR_RIO_G00__A */
0x90,0x01, /* CE_REG_FR_RIO_G01__A */ 0x90, 0x01, /* CE_REG_FR_RIO_G01__A */
0x0B,0x01, /* CE_REG_FR_RIO_G02__A */ 0x0B, 0x01, /* CE_REG_FR_RIO_G02__A */
0xC8,0x00, /* CE_REG_FR_RIO_G03__A */ 0xC8, 0x00, /* CE_REG_FR_RIO_G03__A */
0xA0,0x00, /* CE_REG_FR_RIO_G04__A */ 0xA0, 0x00, /* CE_REG_FR_RIO_G04__A */
0x85,0x00, /* CE_REG_FR_RIO_G05__A */ 0x85, 0x00, /* CE_REG_FR_RIO_G05__A */
0x72,0x00, /* CE_REG_FR_RIO_G06__A */ 0x72, 0x00, /* CE_REG_FR_RIO_G06__A */
0x64,0x00, /* CE_REG_FR_RIO_G07__A */ 0x64, 0x00, /* CE_REG_FR_RIO_G07__A */
0x59,0x00, /* CE_REG_FR_RIO_G08__A */ 0x59, 0x00, /* CE_REG_FR_RIO_G08__A */
0x50,0x00, /* CE_REG_FR_RIO_G09__A */ 0x50, 0x00, /* CE_REG_FR_RIO_G09__A */
0x49,0x00, /* CE_REG_FR_RIO_G10__A */ 0x49, 0x00, /* CE_REG_FR_RIO_G10__A */
0x10,0x00, /* CE_REG_FR_MODE__A */ 0x10, 0x00, /* CE_REG_FR_MODE__A */
0x78,0x00, /* CE_REG_FR_SQS_TRH__A */ 0x78, 0x00, /* CE_REG_FR_SQS_TRH__A */
0x00,0x00, /* CE_REG_FR_RIO_GAIN__A */ 0x00, 0x00, /* CE_REG_FR_RIO_GAIN__A */
0x00,0x02, /* CE_REG_FR_BYPASS__A */ 0x00, 0x02, /* CE_REG_FR_BYPASS__A */
0x0D,0x00, /* CE_REG_FR_PM_SET__A */ 0x0D, 0x00, /* CE_REG_FR_PM_SET__A */
0x07,0x00, /* CE_REG_FR_ERR_SH__A */ 0x07, 0x00, /* CE_REG_FR_ERR_SH__A */
0x04,0x00, /* CE_REG_FR_MAN_SH__A */ 0x04, 0x00, /* CE_REG_FR_MAN_SH__A */
0x06,0x00, /* CE_REG_FR_TAP_SH__A */ 0x06, 0x00, /* CE_REG_FR_TAP_SH__A */
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_InitFEA2_1[] = {
u8_t DRXD_InitFEA2_1[] = WRBLOCK(FE_AD_REG_PD__A, 3),
{ 0x00, 0x00, /* FE_AD_REG_PD__A */
WRBLOCK(FE_AD_REG_PD__A , 3), 0x01, 0x00, /* FE_AD_REG_INVEXT__A */
0x00,0x00, /* FE_AD_REG_PD__A */ 0x00, 0x00, /* FE_AD_REG_CLKNEG__A */
0x01,0x00, /* FE_AD_REG_INVEXT__A */
0x00,0x00, /* FE_AD_REG_CLKNEG__A */ WRBLOCK(FE_AG_REG_DCE_AUR_CNT__A, 2),
0x10, 0x00, /* FE_AG_REG_DCE_AUR_CNT__A */
WRBLOCK(FE_AG_REG_DCE_AUR_CNT__A , 2), 0x10, 0x00, /* FE_AG_REG_DCE_RUR_CNT__A */
0x10,0x00, /* FE_AG_REG_DCE_AUR_CNT__A */
0x10,0x00, /* FE_AG_REG_DCE_RUR_CNT__A */ WRBLOCK(FE_AG_REG_ACE_AUR_CNT__A, 2),
0x0E, 0x00, /* FE_AG_REG_ACE_AUR_CNT__A */
WRBLOCK(FE_AG_REG_ACE_AUR_CNT__A , 2), 0x00, 0x00, /* FE_AG_REG_ACE_RUR_CNT__A */
0x0E,0x00, /* FE_AG_REG_ACE_AUR_CNT__A */
0x00,0x00, /* FE_AG_REG_ACE_RUR_CNT__A */ WRBLOCK(FE_AG_REG_EGC_FLA_RGN__A, 5),
0x04, 0x00, /* FE_AG_REG_EGC_FLA_RGN__A */
WRBLOCK(FE_AG_REG_EGC_FLA_RGN__A , 5), 0x1F, 0x00, /* FE_AG_REG_EGC_SLO_RGN__A */
0x04,0x00, /* FE_AG_REG_EGC_FLA_RGN__A */ 0x00, 0x00, /* FE_AG_REG_EGC_JMP_PSN__A */
0x1F,0x00, /* FE_AG_REG_EGC_SLO_RGN__A */ 0x00, 0x00, /* FE_AG_REG_EGC_FLA_INC__A */
0x00,0x00, /* FE_AG_REG_EGC_JMP_PSN__A */ 0x00, 0x00, /* FE_AG_REG_EGC_FLA_DEC__A */
0x00,0x00, /* FE_AG_REG_EGC_FLA_INC__A */
0x00,0x00, /* FE_AG_REG_EGC_FLA_DEC__A */ WRBLOCK(FE_AG_REG_GC1_AGC_MAX__A, 2),
0xFF, 0x01, /* FE_AG_REG_GC1_AGC_MAX__A */
WRBLOCK(FE_AG_REG_GC1_AGC_MAX__A , 2), 0x00, 0xFE, /* FE_AG_REG_GC1_AGC_MIN__A */
0xFF,0x01, /* FE_AG_REG_GC1_AGC_MAX__A */
0x00,0xFE, /* FE_AG_REG_GC1_AGC_MIN__A */ WRBLOCK(FE_AG_REG_IND_WIN__A, 29),
0x00, 0x00, /* FE_AG_REG_IND_WIN__A */
WRBLOCK(FE_AG_REG_IND_WIN__A , 29), 0x05, 0x00, /* FE_AG_REG_IND_THD_LOL__A */
0x00,0x00, /* FE_AG_REG_IND_WIN__A */ 0x0F, 0x00, /* FE_AG_REG_IND_THD_HIL__A */
0x05,0x00, /* FE_AG_REG_IND_THD_LOL__A */ 0x00, 0x00, /* FE_AG_REG_IND_DEL__A don't care */
0x0F,0x00, /* FE_AG_REG_IND_THD_HIL__A */ 0x1E, 0x00, /* FE_AG_REG_IND_PD1_WRI__A */
0x00,0x00, /* FE_AG_REG_IND_DEL__A don't care */ 0x0C, 0x00, /* FE_AG_REG_PDA_AUR_CNT__A */
0x1E,0x00, /* FE_AG_REG_IND_PD1_WRI__A */ 0x00, 0x00, /* FE_AG_REG_PDA_RUR_CNT__A */
0x0C,0x00, /* FE_AG_REG_PDA_AUR_CNT__A */ 0x00, 0x00, /* FE_AG_REG_PDA_AVE_DAT__A don't care */
0x00,0x00, /* FE_AG_REG_PDA_RUR_CNT__A */ 0x00, 0x00, /* FE_AG_REG_PDC_RUR_CNT__A */
0x00,0x00, /* FE_AG_REG_PDA_AVE_DAT__A don't care */ 0x01, 0x00, /* FE_AG_REG_PDC_SET_LVL__A */
0x00,0x00, /* FE_AG_REG_PDC_RUR_CNT__A */ 0x02, 0x00, /* FE_AG_REG_PDC_FLA_RGN__A */
0x01,0x00, /* FE_AG_REG_PDC_SET_LVL__A */ 0x00, 0x00, /* FE_AG_REG_PDC_JMP_PSN__A don't care */
0x02,0x00, /* FE_AG_REG_PDC_FLA_RGN__A */ 0xFF, 0xFF, /* FE_AG_REG_PDC_FLA_STP__A */
0x00,0x00, /* FE_AG_REG_PDC_JMP_PSN__A don't care */ 0xFF, 0xFF, /* FE_AG_REG_PDC_SLO_STP__A */
0xFF,0xFF, /* FE_AG_REG_PDC_FLA_STP__A */ 0x00, 0x1F, /* FE_AG_REG_PDC_PD2_WRI__A don't care */
0xFF,0xFF, /* FE_AG_REG_PDC_SLO_STP__A */ 0x00, 0x00, /* FE_AG_REG_PDC_MAP_DAT__A don't care */
0x00,0x1F, /* FE_AG_REG_PDC_PD2_WRI__A don't care */ 0x02, 0x00, /* FE_AG_REG_PDC_MAX__A */
0x00,0x00, /* FE_AG_REG_PDC_MAP_DAT__A don't care */ 0x0C, 0x00, /* FE_AG_REG_TGA_AUR_CNT__A */
0x02,0x00, /* FE_AG_REG_PDC_MAX__A */ 0x00, 0x00, /* FE_AG_REG_TGA_RUR_CNT__A */
0x0C,0x00, /* FE_AG_REG_TGA_AUR_CNT__A */ 0x00, 0x00, /* FE_AG_REG_TGA_AVE_DAT__A don't care */
0x00,0x00, /* FE_AG_REG_TGA_RUR_CNT__A */ 0x00, 0x00, /* FE_AG_REG_TGC_RUR_CNT__A */
0x00,0x00, /* FE_AG_REG_TGA_AVE_DAT__A don't care */ 0x22, 0x00, /* FE_AG_REG_TGC_SET_LVL__A */
0x00,0x00, /* FE_AG_REG_TGC_RUR_CNT__A */ 0x15, 0x00, /* FE_AG_REG_TGC_FLA_RGN__A */
0x22,0x00, /* FE_AG_REG_TGC_SET_LVL__A */ 0x00, 0x00, /* FE_AG_REG_TGC_JMP_PSN__A don't care */
0x15,0x00, /* FE_AG_REG_TGC_FLA_RGN__A */ 0x01, 0x00, /* FE_AG_REG_TGC_FLA_STP__A */
0x00,0x00, /* FE_AG_REG_TGC_JMP_PSN__A don't care */ 0x0A, 0x00, /* FE_AG_REG_TGC_SLO_STP__A */
0x01,0x00, /* FE_AG_REG_TGC_FLA_STP__A */ 0x00, 0x00, /* FE_AG_REG_TGC_MAP_DAT__A don't care */
0x0A,0x00, /* FE_AG_REG_TGC_SLO_STP__A */ 0x10, 0x00, /* FE_AG_REG_FGA_AUR_CNT__A */
0x00,0x00, /* FE_AG_REG_TGC_MAP_DAT__A don't care */ 0x10, 0x00, /* FE_AG_REG_FGA_RUR_CNT__A */
0x10,0x00, /* FE_AG_REG_FGA_AUR_CNT__A */
0x10,0x00, /* FE_AG_REG_FGA_RUR_CNT__A */ WRBLOCK(FE_AG_REG_BGC_FGC_WRI__A, 2),
0x00, 0x00, /* FE_AG_REG_BGC_FGC_WRI__A */
WRBLOCK(FE_AG_REG_BGC_FGC_WRI__A , 2), 0x00, 0x00, /* FE_AG_REG_BGC_CGC_WRI__A */
0x00,0x00, /* FE_AG_REG_BGC_FGC_WRI__A */
0x00,0x00, /* FE_AG_REG_BGC_CGC_WRI__A */ WRBLOCK(FE_FD_REG_SCL__A, 3),
0x05, 0x00, /* FE_FD_REG_SCL__A */
WRBLOCK(FE_FD_REG_SCL__A , 3), 0x03, 0x00, /* FE_FD_REG_MAX_LEV__A */
0x05,0x00, /* FE_FD_REG_SCL__A */ 0x05, 0x00, /* FE_FD_REG_NR__A */
0x03,0x00, /* FE_FD_REG_MAX_LEV__A */
0x05,0x00, /* FE_FD_REG_NR__A */ WRBLOCK(FE_CF_REG_SCL__A, 5),
0x16, 0x00, /* FE_CF_REG_SCL__A */
WRBLOCK(FE_CF_REG_SCL__A , 5), 0x04, 0x00, /* FE_CF_REG_MAX_LEV__A */
0x16,0x00, /* FE_CF_REG_SCL__A */ 0x06, 0x00, /* FE_CF_REG_NR__A */
0x04,0x00, /* FE_CF_REG_MAX_LEV__A */ 0x00, 0x00, /* FE_CF_REG_IMP_VAL__A */
0x06,0x00, /* FE_CF_REG_NR__A */ 0x01, 0x00, /* FE_CF_REG_MEAS_VAL__A */
0x00,0x00, /* FE_CF_REG_IMP_VAL__A */
0x01,0x00, /* FE_CF_REG_MEAS_VAL__A */ WRBLOCK(FE_CU_REG_FRM_CNT_RST__A, 2),
0x00, 0x08, /* FE_CU_REG_FRM_CNT_RST__A */
WRBLOCK(FE_CU_REG_FRM_CNT_RST__A , 2), 0x00, 0x00, /* FE_CU_REG_FRM_CNT_STR__A */
0x00,0x08, /* FE_CU_REG_FRM_CNT_RST__A */
0x00,0x00, /* FE_CU_REG_FRM_CNT_STR__A */
END_OF_TABLE END_OF_TABLE
}; };
...@@ -339,254 +341,242 @@ u8_t DRXD_InitFEA2_1[] = ...@@ -339,254 +341,242 @@ u8_t DRXD_InitFEA2_1[] =
/* WR16(FE_AG_REG_AG_AGC_SIO__A, (extAttr -> FeAgRegAgAgcSio), 0x0000 );*/ /* WR16(FE_AG_REG_AG_AGC_SIO__A, (extAttr -> FeAgRegAgAgcSio), 0x0000 );*/
/* WR16(FE_AG_REG_AG_PWD__A ,(extAttr -> FeAgRegAgPwd), 0x0000 );*/ /* WR16(FE_AG_REG_AG_PWD__A ,(extAttr -> FeAgRegAgPwd), 0x0000 );*/
u8_t DRXD_InitFEA2_2[] = u8_t DRXD_InitFEA2_2[] = {
{
WR16(FE_AG_REG_CDR_RUR_CNT__A, 0x0010), WR16(FE_AG_REG_CDR_RUR_CNT__A, 0x0010),
WR16(FE_AG_REG_FGM_WRI__A , 48), WR16(FE_AG_REG_FGM_WRI__A, 48),
/* Activate measurement, activate scale */ /* Activate measurement, activate scale */
WR16(FE_FD_REG_MEAS_VAL__A , 0x0001), WR16(FE_FD_REG_MEAS_VAL__A, 0x0001),
WR16(FE_CU_REG_COMM_EXEC__A, 0x0001), WR16(FE_CU_REG_COMM_EXEC__A, 0x0001),
WR16(FE_CF_REG_COMM_EXEC__A, 0x0001), WR16(FE_CF_REG_COMM_EXEC__A, 0x0001),
WR16(FE_IF_REG_COMM_EXEC__A, 0x0001), WR16(FE_IF_REG_COMM_EXEC__A, 0x0001),
WR16(FE_FD_REG_COMM_EXEC__A, 0x0001), WR16(FE_FD_REG_COMM_EXEC__A, 0x0001),
WR16(FE_FS_REG_COMM_EXEC__A, 0x0001), WR16(FE_FS_REG_COMM_EXEC__A, 0x0001),
WR16(FE_AD_REG_COMM_EXEC__A , 0x0001), WR16(FE_AD_REG_COMM_EXEC__A, 0x0001),
WR16(FE_AG_REG_COMM_EXEC__A , 0x0001), WR16(FE_AG_REG_COMM_EXEC__A, 0x0001),
WR16(FE_AG_REG_AG_MODE_LOP__A , 0x895E), WR16(FE_AG_REG_AG_MODE_LOP__A, 0x895E),
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_InitFEB1_1[] = u8_t DRXD_InitFEB1_1[] = {
{ WR16(B_FE_AD_REG_PD__A, 0x0000),
WR16(B_FE_AD_REG_PD__A ,0x0000 ), WR16(B_FE_AD_REG_CLKNEG__A, 0x0000),
WR16(B_FE_AD_REG_CLKNEG__A ,0x0000 ), WR16(B_FE_AG_REG_BGC_FGC_WRI__A, 0x0000),
WR16(B_FE_AG_REG_BGC_FGC_WRI__A ,0x0000 ), WR16(B_FE_AG_REG_BGC_CGC_WRI__A, 0x0000),
WR16(B_FE_AG_REG_BGC_CGC_WRI__A ,0x0000 ), WR16(B_FE_AG_REG_AG_MODE_LOP__A, 0x000a),
WR16(B_FE_AG_REG_AG_MODE_LOP__A ,0x000a ), WR16(B_FE_AG_REG_IND_PD1_WRI__A, 35),
WR16(B_FE_AG_REG_IND_PD1_WRI__A ,35 ), WR16(B_FE_AG_REG_IND_WIN__A, 0),
WR16(B_FE_AG_REG_IND_WIN__A ,0 ), WR16(B_FE_AG_REG_IND_THD_LOL__A, 8),
WR16(B_FE_AG_REG_IND_THD_LOL__A ,8 ), WR16(B_FE_AG_REG_IND_THD_HIL__A, 8),
WR16(B_FE_AG_REG_IND_THD_HIL__A ,8 ), WR16(B_FE_CF_REG_IMP_VAL__A, 1),
WR16(B_FE_CF_REG_IMP_VAL__A ,1 ), WR16(B_FE_AG_REG_EGC_FLA_RGN__A, 7),
WR16(B_FE_AG_REG_EGC_FLA_RGN__A ,7 ),
END_OF_TABLE END_OF_TABLE
}; };
/* with PGA */ /* with PGA */
/* WR16(B_FE_AG_REG_AG_PGA_MODE__A , 0x0000, 0x0000); */ /* WR16(B_FE_AG_REG_AG_PGA_MODE__A , 0x0000, 0x0000); */
/* without PGA */ /* without PGA */
/* WR16(B_FE_AG_REG_AG_PGA_MODE__A , /* WR16(B_FE_AG_REG_AG_PGA_MODE__A ,
B_FE_AG_REG_AG_PGA_MODE_PFN_PCN_AFY_REN, 0x0000);*/ B_FE_AG_REG_AG_PGA_MODE_PFN_PCN_AFY_REN, 0x0000);*/
/* WR16(B_FE_AG_REG_AG_AGC_SIO__A,(extAttr -> FeAgRegAgAgcSio), 0x0000 );*//*added HS 23-05-2005*/ /* WR16(B_FE_AG_REG_AG_AGC_SIO__A,(extAttr -> FeAgRegAgAgcSio), 0x0000 );*//*added HS 23-05-2005 */
/* WR16(B_FE_AG_REG_AG_PWD__A ,(extAttr -> FeAgRegAgPwd), 0x0000 );*/ /* WR16(B_FE_AG_REG_AG_PWD__A ,(extAttr -> FeAgRegAgPwd), 0x0000 );*/
u8_t DRXD_InitFEB1_2[] = u8_t DRXD_InitFEB1_2[] = {
{ WR16(B_FE_COMM_EXEC__A, 0x0001),
WR16(B_FE_COMM_EXEC__A ,0x0001 ),
/* RF-AGC setup */ /* RF-AGC setup */
WR16(B_FE_AG_REG_PDA_AUR_CNT__A , 0x0C ), WR16(B_FE_AG_REG_PDA_AUR_CNT__A, 0x0C),
WR16(B_FE_AG_REG_PDC_SET_LVL__A , 0x01 ), WR16(B_FE_AG_REG_PDC_SET_LVL__A, 0x01),
WR16(B_FE_AG_REG_PDC_FLA_RGN__A , 0x02 ), WR16(B_FE_AG_REG_PDC_FLA_RGN__A, 0x02),
WR16(B_FE_AG_REG_PDC_FLA_STP__A , 0xFFFF ), WR16(B_FE_AG_REG_PDC_FLA_STP__A, 0xFFFF),
WR16(B_FE_AG_REG_PDC_SLO_STP__A , 0xFFFF ), WR16(B_FE_AG_REG_PDC_SLO_STP__A, 0xFFFF),
WR16(B_FE_AG_REG_PDC_MAX__A , 0x02 ), WR16(B_FE_AG_REG_PDC_MAX__A, 0x02),
WR16(B_FE_AG_REG_TGA_AUR_CNT__A , 0x0C ), WR16(B_FE_AG_REG_TGA_AUR_CNT__A, 0x0C),
WR16(B_FE_AG_REG_TGC_SET_LVL__A , 0x22 ), WR16(B_FE_AG_REG_TGC_SET_LVL__A, 0x22),
WR16(B_FE_AG_REG_TGC_FLA_RGN__A , 0x15 ), WR16(B_FE_AG_REG_TGC_FLA_RGN__A, 0x15),
WR16(B_FE_AG_REG_TGC_FLA_STP__A , 0x01 ), WR16(B_FE_AG_REG_TGC_FLA_STP__A, 0x01),
WR16(B_FE_AG_REG_TGC_SLO_STP__A , 0x0A ), WR16(B_FE_AG_REG_TGC_SLO_STP__A, 0x0A),
WR16(B_FE_CU_REG_DIV_NFC_CLP__A , 0 ), WR16(B_FE_CU_REG_DIV_NFC_CLP__A, 0),
WR16(B_FE_CU_REG_CTR_NFC_OCR__A , 25000 ), WR16(B_FE_CU_REG_CTR_NFC_OCR__A, 25000),
WR16(B_FE_CU_REG_CTR_NFC_ICR__A , 1 ), WR16(B_FE_CU_REG_CTR_NFC_ICR__A, 1),
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_InitCPA2[] = u8_t DRXD_InitCPA2[] = {
{ WRBLOCK(CP_REG_BR_SPL_OFFSET__A, 2),
WRBLOCK(CP_REG_BR_SPL_OFFSET__A , 2), 0x07, 0x00, /* CP_REG_BR_SPL_OFFSET__A */
0x07,0x00, /* CP_REG_BR_SPL_OFFSET__A */ 0x0A, 0x00, /* CP_REG_BR_STR_DEL__A */
0x0A,0x00, /* CP_REG_BR_STR_DEL__A */
WRBLOCK(CP_REG_RT_ANG_INC0__A, 4),
WRBLOCK(CP_REG_RT_ANG_INC0__A , 4), 0x00, 0x00, /* CP_REG_RT_ANG_INC0__A */
0x00,0x00, /* CP_REG_RT_ANG_INC0__A */ 0x00, 0x00, /* CP_REG_RT_ANG_INC1__A */
0x00,0x00, /* CP_REG_RT_ANG_INC1__A */ 0x03, 0x00, /* CP_REG_RT_DETECT_ENA__A */
0x03,0x00, /* CP_REG_RT_DETECT_ENA__A */ 0x03, 0x00, /* CP_REG_RT_DETECT_TRH__A */
0x03,0x00, /* CP_REG_RT_DETECT_TRH__A */
WRBLOCK(CP_REG_AC_NEXP_OFFS__A, 5),
WRBLOCK(CP_REG_AC_NEXP_OFFS__A , 5), 0x32, 0x00, /* CP_REG_AC_NEXP_OFFS__A */
0x32,0x00, /* CP_REG_AC_NEXP_OFFS__A */ 0x62, 0x00, /* CP_REG_AC_AVER_POW__A */
0x62,0x00, /* CP_REG_AC_AVER_POW__A */ 0x82, 0x00, /* CP_REG_AC_MAX_POW__A */
0x82,0x00, /* CP_REG_AC_MAX_POW__A */ 0x26, 0x00, /* CP_REG_AC_WEIGHT_MAN__A */
0x26,0x00, /* CP_REG_AC_WEIGHT_MAN__A */ 0x0F, 0x00, /* CP_REG_AC_WEIGHT_EXP__A */
0x0F,0x00, /* CP_REG_AC_WEIGHT_EXP__A */
WRBLOCK(CP_REG_AC_AMP_MODE__A, 2),
WRBLOCK(CP_REG_AC_AMP_MODE__A ,2), 0x02, 0x00, /* CP_REG_AC_AMP_MODE__A */
0x02,0x00, /* CP_REG_AC_AMP_MODE__A */ 0x01, 0x00, /* CP_REG_AC_AMP_FIX__A */
0x01,0x00, /* CP_REG_AC_AMP_FIX__A */
WR16(CP_REG_INTERVAL__A, 0x0005),
WR16(CP_REG_INTERVAL__A , 0x0005 ), WR16(CP_REG_RT_EXP_MARG__A, 0x0004),
WR16(CP_REG_RT_EXP_MARG__A , 0x0004 ), WR16(CP_REG_AC_ANG_MODE__A, 0x0003),
WR16(CP_REG_AC_ANG_MODE__A , 0x0003 ),
WR16(CP_REG_COMM_EXEC__A, 0x0001),
WR16(CP_REG_COMM_EXEC__A , 0x0001 ),
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_InitCPB1[] = u8_t DRXD_InitCPB1[] = {
{ WR16(B_CP_REG_BR_SPL_OFFSET__A, 0x0008),
WR16(B_CP_REG_BR_SPL_OFFSET__A ,0x0008 ), WR16(B_CP_COMM_EXEC__A, 0x0001),
WR16(B_CP_COMM_EXEC__A ,0x0001 ),
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_InitCEA2[] = {
WRBLOCK(CE_REG_AVG_POW__A, 4),
0x62, 0x00, /* CE_REG_AVG_POW__A */
0x78, 0x00, /* CE_REG_MAX_POW__A */
0x62, 0x00, /* CE_REG_ATT__A */
0x17, 0x00, /* CE_REG_NRED__A */
u8_t DRXD_InitCEA2[] = WRBLOCK(CE_REG_NE_ERR_SELECT__A, 2),
{ 0x07, 0x00, /* CE_REG_NE_ERR_SELECT__A */
WRBLOCK(CE_REG_AVG_POW__A , 4), 0xEB, 0xFF, /* CE_REG_NE_TD_CAL__A */
0x62,0x00, /* CE_REG_AVG_POW__A */
0x78,0x00, /* CE_REG_MAX_POW__A */
0x62,0x00, /* CE_REG_ATT__A */
0x17,0x00, /* CE_REG_NRED__A */
WRBLOCK(CE_REG_NE_ERR_SELECT__A , 2),
0x07,0x00, /* CE_REG_NE_ERR_SELECT__A */
0xEB,0xFF, /* CE_REG_NE_TD_CAL__A */
WRBLOCK(CE_REG_NE_MIXAVG__A , 2),
0x06,0x00, /* CE_REG_NE_MIXAVG__A */
0x00,0x00, /* CE_REG_NE_NUPD_OFS__A */
WRBLOCK(CE_REG_PE_NEXP_OFFS__A , 2), WRBLOCK(CE_REG_NE_MIXAVG__A, 2),
0x00,0x00, /* CE_REG_PE_NEXP_OFFS__A */ 0x06, 0x00, /* CE_REG_NE_MIXAVG__A */
0x00,0x00, /* CE_REG_PE_TIMESHIFT__A */ 0x00, 0x00, /* CE_REG_NE_NUPD_OFS__A */
WRBLOCK(CE_REG_TP_A0_TAP_NEW__A , 3), WRBLOCK(CE_REG_PE_NEXP_OFFS__A, 2),
0x00,0x01, /* CE_REG_TP_A0_TAP_NEW__A */ 0x00, 0x00, /* CE_REG_PE_NEXP_OFFS__A */
0x01,0x00, /* CE_REG_TP_A0_TAP_NEW_VALID__A */ 0x00, 0x00, /* CE_REG_PE_TIMESHIFT__A */
0x0E,0x00, /* CE_REG_TP_A0_MU_LMS_STEP__A */
WRBLOCK(CE_REG_TP_A1_TAP_NEW__A , 3), WRBLOCK(CE_REG_TP_A0_TAP_NEW__A, 3),
0x00,0x00, /* CE_REG_TP_A1_TAP_NEW__A */ 0x00, 0x01, /* CE_REG_TP_A0_TAP_NEW__A */
0x01,0x00, /* CE_REG_TP_A1_TAP_NEW_VALID__A */ 0x01, 0x00, /* CE_REG_TP_A0_TAP_NEW_VALID__A */
0x0A,0x00, /* CE_REG_TP_A1_MU_LMS_STEP__A */ 0x0E, 0x00, /* CE_REG_TP_A0_MU_LMS_STEP__A */
WRBLOCK(CE_REG_FI_SHT_INCR__A , 2), WRBLOCK(CE_REG_TP_A1_TAP_NEW__A, 3),
0x12,0x00, /* CE_REG_FI_SHT_INCR__A */ 0x00, 0x00, /* CE_REG_TP_A1_TAP_NEW__A */
0x0C,0x00, /* CE_REG_FI_EXP_NORM__A */ 0x01, 0x00, /* CE_REG_TP_A1_TAP_NEW_VALID__A */
0x0A, 0x00, /* CE_REG_TP_A1_MU_LMS_STEP__A */
WRBLOCK(CE_REG_IR_INPUTSEL__A , 3), WRBLOCK(CE_REG_FI_SHT_INCR__A, 2),
0x00,0x00, /* CE_REG_IR_INPUTSEL__A */ 0x12, 0x00, /* CE_REG_FI_SHT_INCR__A */
0x00,0x00, /* CE_REG_IR_STARTPOS__A */ 0x0C, 0x00, /* CE_REG_FI_EXP_NORM__A */
0xFF,0x00, /* CE_REG_IR_NEXP_THRES__A */
WRBLOCK(CE_REG_IR_INPUTSEL__A, 3),
0x00, 0x00, /* CE_REG_IR_INPUTSEL__A */
0x00, 0x00, /* CE_REG_IR_STARTPOS__A */
0xFF, 0x00, /* CE_REG_IR_NEXP_THRES__A */
WR16(CE_REG_TI_NEXP_OFFS__A ,0x0000), WR16(CE_REG_TI_NEXP_OFFS__A, 0x0000),
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_InitCEB1[] = u8_t DRXD_InitCEB1[] = {
{ WR16(B_CE_REG_TI_PHN_ENABLE__A, 0x0001),
WR16(B_CE_REG_TI_PHN_ENABLE__A ,0x0001), WR16(B_CE_REG_FR_PM_SET__A, 0x000D),
WR16(B_CE_REG_FR_PM_SET__A ,0x000D),
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_InitEQA2[] = u8_t DRXD_InitEQA2[] = {
{ WRBLOCK(EQ_REG_OT_QNT_THRES0__A, 4),
WRBLOCK(EQ_REG_OT_QNT_THRES0__A , 4), 0x1E, 0x00, /* EQ_REG_OT_QNT_THRES0__A */
0x1E,0x00, /* EQ_REG_OT_QNT_THRES0__A */ 0x1F, 0x00, /* EQ_REG_OT_QNT_THRES1__A */
0x1F,0x00, /* EQ_REG_OT_QNT_THRES1__A */ 0x06, 0x00, /* EQ_REG_OT_CSI_STEP__A */
0x06,0x00, /* EQ_REG_OT_CSI_STEP__A */ 0x02, 0x00, /* EQ_REG_OT_CSI_OFFSET__A */
0x02,0x00, /* EQ_REG_OT_CSI_OFFSET__A */
WR16(EQ_REG_TD_REQ_SMB_CNT__A, 0x0200),
WR16(EQ_REG_TD_REQ_SMB_CNT__A ,0x0200 ), WR16(EQ_REG_IS_CLIP_EXP__A, 0x001F),
WR16(EQ_REG_IS_CLIP_EXP__A ,0x001F ), WR16(EQ_REG_SN_OFFSET__A, (u16_t) (-7)),
WR16(EQ_REG_SN_OFFSET__A ,(u16_t)(-7) ), WR16(EQ_REG_RC_SEL_CAR__A, 0x0002),
WR16(EQ_REG_RC_SEL_CAR__A ,0x0002 ), WR16(EQ_REG_COMM_EXEC__A, 0x0001),
WR16(EQ_REG_COMM_EXEC__A ,0x0001 ),
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_InitEQB1[] = u8_t DRXD_InitEQB1[] = {
{ WR16(B_EQ_REG_COMM_EXEC__A, 0x0001),
WR16(B_EQ_REG_COMM_EXEC__A ,0x0001 ),
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_ResetECRAM[] = u8_t DRXD_ResetECRAM[] = {
{
/* Reset packet sync bytes in EC_VD ram */ /* Reset packet sync bytes in EC_VD ram */
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 0*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (0 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 1*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (1 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 2*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (2 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 3*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (3 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 4*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (4 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 5*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (5 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 6*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (6 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 7*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (7 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 8*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (8 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 9*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (9 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (10*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (10 * 17), 0x0000),
/* Reset packet sync bytes in EC_RS ram */ /* Reset packet sync bytes in EC_RS ram */
WR16(EC_RS_EC_RAM__A , 0x0000 ), WR16(EC_RS_EC_RAM__A, 0x0000),
WR16(EC_RS_EC_RAM__A + 204 , 0x0000 ), WR16(EC_RS_EC_RAM__A + 204, 0x0000),
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_InitECA2[] = u8_t DRXD_InitECA2[] = {
{ WRBLOCK(EC_SB_REG_CSI_HI__A, 6),
WRBLOCK( EC_SB_REG_CSI_HI__A , 6), 0x1F, 0x00, /* EC_SB_REG_CSI_HI__A */
0x1F,0x00, /* EC_SB_REG_CSI_HI__A */ 0x1E, 0x00, /* EC_SB_REG_CSI_LO__A */
0x1E,0x00, /* EC_SB_REG_CSI_LO__A */ 0x01, 0x00, /* EC_SB_REG_SMB_TGL__A */
0x01,0x00, /* EC_SB_REG_SMB_TGL__A */ 0x7F, 0x00, /* EC_SB_REG_SNR_HI__A */
0x7F,0x00, /* EC_SB_REG_SNR_HI__A */ 0x7F, 0x00, /* EC_SB_REG_SNR_MID__A */
0x7F,0x00, /* EC_SB_REG_SNR_MID__A */ 0x7F, 0x00, /* EC_SB_REG_SNR_LO__A */
0x7F,0x00, /* EC_SB_REG_SNR_LO__A */
WRBLOCK(EC_RS_REG_REQ_PCK_CNT__A, 2),
WRBLOCK( EC_RS_REG_REQ_PCK_CNT__A , 2), 0x00, 0x10, /* EC_RS_REG_REQ_PCK_CNT__A */
0x00,0x10, /* EC_RS_REG_REQ_PCK_CNT__A */
DATA16(EC_RS_REG_VAL_PCK), /* EC_RS_REG_VAL__A */ DATA16(EC_RS_REG_VAL_PCK), /* EC_RS_REG_VAL__A */
WRBLOCK( EC_OC_REG_TMD_TOP_MODE__A , 5), WRBLOCK(EC_OC_REG_TMD_TOP_MODE__A, 5),
0x03,0x00, /* EC_OC_REG_TMD_TOP_MODE__A */ 0x03, 0x00, /* EC_OC_REG_TMD_TOP_MODE__A */
0xF4,0x01, /* EC_OC_REG_TMD_TOP_CNT__A */ 0xF4, 0x01, /* EC_OC_REG_TMD_TOP_CNT__A */
0xC0,0x03, /* EC_OC_REG_TMD_HIL_MAR__A */ 0xC0, 0x03, /* EC_OC_REG_TMD_HIL_MAR__A */
0x40,0x00, /* EC_OC_REG_TMD_LOL_MAR__A */ 0x40, 0x00, /* EC_OC_REG_TMD_LOL_MAR__A */
0x03,0x00, /* EC_OC_REG_TMD_CUR_CNT__A */ 0x03, 0x00, /* EC_OC_REG_TMD_CUR_CNT__A */
WRBLOCK( EC_OC_REG_AVR_ASH_CNT__A , 2), WRBLOCK(EC_OC_REG_AVR_ASH_CNT__A, 2),
0x06,0x00, /* EC_OC_REG_AVR_ASH_CNT__A */ 0x06, 0x00, /* EC_OC_REG_AVR_ASH_CNT__A */
0x02,0x00, /* EC_OC_REG_AVR_BSH_CNT__A */ 0x02, 0x00, /* EC_OC_REG_AVR_BSH_CNT__A */
WRBLOCK( EC_OC_REG_RCN_MODE__A , 7), WRBLOCK(EC_OC_REG_RCN_MODE__A, 7),
0x07,0x00, /* EC_OC_REG_RCN_MODE__A */ 0x07, 0x00, /* EC_OC_REG_RCN_MODE__A */
0x00,0x00, /* EC_OC_REG_RCN_CRA_LOP__A */ 0x00, 0x00, /* EC_OC_REG_RCN_CRA_LOP__A */
0xc0,0x00, /* EC_OC_REG_RCN_CRA_HIP__A */ 0xc0, 0x00, /* EC_OC_REG_RCN_CRA_HIP__A */
0x00,0x10, /* EC_OC_REG_RCN_CST_LOP__A */ 0x00, 0x10, /* EC_OC_REG_RCN_CST_LOP__A */
0x00,0x00, /* EC_OC_REG_RCN_CST_HIP__A */ 0x00, 0x00, /* EC_OC_REG_RCN_CST_HIP__A */
0xFF,0x01, /* EC_OC_REG_RCN_SET_LVL__A */ 0xFF, 0x01, /* EC_OC_REG_RCN_SET_LVL__A */
0x0D,0x00, /* EC_OC_REG_RCN_GAI_LVL__A */ 0x0D, 0x00, /* EC_OC_REG_RCN_GAI_LVL__A */
WRBLOCK( EC_OC_REG_RCN_CLP_LOP__A , 2), WRBLOCK(EC_OC_REG_RCN_CLP_LOP__A, 2),
0x00,0x00, /* EC_OC_REG_RCN_CLP_LOP__A */ 0x00, 0x00, /* EC_OC_REG_RCN_CLP_LOP__A */
0xC0,0x00, /* EC_OC_REG_RCN_CLP_HIP__A */ 0xC0, 0x00, /* EC_OC_REG_RCN_CLP_HIP__A */
WR16(EC_SB_REG_CSI_OFS__A , 0x0001 ), WR16(EC_SB_REG_CSI_OFS__A, 0x0001),
WR16(EC_VD_REG_FORCE__A , 0x0002 ), WR16(EC_VD_REG_FORCE__A, 0x0002),
WR16(EC_VD_REG_REQ_SMB_CNT__A , 0x0001 ), WR16(EC_VD_REG_REQ_SMB_CNT__A, 0x0001),
WR16(EC_VD_REG_RLK_ENA__A , 0x0001 ), WR16(EC_VD_REG_RLK_ENA__A, 0x0001),
WR16(EC_OD_REG_SYNC__A , 0x0664 ), WR16(EC_OD_REG_SYNC__A, 0x0664),
WR16(EC_OC_REG_OC_MON_SIO__A , 0x0000 ), WR16(EC_OC_REG_OC_MON_SIO__A, 0x0000),
WR16(EC_OC_REG_SNC_ISC_LVL__A , 0x0D0C ), WR16(EC_OC_REG_SNC_ISC_LVL__A, 0x0D0C),
/* Output zero on monitorbus pads, power saving */ /* Output zero on monitorbus pads, power saving */
WR16(EC_OC_REG_OCR_MON_UOS__A , WR16(EC_OC_REG_OCR_MON_UOS__A,
( EC_OC_REG_OCR_MON_UOS_DAT_0_ENABLE | (EC_OC_REG_OCR_MON_UOS_DAT_0_ENABLE |
EC_OC_REG_OCR_MON_UOS_DAT_1_ENABLE | EC_OC_REG_OCR_MON_UOS_DAT_1_ENABLE |
EC_OC_REG_OCR_MON_UOS_DAT_2_ENABLE | EC_OC_REG_OCR_MON_UOS_DAT_2_ENABLE |
EC_OC_REG_OCR_MON_UOS_DAT_3_ENABLE | EC_OC_REG_OCR_MON_UOS_DAT_3_ENABLE |
...@@ -597,127 +587,125 @@ u8_t DRXD_InitECA2[] = ...@@ -597,127 +587,125 @@ u8_t DRXD_InitECA2[] =
EC_OC_REG_OCR_MON_UOS_DAT_8_ENABLE | EC_OC_REG_OCR_MON_UOS_DAT_8_ENABLE |
EC_OC_REG_OCR_MON_UOS_DAT_9_ENABLE | EC_OC_REG_OCR_MON_UOS_DAT_9_ENABLE |
EC_OC_REG_OCR_MON_UOS_VAL_ENABLE | EC_OC_REG_OCR_MON_UOS_VAL_ENABLE |
EC_OC_REG_OCR_MON_UOS_CLK_ENABLE ) ), EC_OC_REG_OCR_MON_UOS_CLK_ENABLE)),
WR16(EC_OC_REG_OCR_MON_WRI__A, WR16(EC_OC_REG_OCR_MON_WRI__A,
EC_OC_REG_OCR_MON_WRI_INIT ), EC_OC_REG_OCR_MON_WRI_INIT),
/* CHK_ERROR(ResetECRAM(demod)); */ /* CHK_ERROR(ResetECRAM(demod)); */
/* Reset packet sync bytes in EC_VD ram */ /* Reset packet sync bytes in EC_VD ram */
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 0*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (0 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 1*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (1 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 2*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (2 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 3*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (3 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 4*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (4 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 5*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (5 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 6*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (6 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 7*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (7 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 8*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (8 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 9*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (9 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (10*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (10 * 17), 0x0000),
/* Reset packet sync bytes in EC_RS ram */ /* Reset packet sync bytes in EC_RS ram */
WR16(EC_RS_EC_RAM__A , 0x0000 ), WR16(EC_RS_EC_RAM__A, 0x0000),
WR16(EC_RS_EC_RAM__A + 204 , 0x0000 ), WR16(EC_RS_EC_RAM__A + 204, 0x0000),
WR16(EC_SB_REG_COMM_EXEC__A , 0x0001 ), WR16(EC_SB_REG_COMM_EXEC__A, 0x0001),
WR16(EC_VD_REG_COMM_EXEC__A , 0x0001 ), WR16(EC_VD_REG_COMM_EXEC__A, 0x0001),
WR16(EC_OD_REG_COMM_EXEC__A , 0x0001 ), WR16(EC_OD_REG_COMM_EXEC__A, 0x0001),
WR16(EC_RS_REG_COMM_EXEC__A , 0x0001 ), WR16(EC_RS_REG_COMM_EXEC__A, 0x0001),
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_InitECB1[] = u8_t DRXD_InitECB1[] = {
{ WR16(B_EC_SB_REG_CSI_OFS0__A, 0x0001),
WR16(B_EC_SB_REG_CSI_OFS0__A ,0x0001 ), WR16(B_EC_SB_REG_CSI_OFS1__A, 0x0001),
WR16(B_EC_SB_REG_CSI_OFS1__A ,0x0001 ), WR16(B_EC_SB_REG_CSI_OFS2__A, 0x0001),
WR16(B_EC_SB_REG_CSI_OFS2__A ,0x0001 ), WR16(B_EC_SB_REG_CSI_LO__A, 0x000c),
WR16(B_EC_SB_REG_CSI_LO__A ,0x000c ), WR16(B_EC_SB_REG_CSI_HI__A, 0x0018),
WR16(B_EC_SB_REG_CSI_HI__A ,0x0018 ), WR16(B_EC_SB_REG_SNR_HI__A, 0x007f),
WR16(B_EC_SB_REG_SNR_HI__A ,0x007f ), WR16(B_EC_SB_REG_SNR_MID__A, 0x007f),
WR16(B_EC_SB_REG_SNR_MID__A ,0x007f ), WR16(B_EC_SB_REG_SNR_LO__A, 0x007f),
WR16(B_EC_SB_REG_SNR_LO__A ,0x007f ),
WR16(B_EC_OC_REG_DTO_CLKMODE__A, 0x0002),
WR16(B_EC_OC_REG_DTO_CLKMODE__A ,0x0002 ), WR16(B_EC_OC_REG_DTO_PER__A, 0x0006),
WR16(B_EC_OC_REG_DTO_PER__A ,0x0006 ), WR16(B_EC_OC_REG_DTO_BUR__A, 0x0001),
WR16(B_EC_OC_REG_DTO_BUR__A ,0x0001 ), WR16(B_EC_OC_REG_RCR_CLKMODE__A, 0x0000),
WR16(B_EC_OC_REG_RCR_CLKMODE__A ,0x0000 ), WR16(B_EC_OC_REG_RCN_GAI_LVL__A, 0x000D),
WR16(B_EC_OC_REG_RCN_GAI_LVL__A ,0x000D ), WR16(B_EC_OC_REG_OC_MPG_SIO__A, 0x0000),
WR16(B_EC_OC_REG_OC_MPG_SIO__A ,0x0000 ),
/* Needed because shadow registers do not have correct default value */ /* Needed because shadow registers do not have correct default value */
WR16(B_EC_OC_REG_RCN_CST_LOP__A ,0x1000 ), WR16(B_EC_OC_REG_RCN_CST_LOP__A, 0x1000),
WR16(B_EC_OC_REG_RCN_CST_HIP__A ,0x0000 ), WR16(B_EC_OC_REG_RCN_CST_HIP__A, 0x0000),
WR16(B_EC_OC_REG_RCN_CRA_LOP__A ,0x0000 ), WR16(B_EC_OC_REG_RCN_CRA_LOP__A, 0x0000),
WR16(B_EC_OC_REG_RCN_CRA_HIP__A ,0x00C0 ), WR16(B_EC_OC_REG_RCN_CRA_HIP__A, 0x00C0),
WR16(B_EC_OC_REG_RCN_CLP_LOP__A ,0x0000 ), WR16(B_EC_OC_REG_RCN_CLP_LOP__A, 0x0000),
WR16(B_EC_OC_REG_RCN_CLP_HIP__A ,0x00C0 ), WR16(B_EC_OC_REG_RCN_CLP_HIP__A, 0x00C0),
WR16(B_EC_OC_REG_DTO_INC_LOP__A ,0x0000 ), WR16(B_EC_OC_REG_DTO_INC_LOP__A, 0x0000),
WR16(B_EC_OC_REG_DTO_INC_HIP__A ,0x00C0 ), WR16(B_EC_OC_REG_DTO_INC_HIP__A, 0x00C0),
WR16(B_EC_OD_REG_SYNC__A ,0x0664 ), WR16(B_EC_OD_REG_SYNC__A, 0x0664),
WR16(B_EC_RS_REG_REQ_PCK_CNT__A ,0x1000 ), WR16(B_EC_RS_REG_REQ_PCK_CNT__A, 0x1000),
/* CHK_ERROR(ResetECRAM(demod)); */ /* CHK_ERROR(ResetECRAM(demod)); */
/* Reset packet sync bytes in EC_VD ram */ /* Reset packet sync bytes in EC_VD ram */
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 0*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (0 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 1*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (1 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 2*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (2 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 3*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (3 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 4*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (4 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 5*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (5 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 6*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (6 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 7*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (7 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 8*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (8 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 9*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (9 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (10*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (10 * 17), 0x0000),
/* Reset packet sync bytes in EC_RS ram */ /* Reset packet sync bytes in EC_RS ram */
WR16(EC_RS_EC_RAM__A , 0x0000 ), WR16(EC_RS_EC_RAM__A, 0x0000),
WR16(EC_RS_EC_RAM__A + 204 , 0x0000 ), WR16(EC_RS_EC_RAM__A + 204, 0x0000),
WR16(B_EC_SB_REG_COMM_EXEC__A , 0x0001 ), WR16(B_EC_SB_REG_COMM_EXEC__A, 0x0001),
WR16(B_EC_VD_REG_COMM_EXEC__A , 0x0001 ), WR16(B_EC_VD_REG_COMM_EXEC__A, 0x0001),
WR16(B_EC_OD_REG_COMM_EXEC__A , 0x0001 ), WR16(B_EC_OD_REG_COMM_EXEC__A, 0x0001),
WR16(B_EC_RS_REG_COMM_EXEC__A , 0x0001 ), WR16(B_EC_RS_REG_COMM_EXEC__A, 0x0001),
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_ResetECA2[] = u8_t DRXD_ResetECA2[] = {
{
WR16(EC_OC_REG_COMM_EXEC__A, 0x0000),
WR16(EC_OC_REG_COMM_EXEC__A , 0x0000 ), WR16(EC_OD_REG_COMM_EXEC__A, 0x0000),
WR16(EC_OD_REG_COMM_EXEC__A , 0x0000 ),
WRBLOCK(EC_OC_REG_TMD_TOP_MODE__A, 5),
WRBLOCK( EC_OC_REG_TMD_TOP_MODE__A , 5), 0x03, 0x00, /* EC_OC_REG_TMD_TOP_MODE__A */
0x03,0x00, /* EC_OC_REG_TMD_TOP_MODE__A */ 0xF4, 0x01, /* EC_OC_REG_TMD_TOP_CNT__A */
0xF4,0x01, /* EC_OC_REG_TMD_TOP_CNT__A */ 0xC0, 0x03, /* EC_OC_REG_TMD_HIL_MAR__A */
0xC0,0x03, /* EC_OC_REG_TMD_HIL_MAR__A */ 0x40, 0x00, /* EC_OC_REG_TMD_LOL_MAR__A */
0x40,0x00, /* EC_OC_REG_TMD_LOL_MAR__A */ 0x03, 0x00, /* EC_OC_REG_TMD_CUR_CNT__A */
0x03,0x00, /* EC_OC_REG_TMD_CUR_CNT__A */
WRBLOCK(EC_OC_REG_AVR_ASH_CNT__A, 2),
WRBLOCK( EC_OC_REG_AVR_ASH_CNT__A , 2), 0x06, 0x00, /* EC_OC_REG_AVR_ASH_CNT__A */
0x06,0x00, /* EC_OC_REG_AVR_ASH_CNT__A */ 0x02, 0x00, /* EC_OC_REG_AVR_BSH_CNT__A */
0x02,0x00, /* EC_OC_REG_AVR_BSH_CNT__A */
WRBLOCK(EC_OC_REG_RCN_MODE__A, 7),
WRBLOCK( EC_OC_REG_RCN_MODE__A , 7), 0x07, 0x00, /* EC_OC_REG_RCN_MODE__A */
0x07,0x00, /* EC_OC_REG_RCN_MODE__A */ 0x00, 0x00, /* EC_OC_REG_RCN_CRA_LOP__A */
0x00,0x00, /* EC_OC_REG_RCN_CRA_LOP__A */ 0xc0, 0x00, /* EC_OC_REG_RCN_CRA_HIP__A */
0xc0,0x00, /* EC_OC_REG_RCN_CRA_HIP__A */ 0x00, 0x10, /* EC_OC_REG_RCN_CST_LOP__A */
0x00,0x10, /* EC_OC_REG_RCN_CST_LOP__A */ 0x00, 0x00, /* EC_OC_REG_RCN_CST_HIP__A */
0x00,0x00, /* EC_OC_REG_RCN_CST_HIP__A */ 0xFF, 0x01, /* EC_OC_REG_RCN_SET_LVL__A */
0xFF,0x01, /* EC_OC_REG_RCN_SET_LVL__A */ 0x0D, 0x00, /* EC_OC_REG_RCN_GAI_LVL__A */
0x0D,0x00, /* EC_OC_REG_RCN_GAI_LVL__A */
WRBLOCK(EC_OC_REG_RCN_CLP_LOP__A, 2),
WRBLOCK( EC_OC_REG_RCN_CLP_LOP__A , 2), 0x00, 0x00, /* EC_OC_REG_RCN_CLP_LOP__A */
0x00,0x00, /* EC_OC_REG_RCN_CLP_LOP__A */ 0xC0, 0x00, /* EC_OC_REG_RCN_CLP_HIP__A */
0xC0,0x00, /* EC_OC_REG_RCN_CLP_HIP__A */
WR16(EC_OD_REG_SYNC__A, 0x0664),
WR16(EC_OD_REG_SYNC__A , 0x0664 ), WR16(EC_OC_REG_OC_MON_SIO__A, 0x0000),
WR16(EC_OC_REG_OC_MON_SIO__A , 0x0000 ), WR16(EC_OC_REG_SNC_ISC_LVL__A, 0x0D0C),
WR16(EC_OC_REG_SNC_ISC_LVL__A , 0x0D0C ),
/* Output zero on monitorbus pads, power saving */ /* Output zero on monitorbus pads, power saving */
WR16(EC_OC_REG_OCR_MON_UOS__A , WR16(EC_OC_REG_OCR_MON_UOS__A,
( EC_OC_REG_OCR_MON_UOS_DAT_0_ENABLE | (EC_OC_REG_OCR_MON_UOS_DAT_0_ENABLE |
EC_OC_REG_OCR_MON_UOS_DAT_1_ENABLE | EC_OC_REG_OCR_MON_UOS_DAT_1_ENABLE |
EC_OC_REG_OCR_MON_UOS_DAT_2_ENABLE | EC_OC_REG_OCR_MON_UOS_DAT_2_ENABLE |
EC_OC_REG_OCR_MON_UOS_DAT_3_ENABLE | EC_OC_REG_OCR_MON_UOS_DAT_3_ENABLE |
...@@ -728,39 +716,38 @@ u8_t DRXD_ResetECA2[] = ...@@ -728,39 +716,38 @@ u8_t DRXD_ResetECA2[] =
EC_OC_REG_OCR_MON_UOS_DAT_8_ENABLE | EC_OC_REG_OCR_MON_UOS_DAT_8_ENABLE |
EC_OC_REG_OCR_MON_UOS_DAT_9_ENABLE | EC_OC_REG_OCR_MON_UOS_DAT_9_ENABLE |
EC_OC_REG_OCR_MON_UOS_VAL_ENABLE | EC_OC_REG_OCR_MON_UOS_VAL_ENABLE |
EC_OC_REG_OCR_MON_UOS_CLK_ENABLE ) ), EC_OC_REG_OCR_MON_UOS_CLK_ENABLE)),
WR16(EC_OC_REG_OCR_MON_WRI__A, WR16(EC_OC_REG_OCR_MON_WRI__A,
EC_OC_REG_OCR_MON_WRI_INIT ), EC_OC_REG_OCR_MON_WRI_INIT),
/* CHK_ERROR(ResetECRAM(demod)); */ /* CHK_ERROR(ResetECRAM(demod)); */
/* Reset packet sync bytes in EC_VD ram */ /* Reset packet sync bytes in EC_VD ram */
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 0*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (0 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 1*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (1 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 2*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (2 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 3*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (3 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 4*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (4 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 5*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (5 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 6*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (6 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 7*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (7 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 8*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (8 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + ( 9*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (9 * 17), 0x0000),
WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (10*17) , 0x0000 ), WR16(EC_OD_DEINT_RAM__A + 0x3b7 + (10 * 17), 0x0000),
/* Reset packet sync bytes in EC_RS ram */ /* Reset packet sync bytes in EC_RS ram */
WR16(EC_RS_EC_RAM__A , 0x0000 ), WR16(EC_RS_EC_RAM__A, 0x0000),
WR16(EC_RS_EC_RAM__A + 204 , 0x0000 ), WR16(EC_RS_EC_RAM__A + 204, 0x0000),
WR16(EC_OD_REG_COMM_EXEC__A , 0x0001 ), WR16(EC_OD_REG_COMM_EXEC__A, 0x0001),
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_InitSC[] = u8_t DRXD_InitSC[] = {
{ WR16(SC_COMM_EXEC__A, 0),
WR16(SC_COMM_EXEC__A, 0 ), WR16(SC_COMM_STATE__A, 0),
WR16(SC_COMM_STATE__A, 0 ),
#ifdef COMPILE_FOR_QT #ifdef COMPILE_FOR_QT
WR16(SC_RA_RAM_BE_OPT_DELAY__A, 0x100 ), WR16(SC_RA_RAM_BE_OPT_DELAY__A, 0x100),
#endif #endif
/* SC is not started, this is done in SetChannels() */ /* SC is not started, this is done in SetChannels() */
...@@ -769,51 +756,47 @@ u8_t DRXD_InitSC[] = ...@@ -769,51 +756,47 @@ u8_t DRXD_InitSC[] =
/* Diversity settings */ /* Diversity settings */
u8_t DRXD_InitDiversityFront[] = u8_t DRXD_InitDiversityFront[] = {
{ /* Start demod ********* RF in , diversity out **************************** */
/* Start demod ********* RF in , diversity out *****************************/ WR16(B_SC_RA_RAM_CONFIG__A, B_SC_RA_RAM_CONFIG_FR_ENABLE__M |
WR16( B_SC_RA_RAM_CONFIG__A, B_SC_RA_RAM_CONFIG_FR_ENABLE__M | B_SC_RA_RAM_CONFIG_FREQSCAN__M),
B_SC_RA_RAM_CONFIG_FREQSCAN__M ),
WR16(B_SC_RA_RAM_LC_ABS_2K__A, 0x7),
WR16( B_SC_RA_RAM_LC_ABS_2K__A, 0x7), WR16(B_SC_RA_RAM_LC_ABS_8K__A, 0x7),
WR16( B_SC_RA_RAM_LC_ABS_8K__A, 0x7), WR16(B_SC_RA_RAM_IR_COARSE_8K_LENGTH__A, IRLEN_COARSE_8K),
WR16( B_SC_RA_RAM_IR_COARSE_8K_LENGTH__A, IRLEN_COARSE_8K ), WR16(B_SC_RA_RAM_IR_COARSE_8K_FREQINC__A, 1 << (11 - IRLEN_COARSE_8K)),
WR16( B_SC_RA_RAM_IR_COARSE_8K_FREQINC__A, 1<<(11-IRLEN_COARSE_8K) ), WR16(B_SC_RA_RAM_IR_COARSE_8K_KAISINC__A, 1 << (17 - IRLEN_COARSE_8K)),
WR16( B_SC_RA_RAM_IR_COARSE_8K_KAISINC__A, 1<<(17-IRLEN_COARSE_8K) ), WR16(B_SC_RA_RAM_IR_FINE_8K_LENGTH__A, IRLEN_FINE_8K),
WR16( B_SC_RA_RAM_IR_FINE_8K_LENGTH__A, IRLEN_FINE_8K ), WR16(B_SC_RA_RAM_IR_FINE_8K_FREQINC__A, 1 << (11 - IRLEN_FINE_8K)),
WR16( B_SC_RA_RAM_IR_FINE_8K_FREQINC__A, 1<<(11-IRLEN_FINE_8K) ), WR16(B_SC_RA_RAM_IR_FINE_8K_KAISINC__A, 1 << (17 - IRLEN_FINE_8K)),
WR16( B_SC_RA_RAM_IR_FINE_8K_KAISINC__A, 1<<(17-IRLEN_FINE_8K) ),
WR16(B_SC_RA_RAM_IR_COARSE_2K_LENGTH__A, IRLEN_COARSE_2K),
WR16( B_SC_RA_RAM_IR_COARSE_2K_LENGTH__A, IRLEN_COARSE_2K ), WR16(B_SC_RA_RAM_IR_COARSE_2K_FREQINC__A, 1 << (11 - IRLEN_COARSE_2K)),
WR16( B_SC_RA_RAM_IR_COARSE_2K_FREQINC__A, 1<<(11-IRLEN_COARSE_2K) ), WR16(B_SC_RA_RAM_IR_COARSE_2K_KAISINC__A, 1 << (17 - IRLEN_COARSE_2K)),
WR16( B_SC_RA_RAM_IR_COARSE_2K_KAISINC__A, 1<<(17-IRLEN_COARSE_2K) ), WR16(B_SC_RA_RAM_IR_FINE_2K_LENGTH__A, IRLEN_FINE_2K),
WR16( B_SC_RA_RAM_IR_FINE_2K_LENGTH__A, IRLEN_FINE_2K ), WR16(B_SC_RA_RAM_IR_FINE_2K_FREQINC__A, 1 << (11 - IRLEN_FINE_2K)),
WR16( B_SC_RA_RAM_IR_FINE_2K_FREQINC__A, 1<<(11-IRLEN_FINE_2K) ), WR16(B_SC_RA_RAM_IR_FINE_2K_KAISINC__A, 1 << (17 - IRLEN_FINE_2K)),
WR16( B_SC_RA_RAM_IR_FINE_2K_KAISINC__A, 1<<(17-IRLEN_FINE_2K) ),
WR16(B_LC_RA_RAM_FILTER_CRMM_A__A, 7),
WR16( B_LC_RA_RAM_FILTER_CRMM_A__A, 7), WR16(B_LC_RA_RAM_FILTER_CRMM_B__A, 4),
WR16( B_LC_RA_RAM_FILTER_CRMM_B__A, 4), WR16(B_LC_RA_RAM_FILTER_SRMM_A__A, 7),
WR16( B_LC_RA_RAM_FILTER_SRMM_A__A, 7), WR16(B_LC_RA_RAM_FILTER_SRMM_B__A, 4),
WR16( B_LC_RA_RAM_FILTER_SRMM_B__A, 4), WR16(B_LC_RA_RAM_FILTER_SYM_SET__A, 500),
WR16( B_LC_RA_RAM_FILTER_SYM_SET__A, 500),
WR16(B_CC_REG_DIVERSITY__A, 0x0001),
WR16( B_CC_REG_DIVERSITY__A, 0x0001 ), WR16(B_EC_OC_REG_OC_MODE_HIP__A, 0x0010),
WR16( B_EC_OC_REG_OC_MODE_HIP__A, 0x0010 ), WR16(B_EQ_REG_RC_SEL_CAR__A, B_EQ_REG_RC_SEL_CAR_PASS_B_CE |
WR16( B_EQ_REG_RC_SEL_CAR__A, B_EQ_REG_RC_SEL_CAR_PASS_B_CE | B_EQ_REG_RC_SEL_CAR_LOCAL_B_CE | B_EQ_REG_RC_SEL_CAR_MEAS_B_CE),
B_EQ_REG_RC_SEL_CAR_LOCAL_B_CE |
B_EQ_REG_RC_SEL_CAR_MEAS_B_CE ), /* 0x2a ), *//* CE to PASS mux */
/* 0x2a ),*/ /* CE to PASS mux */
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_InitDiversityEnd[] = u8_t DRXD_InitDiversityEnd[] = {
{ /* End demod *********** combining RF in and diversity in, MPEG TS out **** */
/* End demod *********** combining RF in and diversity in, MPEG TS out *****/
/* disable near/far; switch on timing slave mode */ /* disable near/far; switch on timing slave mode */
WR16( B_SC_RA_RAM_CONFIG__A, B_SC_RA_RAM_CONFIG_FR_ENABLE__M | WR16(B_SC_RA_RAM_CONFIG__A, B_SC_RA_RAM_CONFIG_FR_ENABLE__M |
B_SC_RA_RAM_CONFIG_FREQSCAN__M | B_SC_RA_RAM_CONFIG_FREQSCAN__M |
B_SC_RA_RAM_CONFIG_DIV_ECHO_ENABLE__M | B_SC_RA_RAM_CONFIG_DIV_ECHO_ENABLE__M |
B_SC_RA_RAM_CONFIG_SLAVE__M | B_SC_RA_RAM_CONFIG_SLAVE__M |
...@@ -821,121 +804,126 @@ u8_t DRXD_InitDiversityEnd[] = ...@@ -821,121 +804,126 @@ u8_t DRXD_InitDiversityEnd[] =
/* MV from CtrlDiversity */ /* MV from CtrlDiversity */
), ),
#ifdef DRXDDIV_SRMM_SLAVING #ifdef DRXDDIV_SRMM_SLAVING
WR16( SC_RA_RAM_LC_ABS_2K__A, 0x3c7), WR16(SC_RA_RAM_LC_ABS_2K__A, 0x3c7),
WR16( SC_RA_RAM_LC_ABS_8K__A, 0x3c7), WR16(SC_RA_RAM_LC_ABS_8K__A, 0x3c7),
#else #else
WR16( SC_RA_RAM_LC_ABS_2K__A, 0x7), WR16(SC_RA_RAM_LC_ABS_2K__A, 0x7),
WR16( SC_RA_RAM_LC_ABS_8K__A, 0x7), WR16(SC_RA_RAM_LC_ABS_8K__A, 0x7),
#endif #endif
WR16( B_SC_RA_RAM_IR_COARSE_8K_LENGTH__A, IRLEN_COARSE_8K ), WR16(B_SC_RA_RAM_IR_COARSE_8K_LENGTH__A, IRLEN_COARSE_8K),
WR16( B_SC_RA_RAM_IR_COARSE_8K_FREQINC__A, 1<<(11-IRLEN_COARSE_8K) ), WR16(B_SC_RA_RAM_IR_COARSE_8K_FREQINC__A, 1 << (11 - IRLEN_COARSE_8K)),
WR16( B_SC_RA_RAM_IR_COARSE_8K_KAISINC__A, 1<<(17-IRLEN_COARSE_8K) ), WR16(B_SC_RA_RAM_IR_COARSE_8K_KAISINC__A, 1 << (17 - IRLEN_COARSE_8K)),
WR16( B_SC_RA_RAM_IR_FINE_8K_LENGTH__A, IRLEN_FINE_8K ), WR16(B_SC_RA_RAM_IR_FINE_8K_LENGTH__A, IRLEN_FINE_8K),
WR16( B_SC_RA_RAM_IR_FINE_8K_FREQINC__A, 1<<(11-IRLEN_FINE_8K) ), WR16(B_SC_RA_RAM_IR_FINE_8K_FREQINC__A, 1 << (11 - IRLEN_FINE_8K)),
WR16( B_SC_RA_RAM_IR_FINE_8K_KAISINC__A, 1<<(17-IRLEN_FINE_8K) ), WR16(B_SC_RA_RAM_IR_FINE_8K_KAISINC__A, 1 << (17 - IRLEN_FINE_8K)),
WR16( B_SC_RA_RAM_IR_COARSE_2K_LENGTH__A, IRLEN_COARSE_2K ), WR16(B_SC_RA_RAM_IR_COARSE_2K_LENGTH__A, IRLEN_COARSE_2K),
WR16( B_SC_RA_RAM_IR_COARSE_2K_FREQINC__A, 1<<(11-IRLEN_COARSE_2K) ), WR16(B_SC_RA_RAM_IR_COARSE_2K_FREQINC__A, 1 << (11 - IRLEN_COARSE_2K)),
WR16( B_SC_RA_RAM_IR_COARSE_2K_KAISINC__A, 1<<(17-IRLEN_COARSE_2K) ), WR16(B_SC_RA_RAM_IR_COARSE_2K_KAISINC__A, 1 << (17 - IRLEN_COARSE_2K)),
WR16( B_SC_RA_RAM_IR_FINE_2K_LENGTH__A, IRLEN_FINE_2K ), WR16(B_SC_RA_RAM_IR_FINE_2K_LENGTH__A, IRLEN_FINE_2K),
WR16( B_SC_RA_RAM_IR_FINE_2K_FREQINC__A, 1<<(11-IRLEN_FINE_2K) ), WR16(B_SC_RA_RAM_IR_FINE_2K_FREQINC__A, 1 << (11 - IRLEN_FINE_2K)),
WR16( B_SC_RA_RAM_IR_FINE_2K_KAISINC__A, 1<<(17-IRLEN_FINE_2K) ), WR16(B_SC_RA_RAM_IR_FINE_2K_KAISINC__A, 1 << (17 - IRLEN_FINE_2K)),
WR16( B_LC_RA_RAM_FILTER_CRMM_A__A, 7), WR16(B_LC_RA_RAM_FILTER_CRMM_A__A, 7),
WR16( B_LC_RA_RAM_FILTER_CRMM_B__A, 4), WR16(B_LC_RA_RAM_FILTER_CRMM_B__A, 4),
WR16( B_LC_RA_RAM_FILTER_SRMM_A__A, 7), WR16(B_LC_RA_RAM_FILTER_SRMM_A__A, 7),
WR16( B_LC_RA_RAM_FILTER_SRMM_B__A, 4), WR16(B_LC_RA_RAM_FILTER_SRMM_B__A, 4),
WR16( B_LC_RA_RAM_FILTER_SYM_SET__A, 500), WR16(B_LC_RA_RAM_FILTER_SYM_SET__A, 500),
WR16( B_CC_REG_DIVERSITY__A, 0x0001 ), WR16(B_CC_REG_DIVERSITY__A, 0x0001),
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_DisableDiversity[] = u8_t DRXD_DisableDiversity[] = {
{ WR16(B_SC_RA_RAM_LC_ABS_2K__A, B_SC_RA_RAM_LC_ABS_2K__PRE),
WR16( B_SC_RA_RAM_LC_ABS_2K__A, B_SC_RA_RAM_LC_ABS_2K__PRE), WR16(B_SC_RA_RAM_LC_ABS_8K__A, B_SC_RA_RAM_LC_ABS_8K__PRE),
WR16( B_SC_RA_RAM_LC_ABS_8K__A, B_SC_RA_RAM_LC_ABS_8K__PRE), WR16(B_SC_RA_RAM_IR_COARSE_8K_LENGTH__A,
WR16( B_SC_RA_RAM_IR_COARSE_8K_LENGTH__A, B_SC_RA_RAM_IR_COARSE_8K_LENGTH__PRE ), B_SC_RA_RAM_IR_COARSE_8K_LENGTH__PRE),
WR16( B_SC_RA_RAM_IR_COARSE_8K_FREQINC__A, B_SC_RA_RAM_IR_COARSE_8K_FREQINC__PRE ), WR16(B_SC_RA_RAM_IR_COARSE_8K_FREQINC__A,
WR16( B_SC_RA_RAM_IR_COARSE_8K_KAISINC__A, B_SC_RA_RAM_IR_COARSE_8K_KAISINC__PRE ), B_SC_RA_RAM_IR_COARSE_8K_FREQINC__PRE),
WR16( B_SC_RA_RAM_IR_FINE_8K_LENGTH__A, B_SC_RA_RAM_IR_FINE_8K_LENGTH__PRE ), WR16(B_SC_RA_RAM_IR_COARSE_8K_KAISINC__A,
WR16( B_SC_RA_RAM_IR_FINE_8K_FREQINC__A, B_SC_RA_RAM_IR_FINE_8K_FREQINC__PRE ), B_SC_RA_RAM_IR_COARSE_8K_KAISINC__PRE),
WR16( B_SC_RA_RAM_IR_FINE_8K_KAISINC__A, B_SC_RA_RAM_IR_FINE_8K_KAISINC__PRE ), WR16(B_SC_RA_RAM_IR_FINE_8K_LENGTH__A,
B_SC_RA_RAM_IR_FINE_8K_LENGTH__PRE),
WR16( B_SC_RA_RAM_IR_COARSE_2K_LENGTH__A, B_SC_RA_RAM_IR_COARSE_2K_LENGTH__PRE ), WR16(B_SC_RA_RAM_IR_FINE_8K_FREQINC__A,
WR16( B_SC_RA_RAM_IR_COARSE_2K_FREQINC__A, B_SC_RA_RAM_IR_COARSE_2K_FREQINC__PRE ), B_SC_RA_RAM_IR_FINE_8K_FREQINC__PRE),
WR16( B_SC_RA_RAM_IR_COARSE_2K_KAISINC__A, B_SC_RA_RAM_IR_COARSE_2K_KAISINC__PRE ), WR16(B_SC_RA_RAM_IR_FINE_8K_KAISINC__A,
WR16( B_SC_RA_RAM_IR_FINE_2K_LENGTH__A, B_SC_RA_RAM_IR_FINE_2K_LENGTH__PRE ), B_SC_RA_RAM_IR_FINE_8K_KAISINC__PRE),
WR16( B_SC_RA_RAM_IR_FINE_2K_FREQINC__A, B_SC_RA_RAM_IR_FINE_2K_FREQINC__PRE ),
WR16( B_SC_RA_RAM_IR_FINE_2K_KAISINC__A, B_SC_RA_RAM_IR_FINE_2K_KAISINC__PRE ), WR16(B_SC_RA_RAM_IR_COARSE_2K_LENGTH__A,
B_SC_RA_RAM_IR_COARSE_2K_LENGTH__PRE),
WR16( B_LC_RA_RAM_FILTER_CRMM_A__A, B_LC_RA_RAM_FILTER_CRMM_A__PRE), WR16(B_SC_RA_RAM_IR_COARSE_2K_FREQINC__A,
WR16( B_LC_RA_RAM_FILTER_CRMM_B__A, B_LC_RA_RAM_FILTER_CRMM_B__PRE), B_SC_RA_RAM_IR_COARSE_2K_FREQINC__PRE),
WR16( B_LC_RA_RAM_FILTER_SRMM_A__A, B_LC_RA_RAM_FILTER_SRMM_A__PRE), WR16(B_SC_RA_RAM_IR_COARSE_2K_KAISINC__A,
WR16( B_LC_RA_RAM_FILTER_SRMM_B__A, B_LC_RA_RAM_FILTER_SRMM_B__PRE), B_SC_RA_RAM_IR_COARSE_2K_KAISINC__PRE),
WR16( B_LC_RA_RAM_FILTER_SYM_SET__A, B_LC_RA_RAM_FILTER_SYM_SET__PRE), WR16(B_SC_RA_RAM_IR_FINE_2K_LENGTH__A,
B_SC_RA_RAM_IR_FINE_2K_LENGTH__PRE),
WR16(B_SC_RA_RAM_IR_FINE_2K_FREQINC__A,
WR16( B_CC_REG_DIVERSITY__A, 0x0000 ), B_SC_RA_RAM_IR_FINE_2K_FREQINC__PRE),
WR16( B_EQ_REG_RC_SEL_CAR__A, B_EQ_REG_RC_SEL_CAR_INIT ), /* combining disabled*/ WR16(B_SC_RA_RAM_IR_FINE_2K_KAISINC__A,
B_SC_RA_RAM_IR_FINE_2K_KAISINC__PRE),
WR16(B_LC_RA_RAM_FILTER_CRMM_A__A, B_LC_RA_RAM_FILTER_CRMM_A__PRE),
WR16(B_LC_RA_RAM_FILTER_CRMM_B__A, B_LC_RA_RAM_FILTER_CRMM_B__PRE),
WR16(B_LC_RA_RAM_FILTER_SRMM_A__A, B_LC_RA_RAM_FILTER_SRMM_A__PRE),
WR16(B_LC_RA_RAM_FILTER_SRMM_B__A, B_LC_RA_RAM_FILTER_SRMM_B__PRE),
WR16(B_LC_RA_RAM_FILTER_SYM_SET__A, B_LC_RA_RAM_FILTER_SYM_SET__PRE),
WR16(B_CC_REG_DIVERSITY__A, 0x0000),
WR16(B_EQ_REG_RC_SEL_CAR__A, B_EQ_REG_RC_SEL_CAR_INIT), /* combining disabled */
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_StartDiversityFront[] = u8_t DRXD_StartDiversityFront[] = {
{
/* Start demod, RF in and diversity out, no combining */ /* Start demod, RF in and diversity out, no combining */
WR16( B_FE_CF_REG_IMP_VAL__A, 0x0 ), WR16(B_FE_CF_REG_IMP_VAL__A, 0x0),
WR16( B_FE_AD_REG_FDB_IN__A, 0x0 ), WR16(B_FE_AD_REG_FDB_IN__A, 0x0),
WR16( B_FE_AD_REG_INVEXT__A, 0x0 ), WR16(B_FE_AD_REG_INVEXT__A, 0x0),
WR16( B_EQ_REG_COMM_MB__A, 0x12 ), /* EQ to MB out */ WR16(B_EQ_REG_COMM_MB__A, 0x12), /* EQ to MB out */
WR16( B_EQ_REG_RC_SEL_CAR__A, B_EQ_REG_RC_SEL_CAR_PASS_B_CE | /* CE to PASS mux */ WR16(B_EQ_REG_RC_SEL_CAR__A, B_EQ_REG_RC_SEL_CAR_PASS_B_CE | /* CE to PASS mux */
B_EQ_REG_RC_SEL_CAR_LOCAL_B_CE | B_EQ_REG_RC_SEL_CAR_LOCAL_B_CE | B_EQ_REG_RC_SEL_CAR_MEAS_B_CE),
B_EQ_REG_RC_SEL_CAR_MEAS_B_CE ),
WR16( SC_RA_RAM_ECHO_SHIFT_LIM__A, 2 ), WR16(SC_RA_RAM_ECHO_SHIFT_LIM__A, 2),
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_StartDiversityEnd[] = u8_t DRXD_StartDiversityEnd[] = {
{
/* End demod, combining RF in and diversity in, MPEG TS out */ /* End demod, combining RF in and diversity in, MPEG TS out */
WR16( B_FE_CF_REG_IMP_VAL__A, 0x0 ), /* disable impulse noise cruncher */ WR16(B_FE_CF_REG_IMP_VAL__A, 0x0), /* disable impulse noise cruncher */
WR16( B_FE_AD_REG_INVEXT__A, 0x0 ), /* clock inversion (for sohard board) */ WR16(B_FE_AD_REG_INVEXT__A, 0x0), /* clock inversion (for sohard board) */
WR16( B_CP_REG_BR_STR_DEL__A, 10 ), /* apperently no mb delay matching is best */ WR16(B_CP_REG_BR_STR_DEL__A, 10), /* apperently no mb delay matching is best */
WR16( B_EQ_REG_RC_SEL_CAR__A, B_EQ_REG_RC_SEL_CAR_DIV_ON | /* org = 0x81 combining enabled */ WR16(B_EQ_REG_RC_SEL_CAR__A, B_EQ_REG_RC_SEL_CAR_DIV_ON | /* org = 0x81 combining enabled */
B_EQ_REG_RC_SEL_CAR_MEAS_A_CC | B_EQ_REG_RC_SEL_CAR_MEAS_A_CC |
B_EQ_REG_RC_SEL_CAR_PASS_A_CC | B_EQ_REG_RC_SEL_CAR_PASS_A_CC | B_EQ_REG_RC_SEL_CAR_LOCAL_A_CC),
B_EQ_REG_RC_SEL_CAR_LOCAL_A_CC ),
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_DiversityDelay8MHZ[] = u8_t DRXD_DiversityDelay8MHZ[] = {
{ WR16(B_SC_RA_RAM_DIVERSITY_DELAY_2K_32__A, 1150 - 50),
WR16( B_SC_RA_RAM_DIVERSITY_DELAY_2K_32__A, 1150 - 50 ), WR16(B_SC_RA_RAM_DIVERSITY_DELAY_2K_16__A, 1100 - 50),
WR16( B_SC_RA_RAM_DIVERSITY_DELAY_2K_16__A, 1100 - 50 ), WR16(B_SC_RA_RAM_DIVERSITY_DELAY_2K_8__A, 1000 - 50),
WR16( B_SC_RA_RAM_DIVERSITY_DELAY_2K_8__A , 1000 - 50 ), WR16(B_SC_RA_RAM_DIVERSITY_DELAY_2K_4__A, 800 - 50),
WR16( B_SC_RA_RAM_DIVERSITY_DELAY_2K_4__A , 800 - 50 ), WR16(B_SC_RA_RAM_DIVERSITY_DELAY_8K_32__A, 5420 - 50),
WR16( B_SC_RA_RAM_DIVERSITY_DELAY_8K_32__A, 5420 - 50 ), WR16(B_SC_RA_RAM_DIVERSITY_DELAY_8K_16__A, 5200 - 50),
WR16( B_SC_RA_RAM_DIVERSITY_DELAY_8K_16__A, 5200 - 50 ), WR16(B_SC_RA_RAM_DIVERSITY_DELAY_8K_8__A, 4800 - 50),
WR16( B_SC_RA_RAM_DIVERSITY_DELAY_8K_8__A , 4800 - 50 ), WR16(B_SC_RA_RAM_DIVERSITY_DELAY_8K_4__A, 4000 - 50),
WR16( B_SC_RA_RAM_DIVERSITY_DELAY_8K_4__A , 4000 - 50 ),
END_OF_TABLE END_OF_TABLE
}; };
u8_t DRXD_DiversityDelay6MHZ[] = /* also used ok for 7 MHz */ u8_t DRXD_DiversityDelay6MHZ[] = /* also used ok for 7 MHz */
{ {
WR16( B_SC_RA_RAM_DIVERSITY_DELAY_2K_32__A, 1100 - 50 ), WR16(B_SC_RA_RAM_DIVERSITY_DELAY_2K_32__A, 1100 - 50),
WR16( B_SC_RA_RAM_DIVERSITY_DELAY_2K_16__A, 1000 - 50 ), WR16(B_SC_RA_RAM_DIVERSITY_DELAY_2K_16__A, 1000 - 50),
WR16( B_SC_RA_RAM_DIVERSITY_DELAY_2K_8__A , 900 - 50 ), WR16(B_SC_RA_RAM_DIVERSITY_DELAY_2K_8__A, 900 - 50),
WR16( B_SC_RA_RAM_DIVERSITY_DELAY_2K_4__A , 600 - 50 ), WR16(B_SC_RA_RAM_DIVERSITY_DELAY_2K_4__A, 600 - 50),
WR16( B_SC_RA_RAM_DIVERSITY_DELAY_8K_32__A, 5300 - 50 ), WR16(B_SC_RA_RAM_DIVERSITY_DELAY_8K_32__A, 5300 - 50),
WR16( B_SC_RA_RAM_DIVERSITY_DELAY_8K_16__A, 5000 - 50 ), WR16(B_SC_RA_RAM_DIVERSITY_DELAY_8K_16__A, 5000 - 50),
WR16( B_SC_RA_RAM_DIVERSITY_DELAY_8K_8__A , 4500 - 50 ), WR16(B_SC_RA_RAM_DIVERSITY_DELAY_8K_8__A, 4500 - 50),
WR16( B_SC_RA_RAM_DIVERSITY_DELAY_8K_4__A , 3500 - 50 ), WR16(B_SC_RA_RAM_DIVERSITY_DELAY_8K_4__A, 3500 - 50),
END_OF_TABLE END_OF_TABLE
}; };
drivers/media/dvb/frontends/drxd_firm.h
View file @ 6cacdd46
...@@ -65,7 +65,6 @@ typedef unsigned long u32_t; ...@@ -65,7 +65,6 @@ typedef unsigned long u32_t;
#define DRXD_SCAN_TIMEOUT (650) #define DRXD_SCAN_TIMEOUT (650)
#define DRXD_BANDWIDTH_8MHZ_IN_HZ (0x8B8249L) #define DRXD_BANDWIDTH_8MHZ_IN_HZ (0x8B8249L)
#define DRXD_BANDWIDTH_7MHZ_IN_HZ (0x7A1200L) #define DRXD_BANDWIDTH_7MHZ_IN_HZ (0x7A1200L)
#define DRXD_BANDWIDTH_6MHZ_IN_HZ (0x68A1B6L) #define DRXD_BANDWIDTH_6MHZ_IN_HZ (0x68A1B6L)
...@@ -78,7 +77,6 @@ typedef unsigned long u32_t; ...@@ -78,7 +77,6 @@ typedef unsigned long u32_t;
#define DIFF_TARGET (4) #define DIFF_TARGET (4)
#define DIFF_MARGIN (1) #define DIFF_MARGIN (1)
extern u8_t DRXD_InitAtomicRead[]; extern u8_t DRXD_InitAtomicRead[];
extern u8_t DRXD_HiI2cPatch_1[]; extern u8_t DRXD_HiI2cPatch_1[];
extern u8_t DRXD_HiI2cPatch_3[]; extern u8_t DRXD_HiI2cPatch_3[];
......
drivers/media/dvb/frontends/drxd_hard.c
View file @ 6cacdd46
...@@ -62,7 +62,6 @@ ...@@ -62,7 +62,6 @@
#define DRX_LOCK_FEC 2 #define DRX_LOCK_FEC 2
#define DRX_LOCK_DEMOD 4 #define DRX_LOCK_DEMOD 4
/****************************************************************************/ /****************************************************************************/
enum CSCDState { enum CSCDState {
...@@ -93,8 +92,8 @@ struct SCfgAgc { ...@@ -93,8 +92,8 @@ struct SCfgAgc {
enum AGC_CTRL_MODE ctrlMode; enum AGC_CTRL_MODE ctrlMode;
u16 outputLevel; /* range [0, ... , 1023], 1/n of fullscale range */ u16 outputLevel; /* range [0, ... , 1023], 1/n of fullscale range */
u16 settleLevel; /* range [0, ... , 1023], 1/n of fullscale range */ u16 settleLevel; /* range [0, ... , 1023], 1/n of fullscale range */
u16 minOutputLevel;/* range [0, ... , 1023], 1/n of fullscale range */ u16 minOutputLevel; /* range [0, ... , 1023], 1/n of fullscale range */
u16 maxOutputLevel;/* range [0, ... , 1023], 1/n of fullscale range */ u16 maxOutputLevel; /* range [0, ... , 1023], 1/n of fullscale range */
u16 speed; /* range [0, ... , 1023], 1/n of fullscale range */ u16 speed; /* range [0, ... , 1023], 1/n of fullscale range */
u16 R1; u16 R1;
...@@ -205,14 +204,13 @@ struct drxd_state { ...@@ -205,14 +204,13 @@ struct drxd_state {
}; };
/****************************************************************************/ /****************************************************************************/
/* I2C **********************************************************************/ /* I2C **********************************************************************/
/****************************************************************************/ /****************************************************************************/
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 = { .addr=adr, .flags=0, .buf=data, .len=len }; struct i2c_msg msg = {.addr = adr,.flags = 0,.buf = data,.len = len };
if (i2c_transfer(adap, &msg, 1) != 1) if (i2c_transfer(adap, &msg, 1) != 1)
return -1; return -1;
...@@ -220,12 +218,13 @@ static int i2c_write(struct i2c_adapter *adap, u8 adr, u8 *data, int len) ...@@ -220,12 +218,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)
return -1; return -1;
return 0; return 0;
...@@ -235,75 +234,81 @@ inline u32 MulDiv32(u32 a, u32 b, u32 c) ...@@ -235,75 +234,81 @@ 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;
} }
static int Read16(struct drxd_state *state, u32 reg, u16 *data, u8 flags) static int Read16(struct drxd_state *state, u32 reg, u16 * data, u8 flags)
{ {
u8 adr=state->config.demod_address; u8 adr = state->config.demod_address;
u8 mm1[4]={reg&0xff, (reg>>16)&0xff, u8 mm1[4] = { reg & 0xff, (reg >> 16) & 0xff,
flags|((reg>>24)&0xff), (reg>>8)&0xff}; flags | ((reg >> 24) & 0xff), (reg >> 8) & 0xff
};
u8 mm2[2]; u8 mm2[2];
if (i2c_read(state->i2c, adr, mm1, 4, mm2, 2)<0) if (i2c_read(state->i2c, adr, mm1, 4, mm2, 2) < 0)
return -1; return -1;
if (data) if (data)
*data=mm2[0]|(mm2[1]<<8); *data = mm2[0] | (mm2[1] << 8);
return mm2[0]|(mm2[1]<<8); return mm2[0] | (mm2[1] << 8);
} }
static int Read32(struct drxd_state *state, u32 reg, u32 *data, u8 flags) static int Read32(struct drxd_state *state, u32 reg, u32 * data, u8 flags)
{ {
u8 adr=state->config.demod_address; u8 adr = state->config.demod_address;
u8 mm1[4]={reg&0xff, (reg>>16)&0xff, u8 mm1[4] = { reg & 0xff, (reg >> 16) & 0xff,
flags|((reg>>24)&0xff), (reg>>8)&0xff}; flags | ((reg >> 24) & 0xff), (reg >> 8) & 0xff
};
u8 mm2[4]; u8 mm2[4];
if (i2c_read(state->i2c, adr, mm1, 4, mm2, 4)<0) if (i2c_read(state->i2c, adr, mm1, 4, mm2, 4) < 0)
return -1; return -1;
if (data) if (data)
*data=mm2[0]|(mm2[1]<<8)|(mm2[2]<<16)|(mm2[3]<<24); *data =
mm2[0] | (mm2[1] << 8) | (mm2[2] << 16) | (mm2[3] << 24);
return 0; return 0;
} }
static int Write16(struct drxd_state *state, u32 reg, u16 data, u8 flags) static int Write16(struct drxd_state *state, u32 reg, u16 data, u8 flags)
{ {
u8 adr=state->config.demod_address; u8 adr = state->config.demod_address;
u8 mm[6]={ reg&0xff, (reg>>16)&0xff, u8 mm[6] = { reg & 0xff, (reg >> 16) & 0xff,
flags|((reg>>24)&0xff), (reg>>8)&0xff, flags | ((reg >> 24) & 0xff), (reg >> 8) & 0xff,
data&0xff, (data>>8)&0xff }; data & 0xff, (data >> 8) & 0xff
};
if (i2c_write(state->i2c, adr, mm, 6)<0) if (i2c_write(state->i2c, adr, mm, 6) < 0)
return -1; return -1;
return 0; return 0;
} }
static int Write32(struct drxd_state *state, u32 reg, u32 data, u8 flags) static int Write32(struct drxd_state *state, u32 reg, u32 data, u8 flags)
{ {
u8 adr=state->config.demod_address; u8 adr = state->config.demod_address;
u8 mm[8]={ reg&0xff, (reg>>16)&0xff, u8 mm[8] = { reg & 0xff, (reg >> 16) & 0xff,
flags|((reg>>24)&0xff), (reg>>8)&0xff, flags | ((reg >> 24) & 0xff), (reg >> 8) & 0xff,
data&0xff, (data>>8)&0xff, data & 0xff, (data >> 8) & 0xff,
(data>>16)&0xff, (data>>24)&0xff }; (data >> 16) & 0xff, (data >> 24) & 0xff
};
if (i2c_write(state->i2c, adr, mm, 8)<0) if (i2c_write(state->i2c, adr, mm, 8) < 0)
return -1; return -1;
return 0; return 0;
} }
static int write_chunk(struct drxd_state *state, static int write_chunk(struct drxd_state *state,
u32 reg, u8 *data, u32 len, u8 flags) u32 reg, u8 * data, u32 len, u8 flags)
{ {
u8 adr=state->config.demod_address; u8 adr = state->config.demod_address;
u8 mm[CHUNK_SIZE+4]={ reg&0xff, (reg>>16)&0xff, u8 mm[CHUNK_SIZE + 4] = { reg & 0xff, (reg >> 16) & 0xff,
flags|((reg>>24)&0xff), (reg>>8)&0xff }; flags | ((reg >> 24) & 0xff), (reg >> 8) & 0xff
};
int i; int i;
for (i=0; i<len; i++) for (i = 0; i < len; i++)
mm[4+i]=data[i]; mm[4 + i] = data[i];
if (i2c_write(state->i2c, adr, mm, 4+len)<0) { if (i2c_write(state->i2c, adr, mm, 4 + len) < 0) {
printk("error in write_chunk\n"); printk("error in write_chunk\n");
return -1; return -1;
} }
...@@ -311,12 +316,12 @@ static int write_chunk(struct drxd_state *state, ...@@ -311,12 +316,12 @@ static int write_chunk(struct drxd_state *state,
} }
static int WriteBlock(struct drxd_state *state, static int WriteBlock(struct drxd_state *state,
u32 Address, u16 BlockSize, u8 *pBlock, u8 Flags) u32 Address, u16 BlockSize, u8 * pBlock, u8 Flags)
{ {
while(BlockSize > 0) { while (BlockSize > 0) {
u16 Chunk = BlockSize > CHUNK_SIZE ? CHUNK_SIZE : BlockSize; u16 Chunk = BlockSize > CHUNK_SIZE ? CHUNK_SIZE : BlockSize;
if (write_chunk(state, Address, pBlock, Chunk, Flags)<0) if (write_chunk(state, Address, pBlock, Chunk, Flags) < 0)
return -1; return -1;
pBlock += Chunk; pBlock += Chunk;
Address += (Chunk >> 1); Address += (Chunk >> 1);
...@@ -325,33 +330,32 @@ static int WriteBlock(struct drxd_state *state, ...@@ -325,33 +330,32 @@ static int WriteBlock(struct drxd_state *state,
return 0; return 0;
} }
static int WriteTable(struct drxd_state *state, u8 *pTable) static int WriteTable(struct drxd_state *state, u8 * pTable)
{ {
int status = 0; int status = 0;
if( pTable == NULL ) if (pTable == NULL)
return 0; return 0;
while(!status) { while (!status) {
u16 Length; u16 Length;
u32 Address = pTable[0]|(pTable[1]<<8)| u32 Address = pTable[0] | (pTable[1] << 8) |
(pTable[2]<<16)|(pTable[3]<<24); (pTable[2] << 16) | (pTable[3] << 24);
if (Address==0xFFFFFFFF) if (Address == 0xFFFFFFFF)
break; break;
pTable += sizeof(u32); pTable += sizeof(u32);
Length = pTable[0]|(pTable[1]<<8); Length = pTable[0] | (pTable[1] << 8);
pTable += sizeof(u16); pTable += sizeof(u16);
if (!Length) if (!Length)
break; break;
status = WriteBlock(state, Address, Length*2, pTable, 0); status = WriteBlock(state, Address, Length * 2, pTable, 0);
pTable += (Length*2); pTable += (Length * 2);
} }
return status; return status;
} }
/****************************************************************************/ /****************************************************************************/
/****************************************************************************/ /****************************************************************************/
/****************************************************************************/ /****************************************************************************/
...@@ -375,22 +379,22 @@ static int InitCE(struct drxd_state *state) ...@@ -375,22 +379,22 @@ static int InitCE(struct drxd_state *state)
CHK_ERROR(WriteTable(state, state->m_InitCE)); CHK_ERROR(WriteTable(state, state->m_InitCE));
if (state->operation_mode == OM_DVBT_Diversity_Front || if (state->operation_mode == OM_DVBT_Diversity_Front ||
state->operation_mode == OM_DVBT_Diversity_End ) { state->operation_mode == OM_DVBT_Diversity_End) {
AppEnv = state->app_env_diversity; AppEnv = state->app_env_diversity;
} }
if ( AppEnv == APPENV_STATIC ) { if (AppEnv == APPENV_STATIC) {
CHK_ERROR(Write16(state,CE_REG_TAPSET__A, 0x0000,0)); CHK_ERROR(Write16(state, CE_REG_TAPSET__A, 0x0000, 0));
} else if( AppEnv == APPENV_PORTABLE ) { } else if (AppEnv == APPENV_PORTABLE) {
CHK_ERROR(Write16(state,CE_REG_TAPSET__A, 0x0001,0)); CHK_ERROR(Write16(state, CE_REG_TAPSET__A, 0x0001, 0));
} else if( AppEnv == APPENV_MOBILE && state->type_A ) { } else if (AppEnv == APPENV_MOBILE && state->type_A) {
CHK_ERROR(Write16(state,CE_REG_TAPSET__A, 0x0002,0)); CHK_ERROR(Write16(state, CE_REG_TAPSET__A, 0x0002, 0));
} else if( AppEnv == APPENV_MOBILE && !state->type_A ) { } else if (AppEnv == APPENV_MOBILE && !state->type_A) {
CHK_ERROR(Write16(state,CE_REG_TAPSET__A, 0x0006,0)); CHK_ERROR(Write16(state, CE_REG_TAPSET__A, 0x0006, 0));
} }
/* start ce */ /* start ce */
CHK_ERROR(Write16(state,B_CE_REG_COMM_EXEC__A,0x0001,0)); CHK_ERROR(Write16(state, B_CE_REG_COMM_EXEC__A, 0x0001, 0));
} while(0); } while (0);
return status; return status;
} }
...@@ -413,65 +417,65 @@ static int StopOC(struct drxd_state *state) ...@@ -413,65 +417,65 @@ static int StopOC(struct drxd_state *state)
/* Flush FIFO (byte-boundary) at fixed rate */ /* Flush FIFO (byte-boundary) at fixed rate */
CHK_ERROR(Read16(state, EC_OC_REG_RCN_MAP_LOP__A, CHK_ERROR(Read16(state, EC_OC_REG_RCN_MAP_LOP__A,
&dtoIncLop,0 )); &dtoIncLop, 0));
CHK_ERROR(Read16(state, EC_OC_REG_RCN_MAP_HIP__A, CHK_ERROR(Read16(state, EC_OC_REG_RCN_MAP_HIP__A,
&dtoIncHip,0 )); &dtoIncHip, 0));
CHK_ERROR(Write16(state, EC_OC_REG_DTO_INC_LOP__A, CHK_ERROR(Write16(state, EC_OC_REG_DTO_INC_LOP__A,
dtoIncLop,0 )); dtoIncLop, 0));
CHK_ERROR(Write16(state, EC_OC_REG_DTO_INC_HIP__A, CHK_ERROR(Write16(state, EC_OC_REG_DTO_INC_HIP__A,
dtoIncHip,0 )); dtoIncHip, 0));
ocModeLop &= ~(EC_OC_REG_OC_MODE_LOP_DTO_CTR_SRC__M); ocModeLop &= ~(EC_OC_REG_OC_MODE_LOP_DTO_CTR_SRC__M);
ocModeLop |= EC_OC_REG_OC_MODE_LOP_DTO_CTR_SRC_STATIC; ocModeLop |= EC_OC_REG_OC_MODE_LOP_DTO_CTR_SRC_STATIC;
CHK_ERROR(Write16(state, EC_OC_REG_OC_MODE_LOP__A, CHK_ERROR(Write16(state, EC_OC_REG_OC_MODE_LOP__A,
ocModeLop,0 )); ocModeLop, 0));
CHK_ERROR(Write16(state, EC_OC_REG_COMM_EXEC__A, CHK_ERROR(Write16(state, EC_OC_REG_COMM_EXEC__A,
EC_OC_REG_COMM_EXEC_CTL_HOLD,0 )); EC_OC_REG_COMM_EXEC_CTL_HOLD, 0));
msleep(1); msleep(1);
/* Output pins to '0' */ /* Output pins to '0' */
CHK_ERROR(Write16(state, EC_OC_REG_OCR_MPG_UOS__A, CHK_ERROR(Write16(state, EC_OC_REG_OCR_MPG_UOS__A,
EC_OC_REG_OCR_MPG_UOS__M,0 )); EC_OC_REG_OCR_MPG_UOS__M, 0));
/* Force the OC out of sync */ /* Force the OC out of sync */
ocSyncLvl &= ~(EC_OC_REG_SNC_ISC_LVL_OSC__M); ocSyncLvl &= ~(EC_OC_REG_SNC_ISC_LVL_OSC__M);
CHK_ERROR(Write16(state, EC_OC_REG_SNC_ISC_LVL__A, CHK_ERROR(Write16(state, EC_OC_REG_SNC_ISC_LVL__A,
ocSyncLvl,0 )); ocSyncLvl, 0));
ocModeLop &= ~(EC_OC_REG_OC_MODE_LOP_PAR_ENA__M); ocModeLop &= ~(EC_OC_REG_OC_MODE_LOP_PAR_ENA__M);
ocModeLop |= EC_OC_REG_OC_MODE_LOP_PAR_ENA_ENABLE; ocModeLop |= EC_OC_REG_OC_MODE_LOP_PAR_ENA_ENABLE;
ocModeLop |= 0x2; /* Magically-out-of-sync */ ocModeLop |= 0x2; /* Magically-out-of-sync */
CHK_ERROR(Write16(state, EC_OC_REG_OC_MODE_LOP__A, CHK_ERROR(Write16(state, EC_OC_REG_OC_MODE_LOP__A,
ocModeLop,0 )); ocModeLop, 0));
CHK_ERROR(Write16(state, EC_OC_REG_COMM_INT_STA__A, 0x0,0 )); CHK_ERROR(Write16(state, EC_OC_REG_COMM_INT_STA__A, 0x0, 0));
CHK_ERROR(Write16(state, EC_OC_REG_COMM_EXEC__A, CHK_ERROR(Write16(state, EC_OC_REG_COMM_EXEC__A,
EC_OC_REG_COMM_EXEC_CTL_ACTIVE,0 )); EC_OC_REG_COMM_EXEC_CTL_ACTIVE, 0));
} while(0); } while (0);
return status; return status;
} }
static int StartOC(struct drxd_state *state) static int StartOC(struct drxd_state *state)
{ {
int status=0; int status = 0;
do { do {
/* Stop OC */ /* Stop OC */
CHK_ERROR(Write16(state, EC_OC_REG_COMM_EXEC__A, CHK_ERROR(Write16(state, EC_OC_REG_COMM_EXEC__A,
EC_OC_REG_COMM_EXEC_CTL_HOLD,0 )); EC_OC_REG_COMM_EXEC_CTL_HOLD, 0));
/* Restore output configuration */ /* Restore output configuration */
CHK_ERROR(Write16(state, EC_OC_REG_SNC_ISC_LVL__A, CHK_ERROR(Write16(state, EC_OC_REG_SNC_ISC_LVL__A,
state->m_EcOcRegSncSncLvl,0 )); state->m_EcOcRegSncSncLvl, 0));
CHK_ERROR(Write16(state, EC_OC_REG_OC_MODE_LOP__A, CHK_ERROR(Write16(state, EC_OC_REG_OC_MODE_LOP__A,
state->m_EcOcRegOcModeLop,0 )); state->m_EcOcRegOcModeLop, 0));
/* Output pins active again */ /* Output pins active again */
CHK_ERROR(Write16(state, EC_OC_REG_OCR_MPG_UOS__A, CHK_ERROR(Write16(state, EC_OC_REG_OCR_MPG_UOS__A,
EC_OC_REG_OCR_MPG_UOS_INIT,0 )); EC_OC_REG_OCR_MPG_UOS_INIT, 0));
/* Start OC */ /* Start OC */
CHK_ERROR(Write16(state, EC_OC_REG_COMM_EXEC__A, CHK_ERROR(Write16(state, EC_OC_REG_COMM_EXEC__A,
EC_OC_REG_COMM_EXEC_CTL_ACTIVE,0 )); EC_OC_REG_COMM_EXEC_CTL_ACTIVE, 0));
} while(0); } while (0);
return status; return status;
} }
...@@ -497,40 +501,39 @@ static int InitAtomicRead(struct drxd_state *state) ...@@ -497,40 +501,39 @@ static int InitAtomicRead(struct drxd_state *state)
static int CorrectSysClockDeviation(struct drxd_state *state); static int CorrectSysClockDeviation(struct drxd_state *state);
static int DRX_GetLockStatus(struct drxd_state *state, u32 *pLockStatus) static int DRX_GetLockStatus(struct drxd_state *state, u32 * pLockStatus)
{ {
u16 ScRaRamLock = 0; u16 ScRaRamLock = 0;
const u16 mpeg_lock_mask = ( SC_RA_RAM_LOCK_MPEG__M | const u16 mpeg_lock_mask = (SC_RA_RAM_LOCK_MPEG__M |
SC_RA_RAM_LOCK_FEC__M | SC_RA_RAM_LOCK_FEC__M |
SC_RA_RAM_LOCK_DEMOD__M ); SC_RA_RAM_LOCK_DEMOD__M);
const u16 fec_lock_mask = ( SC_RA_RAM_LOCK_FEC__M | const u16 fec_lock_mask = (SC_RA_RAM_LOCK_FEC__M |
SC_RA_RAM_LOCK_DEMOD__M ); SC_RA_RAM_LOCK_DEMOD__M);
const u16 demod_lock_mask = SC_RA_RAM_LOCK_DEMOD__M ; const u16 demod_lock_mask = SC_RA_RAM_LOCK_DEMOD__M;
int status; int status;
*pLockStatus=0; *pLockStatus = 0;
status = Read16(state, SC_RA_RAM_LOCK__A, &ScRaRamLock, 0x0000 ); status = Read16(state, SC_RA_RAM_LOCK__A, &ScRaRamLock, 0x0000);
if(status<0) { if (status < 0) {
printk("Can't read SC_RA_RAM_LOCK__A status = %08x\n", printk("Can't read SC_RA_RAM_LOCK__A status = %08x\n", status);
status);
return status; return status;
} }
if( state->drxd_state != DRXD_STARTED ) if (state->drxd_state != DRXD_STARTED)
return 0; return 0;
if ( (ScRaRamLock & mpeg_lock_mask) == mpeg_lock_mask ) { if ((ScRaRamLock & mpeg_lock_mask) == mpeg_lock_mask) {
*pLockStatus|=DRX_LOCK_MPEG; *pLockStatus |= DRX_LOCK_MPEG;
CorrectSysClockDeviation(state); CorrectSysClockDeviation(state);
} }
if ( (ScRaRamLock & fec_lock_mask) == fec_lock_mask ) if ((ScRaRamLock & fec_lock_mask) == fec_lock_mask)
*pLockStatus|=DRX_LOCK_FEC; *pLockStatus |= DRX_LOCK_FEC;
if ( (ScRaRamLock & demod_lock_mask) == demod_lock_mask ) if ((ScRaRamLock & demod_lock_mask) == demod_lock_mask)
*pLockStatus|=DRX_LOCK_DEMOD; *pLockStatus |= DRX_LOCK_DEMOD;
return 0; return 0;
} }
...@@ -540,34 +543,32 @@ static int SetCfgIfAgc(struct drxd_state *state, struct SCfgAgc *cfg) ...@@ -540,34 +543,32 @@ static int SetCfgIfAgc(struct drxd_state *state, struct SCfgAgc *cfg)
{ {
int status; int status;
if( cfg->outputLevel > DRXD_FE_CTRL_MAX ) if (cfg->outputLevel > DRXD_FE_CTRL_MAX)
return -1; return -1;
if( cfg->ctrlMode == AGC_CTRL_USER ) { if (cfg->ctrlMode == AGC_CTRL_USER) {
do { do {
u16 FeAgRegPm1AgcWri; u16 FeAgRegPm1AgcWri;
u16 FeAgRegAgModeLop; u16 FeAgRegAgModeLop;
CHK_ERROR(Read16(state,FE_AG_REG_AG_MODE_LOP__A, CHK_ERROR(Read16(state, FE_AG_REG_AG_MODE_LOP__A,
&FeAgRegAgModeLop,0)); &FeAgRegAgModeLop, 0));
FeAgRegAgModeLop &= FeAgRegAgModeLop &= (~FE_AG_REG_AG_MODE_LOP_MODE_4__M);
(~FE_AG_REG_AG_MODE_LOP_MODE_4__M); FeAgRegAgModeLop |= FE_AG_REG_AG_MODE_LOP_MODE_4_STATIC;
FeAgRegAgModeLop |= CHK_ERROR(Write16(state, FE_AG_REG_AG_MODE_LOP__A,
FE_AG_REG_AG_MODE_LOP_MODE_4_STATIC; FeAgRegAgModeLop, 0));
CHK_ERROR(Write16(state,FE_AG_REG_AG_MODE_LOP__A,
FeAgRegAgModeLop,0));
FeAgRegPm1AgcWri = (u16)(cfg->outputLevel & FeAgRegPm1AgcWri = (u16) (cfg->outputLevel &
FE_AG_REG_PM1_AGC_WRI__M); FE_AG_REG_PM1_AGC_WRI__M);
CHK_ERROR(Write16(state,FE_AG_REG_PM1_AGC_WRI__A, CHK_ERROR(Write16(state, FE_AG_REG_PM1_AGC_WRI__A,
FeAgRegPm1AgcWri,0)); FeAgRegPm1AgcWri, 0));
} }
while(0); while (0);
} else if( cfg->ctrlMode == AGC_CTRL_AUTO ) { } else if (cfg->ctrlMode == AGC_CTRL_AUTO) {
if ( ( (cfg->maxOutputLevel) < (cfg->minOutputLevel) ) || if (((cfg->maxOutputLevel) < (cfg->minOutputLevel)) ||
( (cfg->maxOutputLevel) > DRXD_FE_CTRL_MAX ) || ((cfg->maxOutputLevel) > DRXD_FE_CTRL_MAX) ||
( (cfg->speed) > DRXD_FE_CTRL_MAX ) || ((cfg->speed) > DRXD_FE_CTRL_MAX) ||
( (cfg->settleLevel) > DRXD_FE_CTRL_MAX ) ((cfg->settleLevel) > DRXD_FE_CTRL_MAX)
) )
return (-1); return (-1);
do { do {
...@@ -577,55 +578,54 @@ static int SetCfgIfAgc(struct drxd_state *state, struct SCfgAgc *cfg) ...@@ -577,55 +578,54 @@ static int SetCfgIfAgc(struct drxd_state *state, struct SCfgAgc *cfg)
/* == Mode == */ /* == Mode == */
CHK_ERROR(Read16(state,FE_AG_REG_AG_MODE_LOP__A, CHK_ERROR(Read16(state, FE_AG_REG_AG_MODE_LOP__A,
&FeAgRegAgModeLop,0)); &FeAgRegAgModeLop, 0));
FeAgRegAgModeLop &= FeAgRegAgModeLop &= (~FE_AG_REG_AG_MODE_LOP_MODE_4__M);
(~FE_AG_REG_AG_MODE_LOP_MODE_4__M);
FeAgRegAgModeLop |= FeAgRegAgModeLop |=
FE_AG_REG_AG_MODE_LOP_MODE_4_DYNAMIC; FE_AG_REG_AG_MODE_LOP_MODE_4_DYNAMIC;
CHK_ERROR(Write16(state,FE_AG_REG_AG_MODE_LOP__A, CHK_ERROR(Write16(state, FE_AG_REG_AG_MODE_LOP__A,
FeAgRegAgModeLop,0)); FeAgRegAgModeLop, 0));
/* == Settle level == */ /* == Settle level == */
FeAgRegEgcSetLvl = (u16)(( cfg->settleLevel >> 1 ) & FeAgRegEgcSetLvl = (u16) ((cfg->settleLevel >> 1) &
FE_AG_REG_EGC_SET_LVL__M ); FE_AG_REG_EGC_SET_LVL__M);
CHK_ERROR(Write16(state,FE_AG_REG_EGC_SET_LVL__A, CHK_ERROR(Write16(state, FE_AG_REG_EGC_SET_LVL__A,
FeAgRegEgcSetLvl,0)); FeAgRegEgcSetLvl, 0));
/* == Min/Max == */ /* == Min/Max == */
slope = (u16)(( cfg->maxOutputLevel - slope = (u16) ((cfg->maxOutputLevel -
cfg->minOutputLevel )/2); cfg->minOutputLevel) / 2);
offset = (u16)(( cfg->maxOutputLevel + offset = (u16) ((cfg->maxOutputLevel +
cfg->minOutputLevel )/2 - 511); cfg->minOutputLevel) / 2 - 511);
CHK_ERROR(Write16(state,FE_AG_REG_GC1_AGC_RIC__A, CHK_ERROR(Write16(state, FE_AG_REG_GC1_AGC_RIC__A,
slope,0)); slope, 0));
CHK_ERROR(Write16(state,FE_AG_REG_GC1_AGC_OFF__A, CHK_ERROR(Write16(state, FE_AG_REG_GC1_AGC_OFF__A,
offset,0)); offset, 0));
/* == Speed == */ /* == Speed == */
{ {
const u16 maxRur = 8; const u16 maxRur = 8;
const u16 slowIncrDecLUT[]={ 3, 4, 4, 5, 6 }; const u16 slowIncrDecLUT[] = { 3, 4, 4, 5, 6 };
const u16 fastIncrDecLUT[]={ 14, 15, 15, 16, const u16 fastIncrDecLUT[] = { 14, 15, 15, 16,
17, 18, 18, 19, 17, 18, 18, 19,
20, 21, 22, 23, 20, 21, 22, 23,
24, 26, 27, 28, 24, 26, 27, 28,
29, 31}; 29, 31
};
u16 fineSteps = (DRXD_FE_CTRL_MAX+1)/ u16 fineSteps = (DRXD_FE_CTRL_MAX + 1) /
(maxRur+1); (maxRur + 1);
u16 fineSpeed = (u16)(cfg->speed - u16 fineSpeed = (u16) (cfg->speed -
((cfg->speed/ ((cfg->speed /
fineSteps)* fineSteps) *
fineSteps)); fineSteps));
u16 invRurCount= (u16)(cfg->speed / u16 invRurCount = (u16) (cfg->speed /
fineSteps); fineSteps);
u16 rurCount; u16 rurCount;
if ( invRurCount > maxRur ) if (invRurCount > maxRur) {
{
rurCount = 0; rurCount = 0;
fineSpeed += fineSteps; fineSpeed += fineSteps;
} else { } else {
...@@ -641,11 +641,13 @@ static int SetCfgIfAgc(struct drxd_state *state, struct SCfgAgc *cfg) ...@@ -641,11 +641,13 @@ static int SetCfgIfAgc(struct drxd_state *state, struct SCfgAgc *cfg)
*/ */
{ {
u16 fastIncrDec = u16 fastIncrDec =
fastIncrDecLUT[fineSpeed/ fastIncrDecLUT[fineSpeed /
((fineSteps/ ((fineSteps /
(14+1))+1) ]; (14 + 1)) + 1)];
u16 slowIncrDec = slowIncrDecLUT[ u16 slowIncrDec =
fineSpeed/(fineSteps/(3+1)) ]; slowIncrDecLUT[fineSpeed /
(fineSteps /
(3 + 1))];
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
FE_AG_REG_EGC_RUR_CNT__A, FE_AG_REG_EGC_RUR_CNT__A,
...@@ -664,7 +666,7 @@ static int SetCfgIfAgc(struct drxd_state *state, struct SCfgAgc *cfg) ...@@ -664,7 +666,7 @@ static int SetCfgIfAgc(struct drxd_state *state, struct SCfgAgc *cfg)
slowIncrDec, 0)); slowIncrDec, 0));
} }
} }
} while(0); } while (0);
} else { } else {
/* No OFF mode for IF control */ /* No OFF mode for IF control */
...@@ -673,63 +675,60 @@ static int SetCfgIfAgc(struct drxd_state *state, struct SCfgAgc *cfg) ...@@ -673,63 +675,60 @@ static int SetCfgIfAgc(struct drxd_state *state, struct SCfgAgc *cfg)
return status; return status;
} }
static int SetCfgRfAgc(struct drxd_state *state, struct SCfgAgc *cfg) static int SetCfgRfAgc(struct drxd_state *state, struct SCfgAgc *cfg)
{ {
int status = 0; int status = 0;
if( cfg->outputLevel > DRXD_FE_CTRL_MAX ) if (cfg->outputLevel > DRXD_FE_CTRL_MAX)
return -1; return -1;
if( cfg->ctrlMode == AGC_CTRL_USER ) { if (cfg->ctrlMode == AGC_CTRL_USER) {
do { do {
u16 AgModeLop=0; u16 AgModeLop = 0;
u16 level = ( cfg->outputLevel ); u16 level = (cfg->outputLevel);
if (level == DRXD_FE_CTRL_MAX ) if (level == DRXD_FE_CTRL_MAX)
level++; level++;
CHK_ERROR( Write16(state,FE_AG_REG_PM2_AGC_WRI__A, CHK_ERROR(Write16(state, FE_AG_REG_PM2_AGC_WRI__A,
level, 0x0000 )); level, 0x0000));
/*==== Mode ====*/ /*==== Mode ====*/
/* Powerdown PD2, WRI source */ /* Powerdown PD2, WRI source */
state->m_FeAgRegAgPwd &= state->m_FeAgRegAgPwd &= ~(FE_AG_REG_AG_PWD_PWD_PD2__M);
~(FE_AG_REG_AG_PWD_PWD_PD2__M);
state->m_FeAgRegAgPwd |= state->m_FeAgRegAgPwd |=
FE_AG_REG_AG_PWD_PWD_PD2_DISABLE; FE_AG_REG_AG_PWD_PWD_PD2_DISABLE;
CHK_ERROR( Write16(state,FE_AG_REG_AG_PWD__A, CHK_ERROR(Write16(state, FE_AG_REG_AG_PWD__A,
state->m_FeAgRegAgPwd,0x0000 )); state->m_FeAgRegAgPwd, 0x0000));
CHK_ERROR( Read16(state,FE_AG_REG_AG_MODE_LOP__A, CHK_ERROR(Read16(state, FE_AG_REG_AG_MODE_LOP__A,
&AgModeLop,0x0000 )); &AgModeLop, 0x0000));
AgModeLop &= (~( FE_AG_REG_AG_MODE_LOP_MODE_5__M | AgModeLop &= (~(FE_AG_REG_AG_MODE_LOP_MODE_5__M |
FE_AG_REG_AG_MODE_LOP_MODE_E__M)); FE_AG_REG_AG_MODE_LOP_MODE_E__M));
AgModeLop |= ( FE_AG_REG_AG_MODE_LOP_MODE_5_STATIC | AgModeLop |= (FE_AG_REG_AG_MODE_LOP_MODE_5_STATIC |
FE_AG_REG_AG_MODE_LOP_MODE_E_STATIC ); FE_AG_REG_AG_MODE_LOP_MODE_E_STATIC);
CHK_ERROR( Write16(state,FE_AG_REG_AG_MODE_LOP__A, CHK_ERROR(Write16(state, FE_AG_REG_AG_MODE_LOP__A,
AgModeLop,0x0000 )); AgModeLop, 0x0000));
/* enable AGC2 pin */ /* enable AGC2 pin */
{ {
u16 FeAgRegAgAgcSio = 0; u16 FeAgRegAgAgcSio = 0;
CHK_ERROR( Read16(state, CHK_ERROR(Read16(state,
FE_AG_REG_AG_AGC_SIO__A, FE_AG_REG_AG_AGC_SIO__A,
&FeAgRegAgAgcSio, 0x0000 )); &FeAgRegAgAgcSio, 0x0000));
FeAgRegAgAgcSio &= FeAgRegAgAgcSio &=
~(FE_AG_REG_AG_AGC_SIO_AGC_SIO_2__M); ~(FE_AG_REG_AG_AGC_SIO_AGC_SIO_2__M);
FeAgRegAgAgcSio |= FeAgRegAgAgcSio |=
FE_AG_REG_AG_AGC_SIO_AGC_SIO_2_OUTPUT; FE_AG_REG_AG_AGC_SIO_AGC_SIO_2_OUTPUT;
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
FE_AG_REG_AG_AGC_SIO__A, FE_AG_REG_AG_AGC_SIO__A,
FeAgRegAgAgcSio, 0x0000 )); FeAgRegAgAgcSio, 0x0000));
} }
} while(0); } while (0);
} else if( cfg->ctrlMode == AGC_CTRL_AUTO ) { } else if (cfg->ctrlMode == AGC_CTRL_AUTO) {
u16 AgModeLop=0; u16 AgModeLop = 0;
do { do {
u16 level; u16 level;
...@@ -739,24 +738,24 @@ static int SetCfgRfAgc(struct drxd_state *state, struct SCfgAgc *cfg) ...@@ -739,24 +738,24 @@ static int SetCfgRfAgc(struct drxd_state *state, struct SCfgAgc *cfg)
~(FE_AG_REG_AG_PWD_PWD_PD2__M); ~(FE_AG_REG_AG_PWD_PWD_PD2__M);
(state->m_FeAgRegAgPwd) |= (state->m_FeAgRegAgPwd) |=
FE_AG_REG_AG_PWD_PWD_PD2_DISABLE; FE_AG_REG_AG_PWD_PWD_PD2_DISABLE;
CHK_ERROR(Write16(state,FE_AG_REG_AG_PWD__A, CHK_ERROR(Write16(state, FE_AG_REG_AG_PWD__A,
(state->m_FeAgRegAgPwd),0x0000 )); (state->m_FeAgRegAgPwd), 0x0000));
CHK_ERROR(Read16(state,FE_AG_REG_AG_MODE_LOP__A, CHK_ERROR(Read16(state, FE_AG_REG_AG_MODE_LOP__A,
&AgModeLop,0x0000 )); &AgModeLop, 0x0000));
AgModeLop &= (~( FE_AG_REG_AG_MODE_LOP_MODE_5__M | AgModeLop &= (~(FE_AG_REG_AG_MODE_LOP_MODE_5__M |
FE_AG_REG_AG_MODE_LOP_MODE_E__M)); FE_AG_REG_AG_MODE_LOP_MODE_E__M));
AgModeLop |= ( FE_AG_REG_AG_MODE_LOP_MODE_5_STATIC | AgModeLop |= (FE_AG_REG_AG_MODE_LOP_MODE_5_STATIC |
FE_AG_REG_AG_MODE_LOP_MODE_E_DYNAMIC ); FE_AG_REG_AG_MODE_LOP_MODE_E_DYNAMIC);
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
FE_AG_REG_AG_MODE_LOP__A, FE_AG_REG_AG_MODE_LOP__A,
AgModeLop, 0x0000 )); AgModeLop, 0x0000));
/* Settle level */ /* Settle level */
level = ( (( cfg->settleLevel )>>4) & level = (((cfg->settleLevel) >> 4) &
FE_AG_REG_TGC_SET_LVL__M ); FE_AG_REG_TGC_SET_LVL__M);
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
FE_AG_REG_TGC_SET_LVL__A, FE_AG_REG_TGC_SET_LVL__A,
level,0x0000 )); level, 0x0000));
/* Min/max: don't care */ /* Min/max: don't care */
...@@ -765,21 +764,21 @@ static int SetCfgRfAgc(struct drxd_state *state, struct SCfgAgc *cfg) ...@@ -765,21 +764,21 @@ static int SetCfgRfAgc(struct drxd_state *state, struct SCfgAgc *cfg)
/* enable AGC2 pin */ /* enable AGC2 pin */
{ {
u16 FeAgRegAgAgcSio = 0; u16 FeAgRegAgAgcSio = 0;
CHK_ERROR( Read16(state, CHK_ERROR(Read16(state,
FE_AG_REG_AG_AGC_SIO__A, FE_AG_REG_AG_AGC_SIO__A,
&FeAgRegAgAgcSio, 0x0000 )); &FeAgRegAgAgcSio, 0x0000));
FeAgRegAgAgcSio &= FeAgRegAgAgcSio &=
~(FE_AG_REG_AG_AGC_SIO_AGC_SIO_2__M); ~(FE_AG_REG_AG_AGC_SIO_AGC_SIO_2__M);
FeAgRegAgAgcSio |= FeAgRegAgAgcSio |=
FE_AG_REG_AG_AGC_SIO_AGC_SIO_2_OUTPUT; FE_AG_REG_AG_AGC_SIO_AGC_SIO_2_OUTPUT;
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
FE_AG_REG_AG_AGC_SIO__A, FE_AG_REG_AG_AGC_SIO__A,
FeAgRegAgAgcSio, 0x0000 )); FeAgRegAgAgcSio, 0x0000));
} }
} while(0); } while (0);
} else { } else {
u16 AgModeLop=0; u16 AgModeLop = 0;
do { do {
/* No RF AGC control */ /* No RF AGC control */
...@@ -790,48 +789,48 @@ static int SetCfgRfAgc(struct drxd_state *state, struct SCfgAgc *cfg) ...@@ -790,48 +789,48 @@ static int SetCfgRfAgc(struct drxd_state *state, struct SCfgAgc *cfg)
FE_AG_REG_AG_PWD_PWD_PD2_ENABLE; FE_AG_REG_AG_PWD_PWD_PD2_ENABLE;
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
FE_AG_REG_AG_PWD__A, FE_AG_REG_AG_PWD__A,
(state->m_FeAgRegAgPwd),0x0000 )); (state->m_FeAgRegAgPwd), 0x0000));
CHK_ERROR(Read16(state, CHK_ERROR(Read16(state,
FE_AG_REG_AG_MODE_LOP__A, FE_AG_REG_AG_MODE_LOP__A,
&AgModeLop,0x0000 )); &AgModeLop, 0x0000));
AgModeLop &= (~( FE_AG_REG_AG_MODE_LOP_MODE_5__M | AgModeLop &= (~(FE_AG_REG_AG_MODE_LOP_MODE_5__M |
FE_AG_REG_AG_MODE_LOP_MODE_E__M)); FE_AG_REG_AG_MODE_LOP_MODE_E__M));
AgModeLop |= ( FE_AG_REG_AG_MODE_LOP_MODE_5_STATIC | AgModeLop |= (FE_AG_REG_AG_MODE_LOP_MODE_5_STATIC |
FE_AG_REG_AG_MODE_LOP_MODE_E_STATIC ); FE_AG_REG_AG_MODE_LOP_MODE_E_STATIC);
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
FE_AG_REG_AG_MODE_LOP__A, FE_AG_REG_AG_MODE_LOP__A,
AgModeLop,0x0000 )); AgModeLop, 0x0000));
/* set FeAgRegAgAgcSio AGC2 (RF) as input */ /* set FeAgRegAgAgcSio AGC2 (RF) as input */
{ {
u16 FeAgRegAgAgcSio = 0; u16 FeAgRegAgAgcSio = 0;
CHK_ERROR( Read16(state, CHK_ERROR(Read16(state,
FE_AG_REG_AG_AGC_SIO__A, FE_AG_REG_AG_AGC_SIO__A,
&FeAgRegAgAgcSio, 0x0000 )); &FeAgRegAgAgcSio, 0x0000));
FeAgRegAgAgcSio &= FeAgRegAgAgcSio &=
~(FE_AG_REG_AG_AGC_SIO_AGC_SIO_2__M); ~(FE_AG_REG_AG_AGC_SIO_AGC_SIO_2__M);
FeAgRegAgAgcSio |= FeAgRegAgAgcSio |=
FE_AG_REG_AG_AGC_SIO_AGC_SIO_2_INPUT; FE_AG_REG_AG_AGC_SIO_AGC_SIO_2_INPUT;
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
FE_AG_REG_AG_AGC_SIO__A, FE_AG_REG_AG_AGC_SIO__A,
FeAgRegAgAgcSio, 0x0000 )); FeAgRegAgAgcSio, 0x0000));
} }
} while(0); } while (0);
} }
return status; return status;
} }
static int ReadIFAgc(struct drxd_state *state, u32 *pValue) static int ReadIFAgc(struct drxd_state *state, u32 * pValue)
{ {
int status = 0; int status = 0;
*pValue = 0; *pValue = 0;
if( state->if_agc_cfg.ctrlMode != AGC_CTRL_OFF ) { if (state->if_agc_cfg.ctrlMode != AGC_CTRL_OFF) {
u16 Value; u16 Value;
status = Read16(state, FE_AG_REG_GC1_AGC_DAT__A,&Value,0); status = Read16(state, FE_AG_REG_GC1_AGC_DAT__A, &Value, 0);
Value &= FE_AG_REG_GC1_AGC_DAT__M; Value &= FE_AG_REG_GC1_AGC_DAT__M;
if(status>=0) { if (status >= 0) {
/* 3.3V /* 3.3V
| |
R1 R1
...@@ -846,10 +845,10 @@ static int ReadIFAgc(struct drxd_state *state, u32 *pValue) ...@@ -846,10 +845,10 @@ static int ReadIFAgc(struct drxd_state *state, u32 *pValue)
u32 R2 = state->if_agc_cfg.R2; u32 R2 = state->if_agc_cfg.R2;
u32 R3 = state->if_agc_cfg.R3; u32 R3 = state->if_agc_cfg.R3;
u32 Vmax = (3300 * R2) / ( R1 + R2 ); u32 Vmax = (3300 * R2) / (R1 + R2);
u32 Rpar = ( R2 * R3 ) / ( R3 + R2 ); u32 Rpar = (R2 * R3) / (R3 + R2);
u32 Vmin = (3300 * Rpar ) / ( R1 + Rpar ); u32 Vmin = (3300 * Rpar) / (R1 + Rpar);
u32 Vout = Vmin + (( Vmax - Vmin ) * Value) / 1024; u32 Vout = Vmin + ((Vmax - Vmin) * Value) / 1024;
*pValue = Vout; *pValue = Vout;
} }
...@@ -878,7 +877,7 @@ static int load_firmware(struct drxd_state *state, const char *fw_name) ...@@ -878,7 +877,7 @@ static int load_firmware(struct drxd_state *state, const char *fw_name)
} }
static int DownloadMicrocode(struct drxd_state *state, static int DownloadMicrocode(struct drxd_state *state,
const u8 *pMCImage, u32 Length) const u8 * pMCImage, u32 Length)
{ {
u8 *pSrc; u8 *pSrc;
u16 Flags; u16 Flags;
...@@ -886,32 +885,38 @@ static int DownloadMicrocode(struct drxd_state *state, ...@@ -886,32 +885,38 @@ static int DownloadMicrocode(struct drxd_state *state,
u16 nBlocks; u16 nBlocks;
u16 BlockSize; u16 BlockSize;
u16 BlockCRC; u16 BlockCRC;
u32 offset=0; u32 offset = 0;
int i, status=0; int i, status = 0;
pSrc=(u8 *) pMCImage; pSrc = (u8 *) pMCImage;
Flags = (pSrc[0] << 8) | pSrc[1]; Flags = (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++ ) { for (i = 0; i < nBlocks; i++) {
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, status = WriteBlock(state, Address, BlockSize,
pSrc,DRX_I2C_CLEARCRC); pSrc, DRX_I2C_CLEARCRC);
if (status<0) if (status < 0)
break; break;
pSrc += BlockSize; pSrc += BlockSize;
offset += BlockSize; offset += BlockSize;
...@@ -920,51 +925,48 @@ static int DownloadMicrocode(struct drxd_state *state, ...@@ -920,51 +925,48 @@ static int DownloadMicrocode(struct drxd_state *state,
return status; return status;
} }
static int HI_Command(struct drxd_state *state, u16 cmd, u16 *pResult) static int HI_Command(struct drxd_state *state, u16 cmd, u16 * pResult)
{ {
u32 nrRetries = 0; u32 nrRetries = 0;
u16 waitCmd; u16 waitCmd;
int status; int status;
if ((status=Write16(state, HI_RA_RAM_SRV_CMD__A, cmd, 0))<0) if ((status = Write16(state, HI_RA_RAM_SRV_CMD__A, cmd, 0)) < 0)
return status; return status;
do { do {
nrRetries+=1; nrRetries += 1;
if (nrRetries>DRXD_MAX_RETRIES) { if (nrRetries > DRXD_MAX_RETRIES) {
status=-1; status = -1;
break; break;
}; };
status=Read16(state, HI_RA_RAM_SRV_CMD__A, &waitCmd, 0); status = Read16(state, HI_RA_RAM_SRV_CMD__A, &waitCmd, 0);
} while (waitCmd!=0); } while (waitCmd != 0);
if (status>=0) if (status >= 0)
status=Read16(state, HI_RA_RAM_SRV_RES__A, pResult, 0); status = Read16(state, HI_RA_RAM_SRV_RES__A, pResult, 0);
return status; return status;
} }
static int HI_CfgCommand(struct drxd_state *state) static int HI_CfgCommand(struct drxd_state *state)
{ {
int status=0; int status = 0;
down(&state->mutex); down(&state->mutex);
Write16(state, HI_RA_RAM_SRV_CFG_KEY__A, Write16(state, HI_RA_RAM_SRV_CFG_KEY__A, HI_RA_RAM_SRV_RST_KEY_ACT, 0);
HI_RA_RAM_SRV_RST_KEY_ACT, 0);
Write16(state, HI_RA_RAM_SRV_CFG_DIV__A, state->hi_cfg_timing_div, 0); Write16(state, HI_RA_RAM_SRV_CFG_DIV__A, state->hi_cfg_timing_div, 0);
Write16(state, HI_RA_RAM_SRV_CFG_BDL__A, Write16(state, HI_RA_RAM_SRV_CFG_BDL__A, state->hi_cfg_bridge_delay, 0);
state->hi_cfg_bridge_delay, 0);
Write16(state, HI_RA_RAM_SRV_CFG_WUP__A, state->hi_cfg_wakeup_key, 0); Write16(state, HI_RA_RAM_SRV_CFG_WUP__A, state->hi_cfg_wakeup_key, 0);
Write16(state, HI_RA_RAM_SRV_CFG_ACT__A, state->hi_cfg_ctrl, 0); Write16(state, HI_RA_RAM_SRV_CFG_ACT__A, state->hi_cfg_ctrl, 0);
Write16(state, HI_RA_RAM_SRV_CFG_KEY__A, Write16(state, HI_RA_RAM_SRV_CFG_KEY__A, HI_RA_RAM_SRV_RST_KEY_ACT, 0);
HI_RA_RAM_SRV_RST_KEY_ACT, 0);
if ((state->hi_cfg_ctrl & HI_RA_RAM_SRV_CFG_ACT_PWD_EXE)== if ((state->hi_cfg_ctrl & HI_RA_RAM_SRV_CFG_ACT_PWD_EXE) ==
HI_RA_RAM_SRV_CFG_ACT_PWD_EXE) HI_RA_RAM_SRV_CFG_ACT_PWD_EXE)
status=Write16(state, HI_RA_RAM_SRV_CMD__A, status = Write16(state, HI_RA_RAM_SRV_CMD__A,
HI_RA_RAM_SRV_CMD_CONFIG, 0); HI_RA_RAM_SRV_CMD_CONFIG, 0);
else else
status=HI_Command(state, HI_RA_RAM_SRV_CMD_CONFIG, 0); status = HI_Command(state, HI_RA_RAM_SRV_CMD_CONFIG, 0);
up(&state->mutex); up(&state->mutex);
return status; return status;
} }
...@@ -982,20 +984,19 @@ static int HI_ResetCommand(struct drxd_state *state) ...@@ -982,20 +984,19 @@ static int HI_ResetCommand(struct drxd_state *state)
int status; int status;
down(&state->mutex); down(&state->mutex);
status=Write16(state, HI_RA_RAM_SRV_RST_KEY__A, status = Write16(state, HI_RA_RAM_SRV_RST_KEY__A,
HI_RA_RAM_SRV_RST_KEY_ACT, 0); HI_RA_RAM_SRV_RST_KEY_ACT, 0);
if (status==0) if (status == 0)
status=HI_Command(state, HI_RA_RAM_SRV_CMD_RESET, 0); status = HI_Command(state, HI_RA_RAM_SRV_CMD_RESET, 0);
up(&state->mutex); up(&state->mutex);
msleep(1); msleep(1);
return status; return status;
} }
static int DRX_ConfigureI2CBridge(struct drxd_state *state, static int DRX_ConfigureI2CBridge(struct drxd_state *state, int bEnableBridge)
int bEnableBridge)
{ {
state->hi_cfg_ctrl &= (~HI_RA_RAM_SRV_CFG_ACT_BRD__M); state->hi_cfg_ctrl &= (~HI_RA_RAM_SRV_CFG_ACT_BRD__M);
if ( bEnableBridge ) if (bEnableBridge)
state->hi_cfg_ctrl |= HI_RA_RAM_SRV_CFG_ACT_BRD_ON; state->hi_cfg_ctrl |= HI_RA_RAM_SRV_CFG_ACT_BRD_ON;
else else
state->hi_cfg_ctrl |= HI_RA_RAM_SRV_CFG_ACT_BRD_OFF; state->hi_cfg_ctrl |= HI_RA_RAM_SRV_CFG_ACT_BRD_OFF;
...@@ -1010,13 +1011,13 @@ static int DRX_ConfigureI2CBridge(struct drxd_state *state, ...@@ -1010,13 +1011,13 @@ static int DRX_ConfigureI2CBridge(struct drxd_state *state,
#if 0 #if 0
static int AtomicReadBlock(struct drxd_state *state, static int AtomicReadBlock(struct drxd_state *state,
u32 Addr, u16 DataSize, u8 *pData, u8 Flags) u32 Addr, u16 DataSize, u8 * pData, u8 Flags)
{ {
int status; int status;
int i=0; int i = 0;
/* Parameter check */ /* Parameter check */
if ( (!pData) || ( (DataSize & 1)!=0 ) ) if ((!pData) || ((DataSize & 1) != 0))
return -1; return -1;
down(&state->mutex); down(&state->mutex);
...@@ -1024,31 +1025,31 @@ static int AtomicReadBlock(struct drxd_state *state, ...@@ -1024,31 +1025,31 @@ static int AtomicReadBlock(struct drxd_state *state,
do { do {
/* Instruct HI to read n bytes */ /* Instruct HI to read n bytes */
/* TODO use proper names forthese egisters */ /* TODO use proper names forthese egisters */
CHK_ERROR( Write16(state,HI_RA_RAM_SRV_CFG_KEY__A, CHK_ERROR(Write16(state, HI_RA_RAM_SRV_CFG_KEY__A,
(HI_TR_FUNC_ADDR & 0xFFFF), 0)); (HI_TR_FUNC_ADDR & 0xFFFF), 0));
CHK_ERROR( Write16(state,HI_RA_RAM_SRV_CFG_DIV__A, CHK_ERROR(Write16(state, HI_RA_RAM_SRV_CFG_DIV__A,
(u16)(Addr >> 16), 0)); (u16) (Addr >> 16), 0));
CHK_ERROR( Write16(state,HI_RA_RAM_SRV_CFG_BDL__A, CHK_ERROR(Write16(state, HI_RA_RAM_SRV_CFG_BDL__A,
(u16)(Addr & 0xFFFF), 0)); (u16) (Addr & 0xFFFF), 0));
CHK_ERROR( Write16(state,HI_RA_RAM_SRV_CFG_WUP__A, CHK_ERROR(Write16(state, HI_RA_RAM_SRV_CFG_WUP__A,
(u16)((DataSize/2) - 1), 0)); (u16) ((DataSize / 2) - 1), 0));
CHK_ERROR( Write16(state,HI_RA_RAM_SRV_CFG_ACT__A, CHK_ERROR(Write16(state, HI_RA_RAM_SRV_CFG_ACT__A,
HI_TR_READ, 0)); HI_TR_READ, 0));
CHK_ERROR( HI_Command(state, HI_RA_RAM_SRV_CMD_EXECUTE,0)); CHK_ERROR(HI_Command(state, HI_RA_RAM_SRV_CMD_EXECUTE, 0));
} while(0); } while (0);
if (status>=0) { if (status >= 0) {
for (i = 0; i < (DataSize/2); i += 1) { for (i = 0; i < (DataSize / 2); i += 1) {
u16 word; u16 word;
status = Read16(state, (HI_RA_RAM_USR_BEGIN__A + i), status = Read16(state, (HI_RA_RAM_USR_BEGIN__A + i),
&word, 0); &word, 0);
if( status<0) if (status < 0)
break; break;
pData[2*i] = (u8) (word & 0xFF); pData[2 * i] = (u8) (word & 0xFF);
pData[(2*i) + 1] = (u8) (word >> 8 ); pData[(2 * i) + 1] = (u8) (word >> 8);
} }
} }
up(&state->mutex); up(&state->mutex);
...@@ -1056,18 +1057,17 @@ static int AtomicReadBlock(struct drxd_state *state, ...@@ -1056,18 +1057,17 @@ static int AtomicReadBlock(struct drxd_state *state,
} }
static int AtomicReadReg32(struct drxd_state *state, static int AtomicReadReg32(struct drxd_state *state,
u32 Addr, u32 *pData, u8 Flags) u32 Addr, u32 * pData, u8 Flags)
{ {
u8 buf[sizeof (u32)]; u8 buf[sizeof(u32)];
int status; int status;
if (!pData) if (!pData)
return -1; return -1;
status=AtomicReadBlock(state, Addr, sizeof (u32), buf, Flags); status = AtomicReadBlock(state, Addr, sizeof(u32), buf, Flags);
*pData = (((u32) buf[0]) << 0) + *pData = (((u32) buf[0]) << 0) +
(((u32) buf[1]) << 8) + (((u32) buf[1]) << 8) +
(((u32) buf[2]) << 16) + (((u32) buf[2]) << 16) + (((u32) buf[3]) << 24);
(((u32) buf[3]) << 24);
return status; return status;
} }
#endif #endif
...@@ -1095,7 +1095,7 @@ static int InitCC(struct drxd_state *state) ...@@ -1095,7 +1095,7 @@ static int InitCC(struct drxd_state *state)
{ {
if (state->osc_clock_freq == 0 || if (state->osc_clock_freq == 0 ||
state->osc_clock_freq > 20000 || state->osc_clock_freq > 20000 ||
(state->osc_clock_freq % 4000 ) != 0 ) { (state->osc_clock_freq % 4000) != 0) {
printk("invalid osc frequency %d\n", state->osc_clock_freq); printk("invalid osc frequency %d\n", state->osc_clock_freq);
return -1; return -1;
} }
...@@ -1103,7 +1103,7 @@ static int InitCC(struct drxd_state *state) ...@@ -1103,7 +1103,7 @@ static int InitCC(struct drxd_state *state)
Write16(state, CC_REG_OSC_MODE__A, CC_REG_OSC_MODE_M20, 0); Write16(state, CC_REG_OSC_MODE__A, CC_REG_OSC_MODE_M20, 0);
Write16(state, CC_REG_PLL_MODE__A, CC_REG_PLL_MODE_BYPASS_PLL | Write16(state, CC_REG_PLL_MODE__A, CC_REG_PLL_MODE_BYPASS_PLL |
CC_REG_PLL_MODE_PUMP_CUR_12, 0); CC_REG_PLL_MODE_PUMP_CUR_12, 0);
Write16(state, CC_REG_REF_DIVIDE__A, state->osc_clock_freq/4000, 0); Write16(state, CC_REG_REF_DIVIDE__A, state->osc_clock_freq / 4000, 0);
Write16(state, CC_REG_PWD_MODE__A, CC_REG_PWD_MODE_DOWN_PLL, 0); Write16(state, CC_REG_PWD_MODE__A, CC_REG_PWD_MODE_DOWN_PLL, 0);
Write16(state, CC_REG_UPDATE__A, CC_REG_UPDATE_KEY, 0); Write16(state, CC_REG_UPDATE__A, CC_REG_UPDATE_KEY, 0);
...@@ -1114,19 +1114,18 @@ static int ResetECOD(struct drxd_state *state) ...@@ -1114,19 +1114,18 @@ static int ResetECOD(struct drxd_state *state)
{ {
int status = 0; int status = 0;
if(state->type_A ) if (state->type_A)
status = Write16(state, EC_OD_REG_SYNC__A, 0x0664, 0); status = Write16(state, EC_OD_REG_SYNC__A, 0x0664, 0);
else else
status = Write16(state, B_EC_OD_REG_SYNC__A, 0x0664, 0); status = Write16(state, B_EC_OD_REG_SYNC__A, 0x0664, 0);
if (!(status<0)) if (!(status < 0))
status = WriteTable(state, state->m_ResetECRAM); status = WriteTable(state, state->m_ResetECRAM);
if (!(status<0)) if (!(status < 0))
status = Write16(state, EC_OD_REG_COMM_EXEC__A, 0x0001, 0); status = Write16(state, EC_OD_REG_COMM_EXEC__A, 0x0001, 0);
return status; return status;
} }
/* Configure PGA switch */ /* Configure PGA switch */
static int SetCfgPga(struct drxd_state *state, int pgaSwitch) static int SetCfgPga(struct drxd_state *state, int pgaSwitch)
...@@ -1135,21 +1134,21 @@ static int SetCfgPga(struct drxd_state *state, int pgaSwitch) ...@@ -1135,21 +1134,21 @@ static int SetCfgPga(struct drxd_state *state, int pgaSwitch)
u16 AgModeLop = 0; u16 AgModeLop = 0;
u16 AgModeHip = 0; u16 AgModeHip = 0;
do { do {
if ( pgaSwitch ) { if (pgaSwitch) {
/* PGA on */ /* PGA on */
/* fine gain */ /* fine gain */
CHK_ERROR(Read16(state, B_FE_AG_REG_AG_MODE_LOP__A, CHK_ERROR(Read16(state, B_FE_AG_REG_AG_MODE_LOP__A,
&AgModeLop, 0x0000)); &AgModeLop, 0x0000));
AgModeLop&=(~(B_FE_AG_REG_AG_MODE_LOP_MODE_C__M)); AgModeLop &= (~(B_FE_AG_REG_AG_MODE_LOP_MODE_C__M));
AgModeLop|= B_FE_AG_REG_AG_MODE_LOP_MODE_C_DYNAMIC; AgModeLop |= B_FE_AG_REG_AG_MODE_LOP_MODE_C_DYNAMIC;
CHK_ERROR(Write16(state, B_FE_AG_REG_AG_MODE_LOP__A, CHK_ERROR(Write16(state, B_FE_AG_REG_AG_MODE_LOP__A,
AgModeLop, 0x0000)); AgModeLop, 0x0000));
/* coarse gain */ /* coarse gain */
CHK_ERROR(Read16(state, B_FE_AG_REG_AG_MODE_HIP__A, CHK_ERROR(Read16(state, B_FE_AG_REG_AG_MODE_HIP__A,
&AgModeHip, 0x0000)); &AgModeHip, 0x0000));
AgModeHip&=(~(B_FE_AG_REG_AG_MODE_HIP_MODE_J__M)); AgModeHip &= (~(B_FE_AG_REG_AG_MODE_HIP_MODE_J__M));
AgModeHip|= B_FE_AG_REG_AG_MODE_HIP_MODE_J_DYNAMIC ; AgModeHip |= B_FE_AG_REG_AG_MODE_HIP_MODE_J_DYNAMIC;
CHK_ERROR(Write16(state, B_FE_AG_REG_AG_MODE_HIP__A, CHK_ERROR(Write16(state, B_FE_AG_REG_AG_MODE_HIP__A,
AgModeHip, 0x0000)); AgModeHip, 0x0000));
...@@ -1164,16 +1163,16 @@ static int SetCfgPga(struct drxd_state *state, int pgaSwitch) ...@@ -1164,16 +1163,16 @@ static int SetCfgPga(struct drxd_state *state, int pgaSwitch)
/* fine gain */ /* fine gain */
CHK_ERROR(Read16(state, B_FE_AG_REG_AG_MODE_LOP__A, CHK_ERROR(Read16(state, B_FE_AG_REG_AG_MODE_LOP__A,
&AgModeLop, 0x0000)); &AgModeLop, 0x0000));
AgModeLop&=(~(B_FE_AG_REG_AG_MODE_LOP_MODE_C__M)); AgModeLop &= (~(B_FE_AG_REG_AG_MODE_LOP_MODE_C__M));
AgModeLop|= B_FE_AG_REG_AG_MODE_LOP_MODE_C_STATIC ; AgModeLop |= B_FE_AG_REG_AG_MODE_LOP_MODE_C_STATIC;
CHK_ERROR(Write16(state, B_FE_AG_REG_AG_MODE_LOP__A, CHK_ERROR(Write16(state, B_FE_AG_REG_AG_MODE_LOP__A,
AgModeLop, 0x0000)); AgModeLop, 0x0000));
/* coarse gain */ /* coarse gain */
CHK_ERROR(Read16(state, B_FE_AG_REG_AG_MODE_HIP__A, CHK_ERROR(Read16(state, B_FE_AG_REG_AG_MODE_HIP__A,
&AgModeHip, 0x0000)); &AgModeHip, 0x0000));
AgModeHip&=(~(B_FE_AG_REG_AG_MODE_HIP_MODE_J__M)); AgModeHip &= (~(B_FE_AG_REG_AG_MODE_HIP_MODE_J__M));
AgModeHip|= B_FE_AG_REG_AG_MODE_HIP_MODE_J_STATIC ; AgModeHip |= B_FE_AG_REG_AG_MODE_HIP_MODE_J_STATIC;
CHK_ERROR(Write16(state, B_FE_AG_REG_AG_MODE_HIP__A, CHK_ERROR(Write16(state, B_FE_AG_REG_AG_MODE_HIP__A,
AgModeHip, 0x0000)); AgModeHip, 0x0000));
...@@ -1184,7 +1183,7 @@ static int SetCfgPga(struct drxd_state *state, int pgaSwitch) ...@@ -1184,7 +1183,7 @@ static int SetCfgPga(struct drxd_state *state, int pgaSwitch)
0x0000)); 0x0000));
} }
} }
while(0); while (0);
return status; return status;
} }
...@@ -1192,32 +1191,34 @@ static int InitFE(struct drxd_state *state) ...@@ -1192,32 +1191,34 @@ static int InitFE(struct drxd_state *state)
{ {
int status; int status;
do do {
{ CHK_ERROR(WriteTable(state, state->m_InitFE_1));
CHK_ERROR( WriteTable(state, state->m_InitFE_1));
if( state->type_A ) { if (state->type_A) {
status = Write16(state, FE_AG_REG_AG_PGA_MODE__A, status = Write16(state, FE_AG_REG_AG_PGA_MODE__A,
FE_AG_REG_AG_PGA_MODE_PFN_PCN_AFY_REN, 0); FE_AG_REG_AG_PGA_MODE_PFN_PCN_AFY_REN,
0);
} else { } else {
if (state->PGA) if (state->PGA)
status = SetCfgPga(state, 0); status = SetCfgPga(state, 0);
else else
status = status =
Write16(state, B_FE_AG_REG_AG_PGA_MODE__A, Write16(state, B_FE_AG_REG_AG_PGA_MODE__A,
B_FE_AG_REG_AG_PGA_MODE_PFN_PCN_AFY_REN, 0); B_FE_AG_REG_AG_PGA_MODE_PFN_PCN_AFY_REN,
0);
} }
if (status<0) break; if (status < 0)
CHK_ERROR( Write16( state, FE_AG_REG_AG_AGC_SIO__A, break;
CHK_ERROR(Write16(state, FE_AG_REG_AG_AGC_SIO__A,
state->m_FeAgRegAgAgcSio, 0x0000)); state->m_FeAgRegAgAgcSio, 0x0000));
CHK_ERROR( Write16( state, FE_AG_REG_AG_PWD__A,state->m_FeAgRegAgPwd, CHK_ERROR(Write16
(state, FE_AG_REG_AG_PWD__A, state->m_FeAgRegAgPwd,
0x0000)); 0x0000));
CHK_ERROR( WriteTable(state, state->m_InitFE_2)); CHK_ERROR(WriteTable(state, state->m_InitFE_2));
} while(0); } while (0);
return status; return status;
} }
...@@ -1228,7 +1229,7 @@ static int InitFT(struct drxd_state *state) ...@@ -1228,7 +1229,7 @@ static int InitFT(struct drxd_state *state)
norm OFFSET, MB says =2 voor 8K en =3 voor 2K waarschijnlijk norm OFFSET, MB says =2 voor 8K en =3 voor 2K waarschijnlijk
SC stuff SC stuff
*/ */
return Write16(state, FT_REG_COMM_EXEC__A, 0x0001, 0x0000 ); return Write16(state, FT_REG_COMM_EXEC__A, 0x0001, 0x0000);
} }
static int SC_WaitForReady(struct drxd_state *state) static int SC_WaitForReady(struct drxd_state *state)
...@@ -1236,10 +1237,9 @@ static int SC_WaitForReady(struct drxd_state *state) ...@@ -1236,10 +1237,9 @@ static int SC_WaitForReady(struct drxd_state *state)
u16 curCmd; u16 curCmd;
int i; int i;
for(i = 0; i < DRXD_MAX_RETRIES; i += 1 ) for (i = 0; i < DRXD_MAX_RETRIES; i += 1) {
{ int status = Read16(state, SC_RA_RAM_CMD__A, &curCmd, 0);
int status = Read16(state, SC_RA_RAM_CMD__A,&curCmd,0); if (status == 0 || curCmd == 0)
if (status==0 || curCmd == 0 )
return status; return status;
} }
return -1; return -1;
...@@ -1247,16 +1247,15 @@ static int SC_WaitForReady(struct drxd_state *state) ...@@ -1247,16 +1247,15 @@ static int SC_WaitForReady(struct drxd_state *state)
static int SC_SendCommand(struct drxd_state *state, u16 cmd) static int SC_SendCommand(struct drxd_state *state, u16 cmd)
{ {
int status=0; int status = 0;
u16 errCode; u16 errCode;
Write16(state, SC_RA_RAM_CMD__A,cmd,0); Write16(state, SC_RA_RAM_CMD__A, cmd, 0);
SC_WaitForReady(state); SC_WaitForReady(state);
Read16(state, SC_RA_RAM_CMD_ADDR__A,&errCode,0); Read16(state, SC_RA_RAM_CMD_ADDR__A, &errCode, 0);
if( errCode == 0xFFFF ) if (errCode == 0xFFFF) {
{
printk("Command Error\n"); printk("Command Error\n");
status = -1; status = -1;
} }
...@@ -1265,61 +1264,58 @@ static int SC_SendCommand(struct drxd_state *state, u16 cmd) ...@@ -1265,61 +1264,58 @@ static int SC_SendCommand(struct drxd_state *state, u16 cmd)
} }
static int SC_ProcStartCommand(struct drxd_state *state, static int SC_ProcStartCommand(struct drxd_state *state,
u16 subCmd,u16 param0,u16 param1) u16 subCmd, u16 param0, u16 param1)
{ {
int status=0; int status = 0;
u16 scExec; u16 scExec;
down(&state->mutex); down(&state->mutex);
do { do {
Read16(state, SC_COMM_EXEC__A, &scExec, 0); Read16(state, SC_COMM_EXEC__A, &scExec, 0);
if (scExec != 1) { if (scExec != 1) {
status=-1; status = -1;
break; break;
} }
SC_WaitForReady(state); SC_WaitForReady(state);
Write16(state, SC_RA_RAM_CMD_ADDR__A,subCmd,0); Write16(state, SC_RA_RAM_CMD_ADDR__A, subCmd, 0);
Write16(state, SC_RA_RAM_PARAM1__A,param1,0); Write16(state, SC_RA_RAM_PARAM1__A, param1, 0);
Write16(state, SC_RA_RAM_PARAM0__A,param0,0); Write16(state, SC_RA_RAM_PARAM0__A, param0, 0);
SC_SendCommand(state, SC_RA_RAM_CMD_PROC_START); SC_SendCommand(state, SC_RA_RAM_CMD_PROC_START);
} while(0); } while (0);
up(&state->mutex); up(&state->mutex);
return status; return status;
} }
static int SC_SetPrefParamCommand(struct drxd_state *state, static int SC_SetPrefParamCommand(struct drxd_state *state,
u16 subCmd,u16 param0,u16 param1) u16 subCmd, u16 param0, u16 param1)
{ {
int status; int status;
down(&state->mutex); down(&state->mutex);
do { do {
CHK_ERROR( SC_WaitForReady(state) ); CHK_ERROR(SC_WaitForReady(state));
CHK_ERROR( Write16(state,SC_RA_RAM_CMD_ADDR__A,subCmd,0) ); CHK_ERROR(Write16(state, SC_RA_RAM_CMD_ADDR__A, subCmd, 0));
CHK_ERROR( Write16(state,SC_RA_RAM_PARAM1__A,param1,0) ); CHK_ERROR(Write16(state, SC_RA_RAM_PARAM1__A, param1, 0));
CHK_ERROR( Write16(state,SC_RA_RAM_PARAM0__A,param0,0) ); CHK_ERROR(Write16(state, SC_RA_RAM_PARAM0__A, param0, 0));
CHK_ERROR( SC_SendCommand(state, CHK_ERROR(SC_SendCommand(state, SC_RA_RAM_CMD_SET_PREF_PARAM));
SC_RA_RAM_CMD_SET_PREF_PARAM) ); } while (0);
} while(0);
up(&state->mutex); up(&state->mutex);
return status; return status;
} }
#if 0 #if 0
static int SC_GetOpParamCommand(struct drxd_state *state, u16 *result) static int SC_GetOpParamCommand(struct drxd_state *state, u16 * result)
{ {
int status=0; int status = 0;
down(&state->mutex); down(&state->mutex);
do { do {
CHK_ERROR( SC_WaitForReady(state) ); CHK_ERROR(SC_WaitForReady(state));
CHK_ERROR( SC_SendCommand(state, CHK_ERROR(SC_SendCommand(state, SC_RA_RAM_CMD_GET_OP_PARAM));
SC_RA_RAM_CMD_GET_OP_PARAM) ); CHK_ERROR(Read16(state, SC_RA_RAM_PARAM0__A, result, 0));
CHK_ERROR( Read16(state, SC_RA_RAM_PARAM0__A,result, 0 ) ); } while (0);
} while(0);
up(&state->mutex); up(&state->mutex);
return status; return status;
} }
...@@ -1336,33 +1332,26 @@ static int ConfigureMPEGOutput(struct drxd_state *state, int bEnableOutput) ...@@ -1336,33 +1332,26 @@ static int ConfigureMPEGOutput(struct drxd_state *state, int bEnableOutput)
u16 EcOcRegOcMpgSio = 0; u16 EcOcRegOcMpgSio = 0;
/*CHK_ERROR(Read16(state, EC_OC_REG_OC_MODE_LOP__A, /*CHK_ERROR(Read16(state, EC_OC_REG_OC_MODE_LOP__A,
&EcOcRegOcModeLop, 0));*/ &EcOcRegOcModeLop, 0)); */
if( state->operation_mode == OM_DVBT_Diversity_Front ) if (state->operation_mode == OM_DVBT_Diversity_Front) {
{ if (bEnableOutput) {
if ( bEnableOutput )
{
EcOcRegOcModeHip |= EcOcRegOcModeHip |=
B_EC_OC_REG_OC_MODE_HIP_MPG_BUS_SRC_MONITOR; B_EC_OC_REG_OC_MODE_HIP_MPG_BUS_SRC_MONITOR;
} } else
else
EcOcRegOcMpgSio |= EC_OC_REG_OC_MPG_SIO__M; EcOcRegOcMpgSio |= EC_OC_REG_OC_MPG_SIO__M;
EcOcRegOcModeLop |= EcOcRegOcModeLop |=
EC_OC_REG_OC_MODE_LOP_PAR_ENA_DISABLE; EC_OC_REG_OC_MODE_LOP_PAR_ENA_DISABLE;
} } else {
else
{
EcOcRegOcModeLop = state->m_EcOcRegOcModeLop; EcOcRegOcModeLop = state->m_EcOcRegOcModeLop;
if (bEnableOutput) if (bEnableOutput)
EcOcRegOcMpgSio &= EcOcRegOcMpgSio &= (~(EC_OC_REG_OC_MPG_SIO__M));
(~(EC_OC_REG_OC_MPG_SIO__M));
else else
EcOcRegOcMpgSio |= EC_OC_REG_OC_MPG_SIO__M; EcOcRegOcMpgSio |= EC_OC_REG_OC_MPG_SIO__M;
/* Don't Insert RS Byte */ /* Don't Insert RS Byte */
if( state->insert_rs_byte ) if (state->insert_rs_byte) {
{
EcOcRegOcModeLop &= EcOcRegOcModeLop &=
(~(EC_OC_REG_OC_MODE_LOP_PAR_ENA__M)); (~(EC_OC_REG_OC_MODE_LOP_PAR_ENA__M));
EcOcRegOcModeHip &= EcOcRegOcModeHip &=
...@@ -1379,7 +1368,7 @@ static int ConfigureMPEGOutput(struct drxd_state *state, int bEnableOutput) ...@@ -1379,7 +1368,7 @@ static int ConfigureMPEGOutput(struct drxd_state *state, int bEnableOutput)
} }
/* Mode = Parallel */ /* Mode = Parallel */
if( state->enable_parallel ) if (state->enable_parallel)
EcOcRegOcModeLop &= EcOcRegOcModeLop &=
(~(EC_OC_REG_OC_MODE_LOP_MPG_TRM_MDE__M)); (~(EC_OC_REG_OC_MODE_LOP_MPG_TRM_MDE__M));
else else
...@@ -1407,28 +1396,28 @@ static int ConfigureMPEGOutput(struct drxd_state *state, int bEnableOutput) ...@@ -1407,28 +1396,28 @@ static int ConfigureMPEGOutput(struct drxd_state *state, int bEnableOutput)
EcOcRegIprInvMpg &= (~(0x0800)); EcOcRegIprInvMpg &= (~(0x0800));
/* EcOcRegOcModeLop =0x05; */ /* EcOcRegOcModeLop =0x05; */
CHK_ERROR( Write16(state, EC_OC_REG_IPR_INV_MPG__A, CHK_ERROR(Write16(state, EC_OC_REG_IPR_INV_MPG__A,
EcOcRegIprInvMpg, 0)); EcOcRegIprInvMpg, 0));
CHK_ERROR( Write16(state, EC_OC_REG_OC_MODE_LOP__A, CHK_ERROR(Write16(state, EC_OC_REG_OC_MODE_LOP__A,
EcOcRegOcModeLop, 0) ); EcOcRegOcModeLop, 0));
CHK_ERROR( Write16(state, EC_OC_REG_OC_MODE_HIP__A, CHK_ERROR(Write16(state, EC_OC_REG_OC_MODE_HIP__A,
EcOcRegOcModeHip, 0x0000 ) ); EcOcRegOcModeHip, 0x0000));
CHK_ERROR( Write16(state, EC_OC_REG_OC_MPG_SIO__A, CHK_ERROR(Write16(state, EC_OC_REG_OC_MPG_SIO__A,
EcOcRegOcMpgSio, 0) ); EcOcRegOcMpgSio, 0));
} while(0); } while (0);
return status; return status;
} }
static int SetDeviceTypeId(struct drxd_state *state) static int SetDeviceTypeId(struct drxd_state *state)
{ {
int status = 0; int status = 0;
u16 deviceId = 0 ; u16 deviceId = 0;
do { do {
CHK_ERROR(Read16(state, CC_REG_JTAGID_L__A, &deviceId, 0)); CHK_ERROR(Read16(state, CC_REG_JTAGID_L__A, &deviceId, 0));
/* TODO: why twice? */ /* TODO: why twice? */
CHK_ERROR(Read16(state, CC_REG_JTAGID_L__A, &deviceId, 0)); CHK_ERROR(Read16(state, CC_REG_JTAGID_L__A, &deviceId, 0));
printk( "drxd: deviceId = %04x\n",deviceId); printk("drxd: deviceId = %04x\n", deviceId);
state->type_A = 0; state->type_A = 0;
state->PGA = 0; state->PGA = 0;
...@@ -1438,8 +1427,8 @@ static int SetDeviceTypeId(struct drxd_state *state) ...@@ -1438,8 +1427,8 @@ static int SetDeviceTypeId(struct drxd_state *state)
printk("DRX3975D-A2\n"); printk("DRX3975D-A2\n");
} else { } else {
deviceId >>= 12; deviceId >>= 12;
printk("DRX397%dD-B1\n",deviceId); printk("DRX397%dD-B1\n", deviceId);
switch(deviceId) { switch (deviceId) {
case 4: case 4:
state->diversity = 1; state->diversity = 1;
case 3: case 3:
...@@ -1456,9 +1445,9 @@ static int SetDeviceTypeId(struct drxd_state *state) ...@@ -1456,9 +1445,9 @@ static int SetDeviceTypeId(struct drxd_state *state)
break; break;
} }
} }
} while(0); } while (0);
if (status<0) if (status < 0)
return status; return status;
/* Init Table selection */ /* Init Table selection */
...@@ -1512,9 +1501,9 @@ static int CorrectSysClockDeviation(struct drxd_state *state) ...@@ -1512,9 +1501,9 @@ static int CorrectSysClockDeviation(struct drxd_state *state)
int status; int status;
s32 incr = 0; s32 incr = 0;
s32 nomincr = 0; s32 nomincr = 0;
u32 bandwidth=0; u32 bandwidth = 0;
u32 sysClockInHz=0; u32 sysClockInHz = 0;
u32 sysClockFreq=0; /* in kHz */ u32 sysClockFreq = 0; /* in kHz */
s16 oscClockDeviation; s16 oscClockDeviation;
s16 Diff; s16 Diff;
...@@ -1523,79 +1512,75 @@ static int CorrectSysClockDeviation(struct drxd_state *state) ...@@ -1523,79 +1512,75 @@ static int CorrectSysClockDeviation(struct drxd_state *state)
/* These accesses should be AtomicReadReg32, but that /* These accesses should be AtomicReadReg32, but that
causes trouble (at least for diversity */ causes trouble (at least for diversity */
CHK_ERROR( Read32(state, LC_RA_RAM_IFINCR_NOM_L__A, CHK_ERROR(Read32(state, LC_RA_RAM_IFINCR_NOM_L__A,
((u32 *)&nomincr),0 )); ((u32 *) & nomincr), 0));
CHK_ERROR( Read32(state, FE_IF_REG_INCR0__A, CHK_ERROR(Read32(state, FE_IF_REG_INCR0__A, (u32 *) & incr, 0));
(u32 *) &incr,0 ));
if (state->type_A) {
if( state->type_A ) { if ((nomincr - incr < -500) || (nomincr - incr > 500))
if( (nomincr - incr < -500) ||
(nomincr - incr > 500 ) )
break; break;
} else { } else {
if( (nomincr - incr < -2000 ) || if ((nomincr - incr < -2000) || (nomincr - incr > 2000))
(nomincr - incr > 2000 ) )
break; break;
} }
switch( state->param.u.ofdm.bandwidth ) switch (state->param.u.ofdm.bandwidth) {
{ case BANDWIDTH_8_MHZ:
case BANDWIDTH_8_MHZ :
bandwidth = DRXD_BANDWIDTH_8MHZ_IN_HZ; bandwidth = DRXD_BANDWIDTH_8MHZ_IN_HZ;
break; break;
case BANDWIDTH_7_MHZ : case BANDWIDTH_7_MHZ:
bandwidth = DRXD_BANDWIDTH_7MHZ_IN_HZ; bandwidth = DRXD_BANDWIDTH_7MHZ_IN_HZ;
break; break;
case BANDWIDTH_6_MHZ : case BANDWIDTH_6_MHZ:
bandwidth = DRXD_BANDWIDTH_6MHZ_IN_HZ; bandwidth = DRXD_BANDWIDTH_6MHZ_IN_HZ;
break; break;
default : default:
return -1; return -1;
break; break;
} }
/* Compute new sysclock value /* Compute new sysclock value
sysClockFreq = (((incr + 2^23)*bandwidth)/2^21)/1000 */ sysClockFreq = (((incr + 2^23)*bandwidth)/2^21)/1000 */
incr += (1<<23); incr += (1 << 23);
sysClockInHz = MulDiv32(incr,bandwidth,1<<21); sysClockInHz = MulDiv32(incr, bandwidth, 1 << 21);
sysClockFreq= (u32)(sysClockInHz/1000); sysClockFreq = (u32) (sysClockInHz / 1000);
/* rounding */ /* rounding */
if ( ( sysClockInHz%1000 ) > 500 ) if ((sysClockInHz % 1000) > 500) {
{
sysClockFreq++; sysClockFreq++;
} }
/* Compute clock deviation in ppm */ /* Compute clock deviation in ppm */
oscClockDeviation = (u16) ( oscClockDeviation = (u16) ((((s32) (sysClockFreq) -
(((s32)(sysClockFreq) - (s32)
(s32)(state->expected_sys_clock_freq))* (state->expected_sys_clock_freq)) *
1000000L)/(s32)(state->expected_sys_clock_freq) ); 1000000L) /
(s32)
(state->expected_sys_clock_freq));
Diff = oscClockDeviation - state->osc_clock_deviation; Diff = oscClockDeviation - state->osc_clock_deviation;
/*printk("sysclockdiff=%d\n", Diff);*/ /*printk("sysclockdiff=%d\n", Diff); */
if( Diff >= -200 && Diff <= 200 ) { if (Diff >= -200 && Diff <= 200) {
state->sys_clock_freq = (u16) sysClockFreq; state->sys_clock_freq = (u16) sysClockFreq;
if( oscClockDeviation != if (oscClockDeviation != state->osc_clock_deviation) {
state->osc_clock_deviation ) {
if (state->config.osc_deviation) { if (state->config.osc_deviation) {
state->config.osc_deviation( state->config.osc_deviation(state->priv,
state->priv, oscClockDeviation,
oscClockDeviation, 1); 1);
state->osc_clock_deviation= state->osc_clock_deviation =
oscClockDeviation; oscClockDeviation;
} }
} }
/* switch OFF SRMM scan in SC */ /* switch OFF SRMM scan in SC */
CHK_ERROR( Write16( state, CHK_ERROR(Write16(state,
SC_RA_RAM_SAMPLE_RATE_COUNT__A, SC_RA_RAM_SAMPLE_RATE_COUNT__A,
DRXD_OSCDEV_DONT_SCAN,0)); DRXD_OSCDEV_DONT_SCAN, 0));
/* overrule FE_IF internal value for /* overrule FE_IF internal value for
proper re-locking */ proper re-locking */
CHK_ERROR( Write16( state, SC_RA_RAM_IF_SAVE__AX, CHK_ERROR(Write16(state, SC_RA_RAM_IF_SAVE__AX,
state->current_fe_if_incr, 0)); state->current_fe_if_incr, 0));
state->cscd_state = CSCD_SAVED; state->cscd_state = CSCD_SAVED;
} }
} while(0); } while (0);
return (status); return (status);
} }
...@@ -1604,60 +1589,58 @@ static int DRX_Stop(struct drxd_state *state) ...@@ -1604,60 +1589,58 @@ static int DRX_Stop(struct drxd_state *state)
{ {
int status; int status;
if( state->drxd_state != DRXD_STARTED ) if (state->drxd_state != DRXD_STARTED)
return 0; return 0;
do { do {
if (state->cscd_state != CSCD_SAVED ) { if (state->cscd_state != CSCD_SAVED) {
u32 lock; u32 lock;
CHK_ERROR( DRX_GetLockStatus(state, &lock)); CHK_ERROR(DRX_GetLockStatus(state, &lock));
} }
CHK_ERROR(StopOC(state)); CHK_ERROR(StopOC(state));
state->drxd_state = DRXD_STOPPED; state->drxd_state = DRXD_STOPPED;
CHK_ERROR( ConfigureMPEGOutput(state, 0) ); CHK_ERROR(ConfigureMPEGOutput(state, 0));
if(state->type_A ) { if (state->type_A) {
/* Stop relevant processors off the device */ /* Stop relevant processors off the device */
CHK_ERROR( Write16(state, EC_OD_REG_COMM_EXEC__A, CHK_ERROR(Write16(state, EC_OD_REG_COMM_EXEC__A,
0x0000, 0x0000)); 0x0000, 0x0000));
CHK_ERROR( Write16(state, SC_COMM_EXEC__A, CHK_ERROR(Write16(state, SC_COMM_EXEC__A,
SC_COMM_EXEC_CTL_STOP, 0 )); SC_COMM_EXEC_CTL_STOP, 0));
CHK_ERROR( Write16(state, LC_COMM_EXEC__A, CHK_ERROR(Write16(state, LC_COMM_EXEC__A,
SC_COMM_EXEC_CTL_STOP, 0 )); SC_COMM_EXEC_CTL_STOP, 0));
} else { } else {
/* Stop all processors except HI & CC & FE */ /* Stop all processors except HI & CC & FE */
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
B_SC_COMM_EXEC__A, B_SC_COMM_EXEC__A,
SC_COMM_EXEC_CTL_STOP, 0 )); SC_COMM_EXEC_CTL_STOP, 0));
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
B_LC_COMM_EXEC__A, B_LC_COMM_EXEC__A,
SC_COMM_EXEC_CTL_STOP, 0 )); SC_COMM_EXEC_CTL_STOP, 0));
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
B_FT_COMM_EXEC__A, B_FT_COMM_EXEC__A,
SC_COMM_EXEC_CTL_STOP, 0 )); SC_COMM_EXEC_CTL_STOP, 0));
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
B_CP_COMM_EXEC__A, B_CP_COMM_EXEC__A,
SC_COMM_EXEC_CTL_STOP, 0 )); SC_COMM_EXEC_CTL_STOP, 0));
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
B_CE_COMM_EXEC__A, B_CE_COMM_EXEC__A,
SC_COMM_EXEC_CTL_STOP, 0 )); SC_COMM_EXEC_CTL_STOP, 0));
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
B_EQ_COMM_EXEC__A, B_EQ_COMM_EXEC__A,
SC_COMM_EXEC_CTL_STOP, 0 )); SC_COMM_EXEC_CTL_STOP, 0));
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
EC_OD_REG_COMM_EXEC__A, EC_OD_REG_COMM_EXEC__A, 0x0000, 0));
0x0000, 0 ));
} }
} while(0); } while (0);
return status; return status;
} }
int SetOperationMode(struct drxd_state *state, int oMode) int SetOperationMode(struct drxd_state *state, int oMode)
{ {
int status; int status;
...@@ -1678,15 +1661,12 @@ int SetOperationMode(struct drxd_state *state, int oMode) ...@@ -1678,15 +1661,12 @@ int SetOperationMode(struct drxd_state *state, int oMode)
break; break;
} }
switch(oMode) switch (oMode) {
{
case OM_DVBT_Diversity_Front: case OM_DVBT_Diversity_Front:
status = WriteTable(state, status = WriteTable(state, state->m_InitDiversityFront);
state->m_InitDiversityFront);
break; break;
case OM_DVBT_Diversity_End: case OM_DVBT_Diversity_End:
status = WriteTable(state, status = WriteTable(state, state->m_InitDiversityEnd);
state->m_InitDiversityEnd);
break; break;
case OM_Default: case OM_Default:
/* We need to check how to /* We need to check how to
...@@ -1695,43 +1675,38 @@ int SetOperationMode(struct drxd_state *state, int oMode) ...@@ -1695,43 +1675,38 @@ int SetOperationMode(struct drxd_state *state, int oMode)
status = WriteTable(state, state->m_DisableDiversity); status = WriteTable(state, state->m_DisableDiversity);
break; break;
} }
} while(0); } while (0);
if (!status) if (!status)
state->operation_mode = oMode; state->operation_mode = oMode;
return status; return status;
} }
static int StartDiversity(struct drxd_state *state) static int StartDiversity(struct drxd_state *state)
{ {
int status=0; int status = 0;
u16 rcControl; u16 rcControl;
do { do {
if (state->operation_mode == OM_DVBT_Diversity_Front) { if (state->operation_mode == OM_DVBT_Diversity_Front) {
CHK_ERROR(WriteTable(state, CHK_ERROR(WriteTable(state,
state->m_StartDiversityFront)); state->m_StartDiversityFront));
} else if( state->operation_mode == OM_DVBT_Diversity_End ) { } else if (state->operation_mode == OM_DVBT_Diversity_End) {
CHK_ERROR(WriteTable(state, CHK_ERROR(WriteTable(state,
state->m_StartDiversityEnd)); state->m_StartDiversityEnd));
if( state->param.u.ofdm.bandwidth == if (state->param.u.ofdm.bandwidth == BANDWIDTH_8_MHZ) {
BANDWIDTH_8_MHZ ) { CHK_ERROR(WriteTable(state,
CHK_ERROR(
WriteTable(state,
state-> state->
m_DiversityDelay8MHZ)); m_DiversityDelay8MHZ));
} else { } else {
CHK_ERROR( CHK_ERROR(WriteTable(state,
WriteTable(state,
state-> state->
m_DiversityDelay6MHZ)); m_DiversityDelay6MHZ));
} }
CHK_ERROR(Read16(state, CHK_ERROR(Read16(state,
B_EQ_REG_RC_SEL_CAR__A, B_EQ_REG_RC_SEL_CAR__A,
&rcControl,0)); &rcControl, 0));
rcControl &= ~(B_EQ_REG_RC_SEL_CAR_FFTMODE__M); rcControl &= ~(B_EQ_REG_RC_SEL_CAR_FFTMODE__M);
rcControl |= B_EQ_REG_RC_SEL_CAR_DIV_ON | rcControl |= B_EQ_REG_RC_SEL_CAR_DIV_ON |
/* combining enabled */ /* combining enabled */
...@@ -1740,13 +1715,12 @@ static int StartDiversity(struct drxd_state *state) ...@@ -1740,13 +1715,12 @@ static int StartDiversity(struct drxd_state *state)
B_EQ_REG_RC_SEL_CAR_LOCAL_A_CC; B_EQ_REG_RC_SEL_CAR_LOCAL_A_CC;
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
B_EQ_REG_RC_SEL_CAR__A, B_EQ_REG_RC_SEL_CAR__A,
rcControl,0)); rcControl, 0));
} }
} while(0); } while (0);
return status; return status;
} }
static int SetFrequencyShift(struct drxd_state *state, static int SetFrequencyShift(struct drxd_state *state,
u32 offsetFreq, int channelMirrored) u32 offsetFreq, int channelMirrored)
{ {
...@@ -1763,60 +1737,55 @@ static int SetFrequencyShift(struct drxd_state *state, ...@@ -1763,60 +1737,55 @@ static int SetFrequencyShift(struct drxd_state *state,
*/ */
/* Compute register value, unsigned computation */ /* Compute register value, unsigned computation */
state->fe_fs_add_incr = MulDiv32( state->intermediate_freq + state->fe_fs_add_incr = MulDiv32(state->intermediate_freq +
offsetFreq, offsetFreq,
1<<28, state->sys_clock_freq); 1 << 28, state->sys_clock_freq);
/* Remove integer part */ /* Remove integer part */
state->fe_fs_add_incr &= 0x0FFFFFFFL; state->fe_fs_add_incr &= 0x0FFFFFFFL;
if (negativeShift) if (negativeShift) {
{ state->fe_fs_add_incr = ((1 << 28) - state->fe_fs_add_incr);
state->fe_fs_add_incr = ((1<<28) - state->fe_fs_add_incr);
} }
/* Save the frequency shift without tunerOffset compensation /* Save the frequency shift without tunerOffset compensation
for CtrlGetChannel. */ for CtrlGetChannel. */
state->org_fe_fs_add_incr = MulDiv32( state->intermediate_freq, state->org_fe_fs_add_incr = MulDiv32(state->intermediate_freq,
1<<28, state->sys_clock_freq); 1 << 28, state->sys_clock_freq);
/* Remove integer part */ /* Remove integer part */
state->org_fe_fs_add_incr &= 0x0FFFFFFFL; state->org_fe_fs_add_incr &= 0x0FFFFFFFL;
if (negativeShift) if (negativeShift)
state->org_fe_fs_add_incr = ((1L<<28) - state->org_fe_fs_add_incr = ((1L << 28) -
state->org_fe_fs_add_incr); state->org_fe_fs_add_incr);
return Write32(state, FE_FS_REG_ADD_INC_LOP__A, return Write32(state, FE_FS_REG_ADD_INC_LOP__A,
state->fe_fs_add_incr, 0); state->fe_fs_add_incr, 0);
} }
static int SetCfgNoiseCalibration (struct drxd_state *state, static int SetCfgNoiseCalibration(struct drxd_state *state,
struct SNoiseCal* noiseCal ) struct SNoiseCal *noiseCal)
{ {
u16 beOptEna; u16 beOptEna;
int status=0; int status = 0;
do { do {
CHK_ERROR(Read16(state, SC_RA_RAM_BE_OPT_ENA__A, CHK_ERROR(Read16(state, SC_RA_RAM_BE_OPT_ENA__A, &beOptEna, 0));
&beOptEna, 0)); if (noiseCal->cpOpt) {
if (noiseCal->cpOpt)
{
beOptEna |= (1 << SC_RA_RAM_BE_OPT_ENA_CP_OPT); beOptEna |= (1 << SC_RA_RAM_BE_OPT_ENA_CP_OPT);
} else { } else {
beOptEna &= ~(1 << SC_RA_RAM_BE_OPT_ENA_CP_OPT); beOptEna &= ~(1 << SC_RA_RAM_BE_OPT_ENA_CP_OPT);
CHK_ERROR(Write16(state, CP_REG_AC_NEXP_OFFS__A, CHK_ERROR(Write16(state, CP_REG_AC_NEXP_OFFS__A,
noiseCal->cpNexpOfs, 0)); noiseCal->cpNexpOfs, 0));
} }
CHK_ERROR(Write16(state, SC_RA_RAM_BE_OPT_ENA__A, CHK_ERROR(Write16(state, SC_RA_RAM_BE_OPT_ENA__A, beOptEna, 0));
beOptEna, 0));
if( !state->type_A ) if (!state->type_A) {
{ CHK_ERROR(Write16(state,
CHK_ERROR(Write16( state,
B_SC_RA_RAM_CO_TD_CAL_2K__A, B_SC_RA_RAM_CO_TD_CAL_2K__A,
noiseCal->tdCal2k,0)); noiseCal->tdCal2k, 0));
CHK_ERROR(Write16( state, CHK_ERROR(Write16(state,
B_SC_RA_RAM_CO_TD_CAL_8K__A, B_SC_RA_RAM_CO_TD_CAL_8K__A,
noiseCal->tdCal8k,0)); noiseCal->tdCal8k, 0));
} }
} while(0); } while (0);
return status; return status;
} }
...@@ -1846,55 +1815,55 @@ static int DRX_Start(struct drxd_state *state, s32 off) ...@@ -1846,55 +1815,55 @@ static int DRX_Start(struct drxd_state *state, s32 off)
u16 qam64IsGainExp = 0; u16 qam64IsGainExp = 0;
u16 bandwidthParam = 0; u16 bandwidthParam = 0;
if (off<0) if (off < 0)
off=(off-500)/1000; off = (off - 500) / 1000;
else else
off=(off+500)/1000; off = (off + 500) / 1000;
do { do {
if (state->drxd_state != DRXD_STOPPED) if (state->drxd_state != DRXD_STOPPED)
return -1; return -1;
CHK_ERROR( ResetECOD(state) ); CHK_ERROR(ResetECOD(state));
if (state->type_A) { if (state->type_A) {
CHK_ERROR( InitSC(state) ); CHK_ERROR(InitSC(state));
} else { } else {
CHK_ERROR( InitFT(state) ); CHK_ERROR(InitFT(state));
CHK_ERROR( InitCP(state) ); CHK_ERROR(InitCP(state));
CHK_ERROR( InitCE(state) ); CHK_ERROR(InitCE(state));
CHK_ERROR( InitEQ(state) ); CHK_ERROR(InitEQ(state));
CHK_ERROR( InitSC(state) ); CHK_ERROR(InitSC(state));
} }
/* Restore current IF & RF AGC settings */ /* Restore current IF & RF AGC settings */
CHK_ERROR(SetCfgIfAgc(state, &state->if_agc_cfg )); CHK_ERROR(SetCfgIfAgc(state, &state->if_agc_cfg));
CHK_ERROR(SetCfgRfAgc(state, &state->rf_agc_cfg )); CHK_ERROR(SetCfgRfAgc(state, &state->rf_agc_cfg));
mirrorFreqSpect=( state->param.inversion==INVERSION_ON); mirrorFreqSpect = (state->param.inversion == INVERSION_ON);
switch (p->transmission_mode) { switch (p->transmission_mode) {
default: /* Not set, detect it automatically */ default: /* Not set, detect it automatically */
operationMode |= SC_RA_RAM_OP_AUTO_MODE__M; operationMode |= 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 |= SC_RA_RAM_OP_PARAM_MODE_8K; transmissionParams |= SC_RA_RAM_OP_PARAM_MODE_8K;
if (state->type_A) { if (state->type_A) {
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
EC_SB_REG_TR_MODE__A, EC_SB_REG_TR_MODE__A,
EC_SB_REG_TR_MODE_8K, EC_SB_REG_TR_MODE_8K,
0x0000 )); 0x0000));
qpskSnCeGain = 99; qpskSnCeGain = 99;
qam16SnCeGain = 83; qam16SnCeGain = 83;
qam64SnCeGain = 67; qam64SnCeGain = 67;
} }
break; break;
case TRANSMISSION_MODE_2K : case TRANSMISSION_MODE_2K:
transmissionParams |= SC_RA_RAM_OP_PARAM_MODE_2K; transmissionParams |= SC_RA_RAM_OP_PARAM_MODE_2K;
if (state->type_A) { if (state->type_A) {
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
EC_SB_REG_TR_MODE__A, EC_SB_REG_TR_MODE__A,
EC_SB_REG_TR_MODE_2K, EC_SB_REG_TR_MODE_2K,
0x0000 )); 0x0000));
qpskSnCeGain = 97; qpskSnCeGain = 97;
qam16SnCeGain = 71; qam16SnCeGain = 71;
qam64SnCeGain = 65; qam64SnCeGain = 65;
...@@ -1902,8 +1871,7 @@ static int DRX_Start(struct drxd_state *state, s32 off) ...@@ -1902,8 +1871,7 @@ static int DRX_Start(struct drxd_state *state, s32 off)
break; break;
} }
switch( p->guard_interval ) switch (p->guard_interval) {
{
case GUARD_INTERVAL_1_4: case GUARD_INTERVAL_1_4:
transmissionParams |= SC_RA_RAM_OP_PARAM_GUARD_4; transmissionParams |= SC_RA_RAM_OP_PARAM_GUARD_4;
break; break;
...@@ -1923,15 +1891,14 @@ static int DRX_Start(struct drxd_state *state, s32 off) ...@@ -1923,15 +1891,14 @@ static int DRX_Start(struct drxd_state *state, s32 off)
break; break;
} }
switch( p->hierarchy_information ) switch (p->hierarchy_information) {
{
case HIERARCHY_1: case HIERARCHY_1:
transmissionParams |= SC_RA_RAM_OP_PARAM_HIER_A1; transmissionParams |= SC_RA_RAM_OP_PARAM_HIER_A1;
if (state->type_A) { if (state->type_A) {
CHK_ERROR( Write16(state, EQ_REG_OT_ALPHA__A, CHK_ERROR(Write16(state, EQ_REG_OT_ALPHA__A,
0x0001, 0x0000 ) ); 0x0001, 0x0000));
CHK_ERROR( Write16(state, EC_SB_REG_ALPHA__A, CHK_ERROR(Write16(state, EC_SB_REG_ALPHA__A,
0x0001, 0x0000 ) ); 0x0001, 0x0000));
qpskTdTpsPwr = EQ_TD_TPS_PWR_UNKNOWN; qpskTdTpsPwr = EQ_TD_TPS_PWR_UNKNOWN;
qam16TdTpsPwr = EQ_TD_TPS_PWR_QAM16_ALPHA1; qam16TdTpsPwr = EQ_TD_TPS_PWR_QAM16_ALPHA1;
...@@ -1956,10 +1923,10 @@ static int DRX_Start(struct drxd_state *state, s32 off) ...@@ -1956,10 +1923,10 @@ static int DRX_Start(struct drxd_state *state, s32 off)
case HIERARCHY_2: case HIERARCHY_2:
transmissionParams |= SC_RA_RAM_OP_PARAM_HIER_A2; transmissionParams |= SC_RA_RAM_OP_PARAM_HIER_A2;
if (state->type_A) { if (state->type_A) {
CHK_ERROR( Write16(state, EQ_REG_OT_ALPHA__A, CHK_ERROR(Write16(state, EQ_REG_OT_ALPHA__A,
0x0002, 0x0000 ) ); 0x0002, 0x0000));
CHK_ERROR( Write16(state, EC_SB_REG_ALPHA__A, CHK_ERROR(Write16(state, EC_SB_REG_ALPHA__A,
0x0002, 0x0000 ) ); 0x0002, 0x0000));
qpskTdTpsPwr = EQ_TD_TPS_PWR_UNKNOWN; qpskTdTpsPwr = EQ_TD_TPS_PWR_UNKNOWN;
qam16TdTpsPwr = EQ_TD_TPS_PWR_QAM16_ALPHA2; qam16TdTpsPwr = EQ_TD_TPS_PWR_QAM16_ALPHA2;
...@@ -1983,10 +1950,10 @@ static int DRX_Start(struct drxd_state *state, s32 off) ...@@ -1983,10 +1950,10 @@ static int DRX_Start(struct drxd_state *state, s32 off)
case HIERARCHY_4: case HIERARCHY_4:
transmissionParams |= SC_RA_RAM_OP_PARAM_HIER_A4; transmissionParams |= SC_RA_RAM_OP_PARAM_HIER_A4;
if (state->type_A) { if (state->type_A) {
CHK_ERROR( Write16(state, EQ_REG_OT_ALPHA__A, CHK_ERROR(Write16(state, EQ_REG_OT_ALPHA__A,
0x0003, 0x0000 )); 0x0003, 0x0000));
CHK_ERROR( Write16(state, EC_SB_REG_ALPHA__A, CHK_ERROR(Write16(state, EC_SB_REG_ALPHA__A,
0x0003, 0x0000 ) ); 0x0003, 0x0000));
qpskTdTpsPwr = EQ_TD_TPS_PWR_UNKNOWN; qpskTdTpsPwr = EQ_TD_TPS_PWR_UNKNOWN;
qam16TdTpsPwr = EQ_TD_TPS_PWR_QAM16_ALPHA4; qam16TdTpsPwr = EQ_TD_TPS_PWR_QAM16_ALPHA4;
...@@ -2013,10 +1980,10 @@ static int DRX_Start(struct drxd_state *state, s32 off) ...@@ -2013,10 +1980,10 @@ static int DRX_Start(struct drxd_state *state, s32 off)
operationMode |= SC_RA_RAM_OP_AUTO_HIER__M; operationMode |= SC_RA_RAM_OP_AUTO_HIER__M;
transmissionParams |= SC_RA_RAM_OP_PARAM_HIER_NO; transmissionParams |= SC_RA_RAM_OP_PARAM_HIER_NO;
if (state->type_A) { if (state->type_A) {
CHK_ERROR( Write16(state, EQ_REG_OT_ALPHA__A, CHK_ERROR(Write16(state, EQ_REG_OT_ALPHA__A,
0x0000, 0x0000 ) ); 0x0000, 0x0000));
CHK_ERROR( Write16(state, EC_SB_REG_ALPHA__A, CHK_ERROR(Write16(state, EC_SB_REG_ALPHA__A,
0x0000, 0x0000 ) ); 0x0000, 0x0000));
qpskTdTpsPwr = EQ_TD_TPS_PWR_QPSK; qpskTdTpsPwr = EQ_TD_TPS_PWR_QPSK;
qam16TdTpsPwr = EQ_TD_TPS_PWR_QAM16_ALPHAN; qam16TdTpsPwr = EQ_TD_TPS_PWR_QAM16_ALPHAN;
...@@ -2038,9 +2005,9 @@ static int DRX_Start(struct drxd_state *state, s32 off) ...@@ -2038,9 +2005,9 @@ static int DRX_Start(struct drxd_state *state, s32 off)
} }
break; break;
} }
CHK_ERROR( status ); CHK_ERROR(status);
switch( p->constellation ) { switch (p->constellation) {
default: default:
operationMode |= SC_RA_RAM_OP_AUTO_CONST__M; operationMode |= SC_RA_RAM_OP_AUTO_CONST__M;
/* fall through , try first guess /* fall through , try first guess
...@@ -2049,60 +2016,60 @@ static int DRX_Start(struct drxd_state *state, s32 off) ...@@ -2049,60 +2016,60 @@ static int DRX_Start(struct drxd_state *state, s32 off)
transmissionParams |= SC_RA_RAM_OP_PARAM_CONST_QAM64; transmissionParams |= SC_RA_RAM_OP_PARAM_CONST_QAM64;
if (state->type_A) { if (state->type_A) {
CHK_ERROR(Write16(state, EQ_REG_OT_CONST__A, CHK_ERROR(Write16(state, EQ_REG_OT_CONST__A,
0x0002, 0x0000 ) ); 0x0002, 0x0000));
CHK_ERROR(Write16(state, EC_SB_REG_CONST__A, CHK_ERROR(Write16(state, EC_SB_REG_CONST__A,
EC_SB_REG_CONST_64QAM, EC_SB_REG_CONST_64QAM,
0x0000) ); 0x0000));
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
EC_SB_REG_SCALE_MSB__A, EC_SB_REG_SCALE_MSB__A,
0x0020, 0x0000 ) ); 0x0020, 0x0000));
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
EC_SB_REG_SCALE_BIT2__A, EC_SB_REG_SCALE_BIT2__A,
0x0008, 0x0000 ) ); 0x0008, 0x0000));
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
EC_SB_REG_SCALE_LSB__A, EC_SB_REG_SCALE_LSB__A,
0x0002, 0x0000 ) ); 0x0002, 0x0000));
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
EQ_REG_TD_TPS_PWR_OFS__A, EQ_REG_TD_TPS_PWR_OFS__A,
qam64TdTpsPwr, 0x0000 ) ); qam64TdTpsPwr, 0x0000));
CHK_ERROR( Write16(state,EQ_REG_SN_CEGAIN__A, CHK_ERROR(Write16(state, EQ_REG_SN_CEGAIN__A,
qam64SnCeGain, 0x0000 )); qam64SnCeGain, 0x0000));
CHK_ERROR( Write16(state,EQ_REG_IS_GAIN_MAN__A, CHK_ERROR(Write16(state, EQ_REG_IS_GAIN_MAN__A,
qam64IsGainMan, 0x0000 )); qam64IsGainMan, 0x0000));
CHK_ERROR( Write16(state,EQ_REG_IS_GAIN_EXP__A, CHK_ERROR(Write16(state, EQ_REG_IS_GAIN_EXP__A,
qam64IsGainExp, 0x0000 )); qam64IsGainExp, 0x0000));
} }
break; break;
case QPSK : case QPSK:
transmissionParams |= SC_RA_RAM_OP_PARAM_CONST_QPSK; transmissionParams |= SC_RA_RAM_OP_PARAM_CONST_QPSK;
if (state->type_A) { if (state->type_A) {
CHK_ERROR(Write16(state, EQ_REG_OT_CONST__A, CHK_ERROR(Write16(state, EQ_REG_OT_CONST__A,
0x0000, 0x0000 ) ); 0x0000, 0x0000));
CHK_ERROR(Write16(state, EC_SB_REG_CONST__A, CHK_ERROR(Write16(state, EC_SB_REG_CONST__A,
EC_SB_REG_CONST_QPSK, EC_SB_REG_CONST_QPSK,
0x0000) ); 0x0000));
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
EC_SB_REG_SCALE_MSB__A, EC_SB_REG_SCALE_MSB__A,
0x0010, 0x0000 ) ); 0x0010, 0x0000));
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
EC_SB_REG_SCALE_BIT2__A, EC_SB_REG_SCALE_BIT2__A,
0x0000, 0x0000 ) ); 0x0000, 0x0000));
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
EC_SB_REG_SCALE_LSB__A, EC_SB_REG_SCALE_LSB__A,
0x0000, 0x0000 ) ); 0x0000, 0x0000));
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
EQ_REG_TD_TPS_PWR_OFS__A, EQ_REG_TD_TPS_PWR_OFS__A,
qpskTdTpsPwr, 0x0000 ) ); qpskTdTpsPwr, 0x0000));
CHK_ERROR( Write16(state, EQ_REG_SN_CEGAIN__A, CHK_ERROR(Write16(state, EQ_REG_SN_CEGAIN__A,
qpskSnCeGain, 0x0000 )); qpskSnCeGain, 0x0000));
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
EQ_REG_IS_GAIN_MAN__A, EQ_REG_IS_GAIN_MAN__A,
qpskIsGainMan, 0x0000 )); qpskIsGainMan, 0x0000));
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
EQ_REG_IS_GAIN_EXP__A, EQ_REG_IS_GAIN_EXP__A,
qpskIsGainExp, 0x0000 )); qpskIsGainExp, 0x0000));
} }
break; break;
...@@ -2110,104 +2077,103 @@ static int DRX_Start(struct drxd_state *state, s32 off) ...@@ -2110,104 +2077,103 @@ static int DRX_Start(struct drxd_state *state, s32 off)
transmissionParams |= SC_RA_RAM_OP_PARAM_CONST_QAM16; transmissionParams |= SC_RA_RAM_OP_PARAM_CONST_QAM16;
if (state->type_A) { if (state->type_A) {
CHK_ERROR(Write16(state, EQ_REG_OT_CONST__A, CHK_ERROR(Write16(state, EQ_REG_OT_CONST__A,
0x0001, 0x0000 ) ); 0x0001, 0x0000));
CHK_ERROR(Write16(state, EC_SB_REG_CONST__A, CHK_ERROR(Write16(state, EC_SB_REG_CONST__A,
EC_SB_REG_CONST_16QAM, EC_SB_REG_CONST_16QAM,
0x0000) ); 0x0000));
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
EC_SB_REG_SCALE_MSB__A, EC_SB_REG_SCALE_MSB__A,
0x0010, 0x0000 ) ); 0x0010, 0x0000));
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
EC_SB_REG_SCALE_BIT2__A, EC_SB_REG_SCALE_BIT2__A,
0x0004, 0x0000 ) ); 0x0004, 0x0000));
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
EC_SB_REG_SCALE_LSB__A, EC_SB_REG_SCALE_LSB__A,
0x0000, 0x0000 ) ); 0x0000, 0x0000));
CHK_ERROR(Write16(state, CHK_ERROR(Write16(state,
EQ_REG_TD_TPS_PWR_OFS__A, EQ_REG_TD_TPS_PWR_OFS__A,
qam16TdTpsPwr, 0x0000 ) ); qam16TdTpsPwr, 0x0000));
CHK_ERROR( Write16(state, EQ_REG_SN_CEGAIN__A, CHK_ERROR(Write16(state, EQ_REG_SN_CEGAIN__A,
qam16SnCeGain, 0x0000 )); qam16SnCeGain, 0x0000));
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
EQ_REG_IS_GAIN_MAN__A, EQ_REG_IS_GAIN_MAN__A,
qam16IsGainMan, 0x0000 )); qam16IsGainMan, 0x0000));
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
EQ_REG_IS_GAIN_EXP__A, EQ_REG_IS_GAIN_EXP__A,
qam16IsGainExp, 0x0000 )); qam16IsGainExp, 0x0000));
} }
break; break;
} }
CHK_ERROR( status ); CHK_ERROR(status);
switch (DRX_CHANNEL_HIGH) { switch (DRX_CHANNEL_HIGH) {
default: default:
case DRX_CHANNEL_AUTO: case DRX_CHANNEL_AUTO:
case DRX_CHANNEL_LOW: case DRX_CHANNEL_LOW:
transmissionParams |= SC_RA_RAM_OP_PARAM_PRIO_LO; transmissionParams |= SC_RA_RAM_OP_PARAM_PRIO_LO;
CHK_ERROR( Write16(state, EC_SB_REG_PRIOR__A, CHK_ERROR(Write16(state, EC_SB_REG_PRIOR__A,
EC_SB_REG_PRIOR_LO, 0x0000 )); EC_SB_REG_PRIOR_LO, 0x0000));
break; break;
case DRX_CHANNEL_HIGH: case DRX_CHANNEL_HIGH:
transmissionParams |= SC_RA_RAM_OP_PARAM_PRIO_HI; transmissionParams |= SC_RA_RAM_OP_PARAM_PRIO_HI;
CHK_ERROR( Write16(state, EC_SB_REG_PRIOR__A, CHK_ERROR(Write16(state, EC_SB_REG_PRIOR__A,
EC_SB_REG_PRIOR_HI, 0x0000 )); EC_SB_REG_PRIOR_HI, 0x0000));
break; break;
} }
switch( p->code_rate_HP ) switch (p->code_rate_HP) {
{
case FEC_1_2: case FEC_1_2:
transmissionParams |= SC_RA_RAM_OP_PARAM_RATE_1_2; transmissionParams |= SC_RA_RAM_OP_PARAM_RATE_1_2;
if (state->type_A) { if (state->type_A) {
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
EC_VD_REG_SET_CODERATE__A, EC_VD_REG_SET_CODERATE__A,
EC_VD_REG_SET_CODERATE_C1_2, EC_VD_REG_SET_CODERATE_C1_2,
0x0000 ) ); 0x0000));
} }
break; break;
default: default:
operationMode |= SC_RA_RAM_OP_AUTO_RATE__M; operationMode |= SC_RA_RAM_OP_AUTO_RATE__M;
case FEC_2_3 : case FEC_2_3:
transmissionParams |= SC_RA_RAM_OP_PARAM_RATE_2_3; transmissionParams |= SC_RA_RAM_OP_PARAM_RATE_2_3;
if (state->type_A) { if (state->type_A) {
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
EC_VD_REG_SET_CODERATE__A, EC_VD_REG_SET_CODERATE__A,
EC_VD_REG_SET_CODERATE_C2_3, EC_VD_REG_SET_CODERATE_C2_3,
0x0000 ) ); 0x0000));
} }
break; break;
case FEC_3_4 : case FEC_3_4:
transmissionParams |= SC_RA_RAM_OP_PARAM_RATE_3_4; transmissionParams |= SC_RA_RAM_OP_PARAM_RATE_3_4;
if (state->type_A) { if (state->type_A) {
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
EC_VD_REG_SET_CODERATE__A, EC_VD_REG_SET_CODERATE__A,
EC_VD_REG_SET_CODERATE_C3_4, EC_VD_REG_SET_CODERATE_C3_4,
0x0000 ) ); 0x0000));
} }
break; break;
case FEC_5_6 : case FEC_5_6:
transmissionParams |= SC_RA_RAM_OP_PARAM_RATE_5_6; transmissionParams |= SC_RA_RAM_OP_PARAM_RATE_5_6;
if (state->type_A) { if (state->type_A) {
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
EC_VD_REG_SET_CODERATE__A, EC_VD_REG_SET_CODERATE__A,
EC_VD_REG_SET_CODERATE_C5_6, EC_VD_REG_SET_CODERATE_C5_6,
0x0000 ) ); 0x0000));
} }
break; break;
case FEC_7_8 : case FEC_7_8:
transmissionParams |= SC_RA_RAM_OP_PARAM_RATE_7_8; transmissionParams |= SC_RA_RAM_OP_PARAM_RATE_7_8;
if (state->type_A) { if (state->type_A) {
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
EC_VD_REG_SET_CODERATE__A, EC_VD_REG_SET_CODERATE__A,
EC_VD_REG_SET_CODERATE_C7_8, EC_VD_REG_SET_CODERATE_C7_8,
0x0000 ) ); 0x0000));
} }
break; break;
} }
CHK_ERROR( status ); CHK_ERROR(status);
/* First determine real bandwidth (Hz) */ /* First determine real bandwidth (Hz) */
/* Also set delay for impulse noise cruncher (only A2) */ /* Also set delay for impulse noise cruncher (only A2) */
...@@ -2216,8 +2182,7 @@ static int DRX_Start(struct drxd_state *state, s32 off) ...@@ -2216,8 +2182,7 @@ static int DRX_Start(struct drxd_state *state, s32 off)
by SC for fix for some 8K,1/8 guard but is restored by by SC for fix for some 8K,1/8 guard but is restored by
InitEC and ResetEC InitEC and ResetEC
functions */ functions */
switch( p->bandwidth ) switch (p->bandwidth) {
{
case BANDWIDTH_AUTO: case BANDWIDTH_AUTO:
case BANDWIDTH_8_MHZ: case BANDWIDTH_8_MHZ:
/* (64/7)*(8/8)*1000000 */ /* (64/7)*(8/8)*1000000 */
...@@ -2225,26 +2190,26 @@ static int DRX_Start(struct drxd_state *state, s32 off) ...@@ -2225,26 +2190,26 @@ static int DRX_Start(struct drxd_state *state, s32 off)
bandwidthParam = 0; bandwidthParam = 0;
status = Write16(state, status = Write16(state,
FE_AG_REG_IND_DEL__A , 50 , 0x0000 ); FE_AG_REG_IND_DEL__A, 50, 0x0000);
break; break;
case BANDWIDTH_7_MHZ: case BANDWIDTH_7_MHZ:
/* (64/7)*(7/8)*1000000 */ /* (64/7)*(7/8)*1000000 */
bandwidth = DRXD_BANDWIDTH_7MHZ_IN_HZ; bandwidth = DRXD_BANDWIDTH_7MHZ_IN_HZ;
bandwidthParam =0x4807; /*binary:0100 1000 0000 0111 */ bandwidthParam = 0x4807; /*binary:0100 1000 0000 0111 */
status = Write16(state, status = Write16(state,
FE_AG_REG_IND_DEL__A , 59 , 0x0000 ); FE_AG_REG_IND_DEL__A, 59, 0x0000);
break; break;
case BANDWIDTH_6_MHZ: case BANDWIDTH_6_MHZ:
/* (64/7)*(6/8)*1000000 */ /* (64/7)*(6/8)*1000000 */
bandwidth = DRXD_BANDWIDTH_6MHZ_IN_HZ; bandwidth = DRXD_BANDWIDTH_6MHZ_IN_HZ;
bandwidthParam =0x0F07; /*binary: 0000 1111 0000 0111*/ bandwidthParam = 0x0F07; /*binary: 0000 1111 0000 0111 */
status = Write16(state, status = Write16(state,
FE_AG_REG_IND_DEL__A , 71 , 0x0000 ); FE_AG_REG_IND_DEL__A, 71, 0x0000);
break; break;
} }
CHK_ERROR( status ); CHK_ERROR(status);
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
SC_RA_RAM_BAND__A, bandwidthParam, 0x0000)); SC_RA_RAM_BAND__A, bandwidthParam, 0x0000));
{ {
...@@ -2254,45 +2219,43 @@ static int DRX_Start(struct drxd_state *state, s32 off) ...@@ -2254,45 +2219,43 @@ static int DRX_Start(struct drxd_state *state, s32 off)
/* enable SLAVE mode in 2k 1/32 to /* enable SLAVE mode in 2k 1/32 to
prevent timing change glitches */ prevent timing change glitches */
if ( (p->transmission_mode==TRANSMISSION_MODE_2K) && if ((p->transmission_mode == TRANSMISSION_MODE_2K) &&
(p->guard_interval==GUARD_INTERVAL_1_32) ) { (p->guard_interval == GUARD_INTERVAL_1_32)) {
/* enable slave */ /* enable slave */
sc_config |= SC_RA_RAM_CONFIG_SLAVE__M; sc_config |= SC_RA_RAM_CONFIG_SLAVE__M;
} else { } else {
/* disable slave */ /* disable slave */
sc_config &= ~SC_RA_RAM_CONFIG_SLAVE__M; sc_config &= ~SC_RA_RAM_CONFIG_SLAVE__M;
} }
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
SC_RA_RAM_CONFIG__A, sc_config,0 )); SC_RA_RAM_CONFIG__A, sc_config, 0));
} }
CHK_ERROR( SetCfgNoiseCalibration(state, &state->noise_cal)); CHK_ERROR(SetCfgNoiseCalibration(state, &state->noise_cal));
if (state->cscd_state == CSCD_INIT ) if (state->cscd_state == CSCD_INIT) {
{
/* switch on SRMM scan in SC */ /* switch on SRMM scan in SC */
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
SC_RA_RAM_SAMPLE_RATE_COUNT__A, SC_RA_RAM_SAMPLE_RATE_COUNT__A,
DRXD_OSCDEV_DO_SCAN, 0x0000 )); DRXD_OSCDEV_DO_SCAN, 0x0000));
/* CHK_ERROR( Write16( SC_RA_RAM_SAMPLE_RATE_STEP__A, /* CHK_ERROR( Write16( SC_RA_RAM_SAMPLE_RATE_STEP__A,
DRXD_OSCDEV_STEP , 0x0000 ));*/ DRXD_OSCDEV_STEP , 0x0000 ));*/
state->cscd_state = CSCD_SET; state->cscd_state = CSCD_SET;
} }
/* Now compute FE_IF_REG_INCR */ /* Now compute FE_IF_REG_INCR */
/*((( SysFreq/BandWidth)/2)/2) -1) * 2^23) => /*((( SysFreq/BandWidth)/2)/2) -1) * 2^23) =>
((SysFreq / BandWidth) * (2^21) ) - (2^23)*/ ((SysFreq / BandWidth) * (2^21) ) - (2^23) */
feIfIncr = MulDiv32(state->sys_clock_freq*1000, feIfIncr = MulDiv32(state->sys_clock_freq * 1000,
( 1ULL<< 21 ), bandwidth) - (1<<23) ; (1ULL << 21), bandwidth) - (1 << 23);
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
FE_IF_REG_INCR0__A, FE_IF_REG_INCR0__A,
(u16)(feIfIncr & FE_IF_REG_INCR0__M ), (u16) (feIfIncr & FE_IF_REG_INCR0__M),
0x0000) ); 0x0000));
CHK_ERROR( Write16(state, CHK_ERROR(Write16(state,
FE_IF_REG_INCR1__A, FE_IF_REG_INCR1__A,
(u16)((feIfIncr >> FE_IF_REG_INCR0__W) & (u16) ((feIfIncr >> FE_IF_REG_INCR0__W) &
FE_IF_REG_INCR1__M ), 0x0000) ); FE_IF_REG_INCR1__M), 0x0000));
/* Bandwidth setting done */ /* Bandwidth setting done */
/* Mirror & frequency offset */ /* Mirror & frequency offset */
...@@ -2301,34 +2264,34 @@ static int DRX_Start(struct drxd_state *state, s32 off) ...@@ -2301,34 +2264,34 @@ static int DRX_Start(struct drxd_state *state, s32 off)
/* Start SC, write channel settings to SC */ /* Start SC, write channel settings to SC */
/* Enable SC after setting all other parameters */ /* Enable SC after setting all other parameters */
CHK_ERROR( Write16(state, SC_COMM_STATE__A, 0, 0x0000)); CHK_ERROR(Write16(state, SC_COMM_STATE__A, 0, 0x0000));
CHK_ERROR( Write16(state, SC_COMM_EXEC__A, 1, 0x0000)); CHK_ERROR(Write16(state, SC_COMM_EXEC__A, 1, 0x0000));
/* Write SC parameter registers, operation mode */ /* Write SC parameter registers, operation mode */
#if 1 #if 1
operationMode =( SC_RA_RAM_OP_AUTO_MODE__M | operationMode = (SC_RA_RAM_OP_AUTO_MODE__M |
SC_RA_RAM_OP_AUTO_GUARD__M | SC_RA_RAM_OP_AUTO_GUARD__M |
SC_RA_RAM_OP_AUTO_CONST__M | SC_RA_RAM_OP_AUTO_CONST__M |
SC_RA_RAM_OP_AUTO_HIER__M | SC_RA_RAM_OP_AUTO_HIER__M |
SC_RA_RAM_OP_AUTO_RATE__M ); SC_RA_RAM_OP_AUTO_RATE__M);
#endif #endif
CHK_ERROR( SC_SetPrefParamCommand(state, 0x0000, CHK_ERROR(SC_SetPrefParamCommand(state, 0x0000,
transmissionParams, transmissionParams,
operationMode) ); operationMode));
/* Start correct processes to get in lock */ /* Start correct processes to get in lock */
CHK_ERROR( SC_ProcStartCommand(state, SC_RA_RAM_PROC_LOCKTRACK, CHK_ERROR(SC_ProcStartCommand(state, SC_RA_RAM_PROC_LOCKTRACK,
SC_RA_RAM_SW_EVENT_RUN_NMASK__M, SC_RA_RAM_SW_EVENT_RUN_NMASK__M,
SC_RA_RAM_LOCKTRACK_MIN) ); SC_RA_RAM_LOCKTRACK_MIN));
CHK_ERROR( StartOC(state) ); CHK_ERROR(StartOC(state));
if( state->operation_mode != OM_Default ) { if (state->operation_mode != OM_Default) {
CHK_ERROR(StartDiversity(state)); CHK_ERROR(StartDiversity(state));
} }
state->drxd_state = DRXD_STARTED; state->drxd_state = DRXD_STARTED;
} while(0); } while (0);
return status; return status;
} }
...@@ -2340,7 +2303,7 @@ static int CDRXD(struct drxd_state *state, u32 IntermediateFrequency) ...@@ -2340,7 +2303,7 @@ static int CDRXD(struct drxd_state *state, u32 IntermediateFrequency)
u32 ulRfAgcMinLevel = 0; /* Currently unused */ u32 ulRfAgcMinLevel = 0; /* Currently unused */
u32 ulRfAgcMaxLevel = DRXD_FE_CTRL_MAX; /* Currently unused */ u32 ulRfAgcMaxLevel = DRXD_FE_CTRL_MAX; /* Currently unused */
u32 ulRfAgcSpeed = 0; /* Currently unused */ u32 ulRfAgcSpeed = 0; /* Currently unused */
u32 ulRfAgcMode = 0;/*2; Off */ u32 ulRfAgcMode = 0; /*2; Off */
u32 ulRfAgcR1 = 820; u32 ulRfAgcR1 = 820;
u32 ulRfAgcR2 = 2200; u32 ulRfAgcR2 = 2200;
u32 ulRfAgcR3 = 150; u32 ulRfAgcR3 = 150;
...@@ -2370,57 +2333,51 @@ static int CDRXD(struct drxd_state *state, u32 IntermediateFrequency) ...@@ -2370,57 +2333,51 @@ static int CDRXD(struct drxd_state *state, u32 IntermediateFrequency)
state->if_agc_cfg.maxOutputLevel = 1023; state->if_agc_cfg.maxOutputLevel = 1023;
state->if_agc_cfg.speed = 904; state->if_agc_cfg.speed = 904;
if( ulIfAgcMode == 1 && ulIfAgcOutputLevel <= DRXD_FE_CTRL_MAX ) if (ulIfAgcMode == 1 && ulIfAgcOutputLevel <= DRXD_FE_CTRL_MAX) {
{
state->if_agc_cfg.ctrlMode = AGC_CTRL_USER; state->if_agc_cfg.ctrlMode = AGC_CTRL_USER;
state->if_agc_cfg.outputLevel = (u16)(ulIfAgcOutputLevel); state->if_agc_cfg.outputLevel = (u16) (ulIfAgcOutputLevel);
} }
if( ulIfAgcMode == 0 && if (ulIfAgcMode == 0 &&
ulIfAgcSettleLevel <= DRXD_FE_CTRL_MAX && ulIfAgcSettleLevel <= DRXD_FE_CTRL_MAX &&
ulIfAgcMinLevel <= DRXD_FE_CTRL_MAX && ulIfAgcMinLevel <= DRXD_FE_CTRL_MAX &&
ulIfAgcMaxLevel <= DRXD_FE_CTRL_MAX && ulIfAgcMaxLevel <= DRXD_FE_CTRL_MAX &&
ulIfAgcSpeed <= DRXD_FE_CTRL_MAX ulIfAgcSpeed <= DRXD_FE_CTRL_MAX) {
)
{
state->if_agc_cfg.ctrlMode = AGC_CTRL_AUTO; state->if_agc_cfg.ctrlMode = AGC_CTRL_AUTO;
state->if_agc_cfg.settleLevel = (u16)(ulIfAgcSettleLevel); state->if_agc_cfg.settleLevel = (u16) (ulIfAgcSettleLevel);
state->if_agc_cfg.minOutputLevel = (u16)(ulIfAgcMinLevel); state->if_agc_cfg.minOutputLevel = (u16) (ulIfAgcMinLevel);
state->if_agc_cfg.maxOutputLevel = (u16)(ulIfAgcMaxLevel); state->if_agc_cfg.maxOutputLevel = (u16) (ulIfAgcMaxLevel);
state->if_agc_cfg.speed = (u16)(ulIfAgcSpeed); state->if_agc_cfg.speed = (u16) (ulIfAgcSpeed);
} }
state->if_agc_cfg.R1 = (u16)(ulIfAgcR1); state->if_agc_cfg.R1 = (u16) (ulIfAgcR1);
state->if_agc_cfg.R2 = (u16)(ulIfAgcR2); state->if_agc_cfg.R2 = (u16) (ulIfAgcR2);
state->if_agc_cfg.R3 = (u16)(ulIfAgcR3); state->if_agc_cfg.R3 = (u16) (ulIfAgcR3);
state->rf_agc_cfg.R1 = (u16)(ulRfAgcR1); state->rf_agc_cfg.R1 = (u16) (ulRfAgcR1);
state->rf_agc_cfg.R2 = (u16)(ulRfAgcR2); state->rf_agc_cfg.R2 = (u16) (ulRfAgcR2);
state->rf_agc_cfg.R3 = (u16)(ulRfAgcR3); state->rf_agc_cfg.R3 = (u16) (ulRfAgcR3);
state->rf_agc_cfg.ctrlMode = AGC_CTRL_AUTO; state->rf_agc_cfg.ctrlMode = AGC_CTRL_AUTO;
/* rest of the RFAgcCfg structure currently unused */ /* rest of the RFAgcCfg structure currently unused */
if (ulRfAgcMode==1 && ulRfAgcOutputLevel<=DRXD_FE_CTRL_MAX) { if (ulRfAgcMode == 1 && ulRfAgcOutputLevel <= DRXD_FE_CTRL_MAX) {
state->rf_agc_cfg.ctrlMode = AGC_CTRL_USER; state->rf_agc_cfg.ctrlMode = AGC_CTRL_USER;
state->rf_agc_cfg.outputLevel = (u16)(ulRfAgcOutputLevel); state->rf_agc_cfg.outputLevel = (u16) (ulRfAgcOutputLevel);
} }
if( ulRfAgcMode == 0 && if (ulRfAgcMode == 0 &&
ulRfAgcSettleLevel <= DRXD_FE_CTRL_MAX && ulRfAgcSettleLevel <= DRXD_FE_CTRL_MAX &&
ulRfAgcMinLevel <= DRXD_FE_CTRL_MAX && ulRfAgcMinLevel <= DRXD_FE_CTRL_MAX &&
ulRfAgcMaxLevel <= DRXD_FE_CTRL_MAX && ulRfAgcMaxLevel <= DRXD_FE_CTRL_MAX &&
ulRfAgcSpeed <= DRXD_FE_CTRL_MAX ulRfAgcSpeed <= DRXD_FE_CTRL_MAX) {
)
{
state->rf_agc_cfg.ctrlMode = AGC_CTRL_AUTO; state->rf_agc_cfg.ctrlMode = AGC_CTRL_AUTO;
state->rf_agc_cfg.settleLevel = (u16)(ulRfAgcSettleLevel); state->rf_agc_cfg.settleLevel = (u16) (ulRfAgcSettleLevel);
state->rf_agc_cfg.minOutputLevel = (u16)(ulRfAgcMinLevel); state->rf_agc_cfg.minOutputLevel = (u16) (ulRfAgcMinLevel);
state->rf_agc_cfg.maxOutputLevel = (u16)(ulRfAgcMaxLevel); state->rf_agc_cfg.maxOutputLevel = (u16) (ulRfAgcMaxLevel);
state->rf_agc_cfg.speed = (u16)(ulRfAgcSpeed); state->rf_agc_cfg.speed = (u16) (ulRfAgcSpeed);
} }
if( ulRfAgcMode == 2 ) if (ulRfAgcMode == 2) {
{
state->rf_agc_cfg.ctrlMode = AGC_CTRL_OFF; state->rf_agc_cfg.ctrlMode = AGC_CTRL_OFF;
} }
...@@ -2431,8 +2388,7 @@ static int CDRXD(struct drxd_state *state, u32 IntermediateFrequency) ...@@ -2431,8 +2388,7 @@ static int CDRXD(struct drxd_state *state, u32 IntermediateFrequency)
state->app_env_diversity = (enum app_env) state->app_env_diversity = (enum app_env)
(ulEnvironmentDiversity); (ulEnvironmentDiversity);
if( ulIFFilter == IFFILTER_DISCRETE ) if (ulIFFilter == IFFILTER_DISCRETE) {
{
/* discrete filter */ /* discrete filter */
state->noise_cal.cpOpt = 0; state->noise_cal.cpOpt = 0;
state->noise_cal.cpNexpOfs = 40; state->noise_cal.cpNexpOfs = 40;
...@@ -2445,19 +2401,22 @@ static int CDRXD(struct drxd_state *state, u32 IntermediateFrequency) ...@@ -2445,19 +2401,22 @@ static int CDRXD(struct drxd_state *state, u32 IntermediateFrequency)
state->noise_cal.tdCal2k = -21; state->noise_cal.tdCal2k = -21;
state->noise_cal.tdCal8k = -24; state->noise_cal.tdCal8k = -24;
} }
state->m_EcOcRegOcModeLop = (u16)(ulEcOcRegOcModeLop); state->m_EcOcRegOcModeLop = (u16) (ulEcOcRegOcModeLop);
state->chip_adr = (state->config.demod_address<<1)|1; state->chip_adr = (state->config.demod_address << 1) | 1;
switch( ulHiI2cPatch ) switch (ulHiI2cPatch) {
{ case 1:
case 1 : state->m_HiI2cPatch = DRXD_HiI2cPatch_1; break; state->m_HiI2cPatch = DRXD_HiI2cPatch_1;
case 3 : state->m_HiI2cPatch = DRXD_HiI2cPatch_3; break; break;
case 3:
state->m_HiI2cPatch = DRXD_HiI2cPatch_3;
break;
default: default:
state->m_HiI2cPatch = NULL; state->m_HiI2cPatch = NULL;
} }
/* modify tuner and clock attributes */ /* modify tuner and clock attributes */
state->intermediate_freq = (u16)(IntermediateFrequency/1000); state->intermediate_freq = (u16) (IntermediateFrequency / 1000);
/* expected system clock frequency in kHz */ /* expected system clock frequency in kHz */
state->expected_sys_clock_freq = 48000; state->expected_sys_clock_freq = 48000;
/* real system clock frequency in kHz */ /* real system clock frequency in kHz */
...@@ -2467,9 +2426,9 @@ static int CDRXD(struct drxd_state *state, u32 IntermediateFrequency) ...@@ -2467,9 +2426,9 @@ static int CDRXD(struct drxd_state *state, u32 IntermediateFrequency)
state->cscd_state = CSCD_INIT; state->cscd_state = CSCD_INIT;
state->drxd_state = DRXD_UNINITIALIZED; state->drxd_state = DRXD_UNINITIALIZED;
state->PGA=0; state->PGA = 0;
state->type_A=0; state->type_A = 0;
state->tuner_mirrors=0; state->tuner_mirrors = 0;
/* modify MPEG output attributes */ /* modify MPEG output attributes */
state->insert_rs_byte = state->config.insert_rs_byte; state->insert_rs_byte = state->config.insert_rs_byte;
...@@ -2478,12 +2437,12 @@ static int CDRXD(struct drxd_state *state, u32 IntermediateFrequency) ...@@ -2478,12 +2437,12 @@ static int CDRXD(struct drxd_state *state, u32 IntermediateFrequency)
/* Timing div, 250ns/Psys */ /* Timing div, 250ns/Psys */
/* Timing div, = ( delay (nano seconds) * sysclk (kHz) )/ 1000 */ /* Timing div, = ( delay (nano seconds) * sysclk (kHz) )/ 1000 */
state->hi_cfg_timing_div = (u16)((state->sys_clock_freq/1000)* state->hi_cfg_timing_div = (u16) ((state->sys_clock_freq / 1000) *
ulHiI2cDelay)/1000 ; ulHiI2cDelay) / 1000;
/* Bridge delay, uses oscilator clock */ /* Bridge delay, uses oscilator clock */
/* Delay = ( delay (nano seconds) * oscclk (kHz) )/ 1000 */ /* Delay = ( delay (nano seconds) * oscclk (kHz) )/ 1000 */
state->hi_cfg_bridge_delay = (u16)((state->osc_clock_freq/1000) * state->hi_cfg_bridge_delay = (u16) ((state->osc_clock_freq / 1000) *
ulHiI2cBridgeDelay)/1000 ; ulHiI2cBridgeDelay) / 1000;
state->m_FeAgRegAgPwd = DRXD_DEF_AG_PWD_CONSUMER; state->m_FeAgRegAgPwd = DRXD_DEF_AG_PWD_CONSUMER;
/* state->m_FeAgRegAgPwd = DRXD_DEF_AG_PWD_PRO; */ /* state->m_FeAgRegAgPwd = DRXD_DEF_AG_PWD_PRO; */
...@@ -2491,9 +2450,9 @@ static int CDRXD(struct drxd_state *state, u32 IntermediateFrequency) ...@@ -2491,9 +2450,9 @@ static int CDRXD(struct drxd_state *state, u32 IntermediateFrequency)
return 0; return 0;
} }
int DRXD_init(struct drxd_state *state, const u8 *fw, u32 fw_size) int DRXD_init(struct drxd_state *state, const u8 * fw, u32 fw_size)
{ {
int status=0; int status = 0;
u32 driverVersion; u32 driverVersion;
if (state->init_done) if (state->init_done)
...@@ -2504,10 +2463,10 @@ int DRXD_init(struct drxd_state *state, const u8 *fw, u32 fw_size) ...@@ -2504,10 +2463,10 @@ int DRXD_init(struct drxd_state *state, const u8 *fw, u32 fw_size)
do { do {
state->operation_mode = OM_Default; state->operation_mode = OM_Default;
CHK_ERROR( SetDeviceTypeId(state) ); CHK_ERROR(SetDeviceTypeId(state));
/* Apply I2c address patch to B1 */ /* Apply I2c address patch to B1 */
if( !state->type_A && state->m_HiI2cPatch != NULL ) if (!state->type_A && state->m_HiI2cPatch != NULL)
CHK_ERROR(WriteTable(state, state->m_HiI2cPatch)); CHK_ERROR(WriteTable(state, state->m_HiI2cPatch));
if (state->type_A) { if (state->type_A) {
...@@ -2516,7 +2475,7 @@ int DRXD_init(struct drxd_state *state, const u8 *fw, u32 fw_size) ...@@ -2516,7 +2475,7 @@ int DRXD_init(struct drxd_state *state, const u8 *fw, u32 fw_size)
CHK_ERROR(Write16(state, 0x43012D, 0x047f, 0)); CHK_ERROR(Write16(state, 0x43012D, 0x047f, 0));
} }
CHK_ERROR( HI_ResetCommand(state)); CHK_ERROR(HI_ResetCommand(state));
CHK_ERROR(StopAllProcessors(state)); CHK_ERROR(StopAllProcessors(state));
CHK_ERROR(InitCC(state)); CHK_ERROR(InitCC(state));
...@@ -2525,28 +2484,26 @@ int DRXD_init(struct drxd_state *state, const u8 *fw, u32 fw_size) ...@@ -2525,28 +2484,26 @@ int DRXD_init(struct drxd_state *state, const u8 *fw, u32 fw_size)
if (state->config.osc_deviation) if (state->config.osc_deviation)
state->osc_clock_deviation = state->osc_clock_deviation =
state->config.osc_deviation(state->priv, state->config.osc_deviation(state->priv, 0, 0);
0, 0);
{ {
/* Handle clock deviation */ /* Handle clock deviation */
s32 devB; s32 devB;
s32 devA = (s32)(state->osc_clock_deviation) * s32 devA = (s32) (state->osc_clock_deviation) *
(s32)(state->expected_sys_clock_freq); (s32) (state->expected_sys_clock_freq);
/* deviation in kHz */ /* deviation in kHz */
s32 deviation = ( devA /(1000000L)); s32 deviation = (devA / (1000000L));
/* rounding, signed */ /* rounding, signed */
if ( devA > 0 ) if (devA > 0)
devB=(2); devB = (2);
else else
devB=(-2); devB = (-2);
if ( (devB*(devA%1000000L)>1000000L ) ) if ((devB * (devA % 1000000L) > 1000000L)) {
{
/* add +1 or -1 */ /* add +1 or -1 */
deviation += (devB/2); deviation += (devB / 2);
} }
state->sys_clock_freq=(u16)((state-> state->sys_clock_freq =
expected_sys_clock_freq)+ (u16) ((state->expected_sys_clock_freq) +
deviation); deviation);
} }
CHK_ERROR(InitHI(state)); CHK_ERROR(InitHI(state));
...@@ -2587,39 +2544,37 @@ int DRXD_init(struct drxd_state *state, const u8 *fw, u32 fw_size) ...@@ -2587,39 +2544,37 @@ int DRXD_init(struct drxd_state *state, const u8 *fw, u32 fw_size)
CHK_ERROR(Write16(state, SC_COMM_EXEC__A, CHK_ERROR(Write16(state, SC_COMM_EXEC__A,
SC_COMM_EXEC_CTL_STOP, 0)); SC_COMM_EXEC_CTL_STOP, 0));
CHK_ERROR(Write16(state, LC_COMM_EXEC__A, CHK_ERROR(Write16(state, LC_COMM_EXEC__A,
SC_COMM_EXEC_CTL_STOP, 0 )); SC_COMM_EXEC_CTL_STOP, 0));
driverVersion = (((VERSION_MAJOR/10) << 4) + driverVersion = (((VERSION_MAJOR / 10) << 4) +
(VERSION_MAJOR%10)) << 24; (VERSION_MAJOR % 10)) << 24;
driverVersion += (((VERSION_MINOR/10) << 4) + driverVersion += (((VERSION_MINOR / 10) << 4) +
(VERSION_MINOR%10)) << 16; (VERSION_MINOR % 10)) << 16;
driverVersion += ((VERSION_PATCH/1000)<<12) + driverVersion += ((VERSION_PATCH / 1000) << 12) +
((VERSION_PATCH/100)<<8) + ((VERSION_PATCH / 100) << 8) +
((VERSION_PATCH/10 )<< 4) + ((VERSION_PATCH / 10) << 4) + (VERSION_PATCH % 10);
(VERSION_PATCH%10 );
CHK_ERROR(Write32(state, SC_RA_RAM_DRIVER_VERSION__AX, CHK_ERROR(Write32(state, SC_RA_RAM_DRIVER_VERSION__AX,
driverVersion,0 )); driverVersion, 0));
CHK_ERROR( StopOC(state) ); CHK_ERROR(StopOC(state));
state->drxd_state = DRXD_STOPPED; state->drxd_state = DRXD_STOPPED;
state->init_done=1; state->init_done = 1;
status=0; status = 0;
} while (0); } while (0);
return status; return status;
} }
int DRXD_status(struct drxd_state *state, u32 *pLockStatus) int DRXD_status(struct drxd_state *state, u32 * pLockStatus)
{ {
DRX_GetLockStatus(state, pLockStatus); DRX_GetLockStatus(state, pLockStatus);
/*if (*pLockStatus&DRX_LOCK_MPEG)*/ /*if (*pLockStatus&DRX_LOCK_MPEG) */
if (*pLockStatus&DRX_LOCK_FEC) { if (*pLockStatus & DRX_LOCK_FEC) {
ConfigureMPEGOutput(state, 1); ConfigureMPEGOutput(state, 1);
/* Get status again, in case we have MPEG lock now */ /* Get status again, in case we have MPEG lock now */
/*DRX_GetLockStatus(state, pLockStatus);*/ /*DRX_GetLockStatus(state, pLockStatus); */
} }
return 0; return 0;
...@@ -2629,61 +2584,59 @@ int DRXD_status(struct drxd_state *state, u32 *pLockStatus) ...@@ -2629,61 +2584,59 @@ int DRXD_status(struct drxd_state *state, u32 *pLockStatus)
/****************************************************************************/ /****************************************************************************/
/****************************************************************************/ /****************************************************************************/
static int drxd_read_signal_strength(struct dvb_frontend *fe, static int drxd_read_signal_strength(struct dvb_frontend *fe, u16 * strength)
u16 *strength)
{ {
struct drxd_state *state = fe->demodulator_priv; struct drxd_state *state = fe->demodulator_priv;
u32 value; u32 value;
int res; int res;
res=ReadIFAgc(state, &value); res = ReadIFAgc(state, &value);
if (res<0) if (res < 0)
*strength=0; *strength = 0;
else else
*strength=0xffff-(value<<4); *strength = 0xffff - (value << 4);
return 0; return 0;
} }
static int drxd_read_status(struct dvb_frontend *fe, fe_status_t * status)
static int drxd_read_status(struct dvb_frontend *fe, fe_status_t *status)
{ {
struct drxd_state *state = fe->demodulator_priv; struct drxd_state *state = fe->demodulator_priv;
u32 lock; u32 lock;
DRXD_status(state, &lock); DRXD_status(state, &lock);
*status=0; *status = 0;
/* No MPEG lock in V255 firmware, bug ? */ /* No MPEG lock in V255 firmware, bug ? */
#if 1 #if 1
if (lock&DRX_LOCK_MPEG) if (lock & DRX_LOCK_MPEG)
*status|=FE_HAS_LOCK; *status |= FE_HAS_LOCK;
#else #else
if (lock&DRX_LOCK_FEC) if (lock & DRX_LOCK_FEC)
*status|=FE_HAS_LOCK; *status |= FE_HAS_LOCK;
#endif #endif
if (lock&DRX_LOCK_FEC) if (lock & DRX_LOCK_FEC)
*status|=FE_HAS_VITERBI|FE_HAS_SYNC; *status |= FE_HAS_VITERBI | FE_HAS_SYNC;
if (lock&DRX_LOCK_DEMOD) if (lock & DRX_LOCK_DEMOD)
*status|=FE_HAS_CARRIER|FE_HAS_SIGNAL; *status |= FE_HAS_CARRIER | FE_HAS_SIGNAL;
return 0; return 0;
} }
static int drxd_init(struct dvb_frontend *fe) static int drxd_init(struct dvb_frontend *fe)
{ {
struct drxd_state *state=fe->demodulator_priv; struct drxd_state *state = fe->demodulator_priv;
int err=0; int err = 0;
/* if (request_firmware(&state->fw, "drxd.fw", state->dev)<0) */ /* if (request_firmware(&state->fw, "drxd.fw", state->dev)<0) */
return DRXD_init(state, 0, 0); return DRXD_init(state, 0, 0);
err=DRXD_init(state, state->fw->data, state->fw->size); err = DRXD_init(state, state->fw->data, state->fw->size);
release_firmware(state->fw); release_firmware(state->fw);
return err; return err;
} }
int drxd_config_i2c(struct dvb_frontend *fe, int onoff) int drxd_config_i2c(struct dvb_frontend *fe, int onoff)
{ {
struct drxd_state *state=fe->demodulator_priv; struct drxd_state *state = fe->demodulator_priv;
if (state->config.disable_i2c_gate_ctrl == 1) if (state->config.disable_i2c_gate_ctrl == 1)
return 0; return 0;
...@@ -2694,33 +2647,33 @@ int drxd_config_i2c(struct dvb_frontend *fe, int onoff) ...@@ -2694,33 +2647,33 @@ int drxd_config_i2c(struct dvb_frontend *fe, int onoff)
static int drxd_get_tune_settings(struct dvb_frontend *fe, static int drxd_get_tune_settings(struct dvb_frontend *fe,
struct dvb_frontend_tune_settings *sets) struct dvb_frontend_tune_settings *sets)
{ {
sets->min_delay_ms=10000; sets->min_delay_ms = 10000;
sets->max_drift=0; sets->max_drift = 0;
sets->step_size=0; sets->step_size = 0;
return 0; return 0;
} }
static int drxd_read_ber(struct dvb_frontend *fe, u32 *ber) static int drxd_read_ber(struct dvb_frontend *fe, u32 * ber)
{ {
*ber = 0; *ber = 0;
return 0; return 0;
} }
static int drxd_read_snr(struct dvb_frontend *fe, u16 *snr) static int drxd_read_snr(struct dvb_frontend *fe, u16 * snr)
{ {
*snr=0; *snr = 0;
return 0; return 0;
} }
static int drxd_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks) static int drxd_read_ucblocks(struct dvb_frontend *fe, u32 * ucblocks)
{ {
*ucblocks=0; *ucblocks = 0;
return 0; return 0;
} }
static int drxd_sleep(struct dvb_frontend* fe) static int drxd_sleep(struct dvb_frontend *fe)
{ {
struct drxd_state *state=fe->demodulator_priv; struct drxd_state *state = fe->demodulator_priv;
ConfigureMPEGOutput(state, 0); ConfigureMPEGOutput(state, 0);
return 0; return 0;
...@@ -2732,7 +2685,7 @@ static int drxd_get_frontend(struct dvb_frontend *fe, ...@@ -2732,7 +2685,7 @@ static int drxd_get_frontend(struct dvb_frontend *fe,
return 0; return 0;
} }
static int drxd_i2c_gate_ctrl(struct dvb_frontend* fe, int enable) static int drxd_i2c_gate_ctrl(struct dvb_frontend *fe, int enable)
{ {
return drxd_config_i2c(fe, enable); return drxd_config_i2c(fe, enable);
} }
...@@ -2740,10 +2693,10 @@ static int drxd_i2c_gate_ctrl(struct dvb_frontend* fe, int enable) ...@@ -2740,10 +2693,10 @@ static int drxd_i2c_gate_ctrl(struct dvb_frontend* fe, int enable)
static int drxd_set_frontend(struct dvb_frontend *fe, static int drxd_set_frontend(struct dvb_frontend *fe,
struct dvb_frontend_parameters *param) struct dvb_frontend_parameters *param)
{ {
struct drxd_state *state=fe->demodulator_priv; struct drxd_state *state = fe->demodulator_priv;
s32 off=0; s32 off = 0;
state->param=*param; state->param = *param;
DRX_Stop(state); DRX_Stop(state);
if (fe->ops.tuner_ops.set_params) { if (fe->ops.tuner_ops.set_params) {
...@@ -2756,8 +2709,7 @@ static int drxd_set_frontend(struct dvb_frontend *fe, ...@@ -2756,8 +2709,7 @@ static int drxd_set_frontend(struct dvb_frontend *fe,
if (state->config.pll_set && if (state->config.pll_set &&
state->config.pll_set(state->priv, param, state->config.pll_set(state->priv, param,
state->config.pll_address, state->config.pll_address,
state->config.demoda_address, state->config.demoda_address, &off) < 0) {
&off)<0) {
printk("Error in pll_set\n"); printk("Error in pll_set\n");
return -1; return -1;
} }
...@@ -2767,7 +2719,6 @@ static int drxd_set_frontend(struct dvb_frontend *fe, ...@@ -2767,7 +2719,6 @@ static int drxd_set_frontend(struct dvb_frontend *fe,
return DRX_Start(state, off); return DRX_Start(state, off);
} }
static void drxd_release(struct dvb_frontend *fe) static void drxd_release(struct dvb_frontend *fe)
{ {
struct drxd_state *state = fe->demodulator_priv; struct drxd_state *state = fe->demodulator_priv;
...@@ -2791,9 +2742,7 @@ static struct dvb_frontend_ops drxd_ops = { ...@@ -2791,9 +2742,7 @@ static struct dvb_frontend_ops drxd_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 = drxd_release, .release = drxd_release,
.init = drxd_init, .init = drxd_init,
...@@ -2817,29 +2766,29 @@ struct dvb_frontend *drxd_attach(const struct drxd_config *config, ...@@ -2817,29 +2766,29 @@ struct dvb_frontend *drxd_attach(const struct drxd_config *config,
{ {
struct drxd_state *state = NULL; struct drxd_state *state = NULL;
state=kmalloc(sizeof(struct drxd_state), GFP_KERNEL); state = kmalloc(sizeof(struct drxd_state), GFP_KERNEL);
if (!state) if (!state)
return NULL; return NULL;
memset(state, 0, sizeof(*state)); memset(state, 0, sizeof(*state));
memcpy(&state->ops, &drxd_ops, sizeof(struct dvb_frontend_ops)); memcpy(&state->ops, &drxd_ops, sizeof(struct dvb_frontend_ops));
state->dev=dev; state->dev = dev;
state->config=*config; state->config = *config;
state->i2c=i2c; state->i2c = i2c;
state->priv=priv; state->priv = priv;
sema_init(&state->mutex, 1); sema_init(&state->mutex, 1);
if (Read16(state, 0, 0, 0)<0) if (Read16(state, 0, 0, 0) < 0)
goto error; goto error;
#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,18) #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,18)
state->frontend.ops=&state->ops; state->frontend.ops = &state->ops;
#else #else
memcpy(&state->frontend.ops, &drxd_ops, memcpy(&state->frontend.ops, &drxd_ops,
sizeof(struct dvb_frontend_ops)); sizeof(struct dvb_frontend_ops));
#endif #endif
state->frontend.demodulator_priv=state; state->frontend.demodulator_priv = state;
ConfigureMPEGOutput(state, 0); ConfigureMPEGOutput(state, 0);
return &state->frontend; return &state->frontend;
......
drivers/media/dvb/frontends/drxd_map_firm.h
View file @ 6cacdd46
This source diff could not be displayed because it is too large. You can view the blob instead.
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment
GitLab Nexedi Edition | About GitLab | About Nexedi | 沪ICP备2021021310号-2 | 沪ICP备2021021310号-7