1*53ee8cc1Swenshuai.xi //<MStar Software>
2*53ee8cc1Swenshuai.xi //******************************************************************************
3*53ee8cc1Swenshuai.xi // MStar Software
4*53ee8cc1Swenshuai.xi // Copyright (c) 2010 - 2012 MStar Semiconductor, Inc. All rights reserved.
5*53ee8cc1Swenshuai.xi // All software, firmware and related documentation herein ("MStar Software") are
6*53ee8cc1Swenshuai.xi // intellectual property of MStar Semiconductor, Inc. ("MStar") and protected by
7*53ee8cc1Swenshuai.xi // law, including, but not limited to, copyright law and international treaties.
8*53ee8cc1Swenshuai.xi // Any use, modification, reproduction, retransmission, or republication of all
9*53ee8cc1Swenshuai.xi // or part of MStar Software is expressly prohibited, unless prior written
10*53ee8cc1Swenshuai.xi // permission has been granted by MStar.
11*53ee8cc1Swenshuai.xi //
12*53ee8cc1Swenshuai.xi // By accessing, browsing and/or using MStar Software, you acknowledge that you
13*53ee8cc1Swenshuai.xi // have read, understood, and agree, to be bound by below terms ("Terms") and to
14*53ee8cc1Swenshuai.xi // comply with all applicable laws and regulations:
15*53ee8cc1Swenshuai.xi //
16*53ee8cc1Swenshuai.xi // 1. MStar shall retain any and all right, ownership and interest to MStar
17*53ee8cc1Swenshuai.xi // Software and any modification/derivatives thereof.
18*53ee8cc1Swenshuai.xi // No right, ownership, or interest to MStar Software and any
19*53ee8cc1Swenshuai.xi // modification/derivatives thereof is transferred to you under Terms.
20*53ee8cc1Swenshuai.xi //
21*53ee8cc1Swenshuai.xi // 2. You understand that MStar Software might include, incorporate or be
22*53ee8cc1Swenshuai.xi // supplied together with third party`s software and the use of MStar
23*53ee8cc1Swenshuai.xi // Software may require additional licenses from third parties.
24*53ee8cc1Swenshuai.xi // Therefore, you hereby agree it is your sole responsibility to separately
25*53ee8cc1Swenshuai.xi // obtain any and all third party right and license necessary for your use of
26*53ee8cc1Swenshuai.xi // such third party`s software.
27*53ee8cc1Swenshuai.xi //
28*53ee8cc1Swenshuai.xi // 3. MStar Software and any modification/derivatives thereof shall be deemed as
29*53ee8cc1Swenshuai.xi // MStar`s confidential information and you agree to keep MStar`s
30*53ee8cc1Swenshuai.xi // confidential information in strictest confidence and not disclose to any
31*53ee8cc1Swenshuai.xi // third party.
32*53ee8cc1Swenshuai.xi //
33*53ee8cc1Swenshuai.xi // 4. MStar Software is provided on an "AS IS" basis without warranties of any
34*53ee8cc1Swenshuai.xi // kind. Any warranties are hereby expressly disclaimed by MStar, including
35*53ee8cc1Swenshuai.xi // without limitation, any warranties of merchantability, non-infringement of
36*53ee8cc1Swenshuai.xi // intellectual property rights, fitness for a particular purpose, error free
37*53ee8cc1Swenshuai.xi // and in conformity with any international standard. You agree to waive any
38*53ee8cc1Swenshuai.xi // claim against MStar for any loss, damage, cost or expense that you may
39*53ee8cc1Swenshuai.xi // incur related to your use of MStar Software.
40*53ee8cc1Swenshuai.xi // In no event shall MStar be liable for any direct, indirect, incidental or
41*53ee8cc1Swenshuai.xi // consequential damages, including without limitation, lost of profit or
42*53ee8cc1Swenshuai.xi // revenues, lost or damage of data, and unauthorized system use.
43*53ee8cc1Swenshuai.xi // You agree that this Section 4 shall still apply without being affected
44*53ee8cc1Swenshuai.xi // even if MStar Software has been modified by MStar in accordance with your
45*53ee8cc1Swenshuai.xi // request or instruction for your use, except otherwise agreed by both
46*53ee8cc1Swenshuai.xi // parties in writing.
47*53ee8cc1Swenshuai.xi //
48*53ee8cc1Swenshuai.xi // 5. If requested, MStar may from time to time provide technical supports or
49*53ee8cc1Swenshuai.xi // services in relation with MStar Software to you for your use of
50*53ee8cc1Swenshuai.xi // MStar Software in conjunction with your or your customer`s product
51*53ee8cc1Swenshuai.xi // ("Services").
52*53ee8cc1Swenshuai.xi // You understand and agree that, except otherwise agreed by both parties in
53*53ee8cc1Swenshuai.xi // writing, Services are provided on an "AS IS" basis and the warranty
54*53ee8cc1Swenshuai.xi // disclaimer set forth in Section 4 above shall apply.
55*53ee8cc1Swenshuai.xi //
56*53ee8cc1Swenshuai.xi // 6. Nothing contained herein shall be construed as by implication, estoppels
57*53ee8cc1Swenshuai.xi // or otherwise:
58*53ee8cc1Swenshuai.xi // (a) conferring any license or right to use MStar name, trademark, service
59*53ee8cc1Swenshuai.xi // mark, symbol or any other identification;
60*53ee8cc1Swenshuai.xi // (b) obligating MStar or any of its affiliates to furnish any person,
61*53ee8cc1Swenshuai.xi // including without limitation, you and your customers, any assistance
62*53ee8cc1Swenshuai.xi // of any kind whatsoever, or any information; or
63*53ee8cc1Swenshuai.xi // (c) conferring any license or right under any intellectual property right.
64*53ee8cc1Swenshuai.xi //
65*53ee8cc1Swenshuai.xi // 7. These terms shall be governed by and construed in accordance with the laws
66*53ee8cc1Swenshuai.xi // of Taiwan, R.O.C., excluding its conflict of law rules.
67*53ee8cc1Swenshuai.xi // Any and all dispute arising out hereof or related hereto shall be finally
68*53ee8cc1Swenshuai.xi // settled by arbitration referred to the Chinese Arbitration Association,
69*53ee8cc1Swenshuai.xi // Taipei in accordance with the ROC Arbitration Law and the Arbitration
70*53ee8cc1Swenshuai.xi // Rules of the Association by three (3) arbitrators appointed in accordance
71*53ee8cc1Swenshuai.xi // with the said Rules.
72*53ee8cc1Swenshuai.xi // The place of arbitration shall be in Taipei, Taiwan and the language shall
73*53ee8cc1Swenshuai.xi // be English.
74*53ee8cc1Swenshuai.xi // The arbitration award shall be final and binding to both parties.
75*53ee8cc1Swenshuai.xi //
76*53ee8cc1Swenshuai.xi //******************************************************************************
77*53ee8cc1Swenshuai.xi //<MStar Software>
78*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
79*53ee8cc1Swenshuai.xi //
80*53ee8cc1Swenshuai.xi // Copyright (c) 2006-2009 MStar Semiconductor, Inc.
81*53ee8cc1Swenshuai.xi // All rights reserved.
82*53ee8cc1Swenshuai.xi //
83*53ee8cc1Swenshuai.xi // Unless otherwise stipulated in writing, any and all information contained
84*53ee8cc1Swenshuai.xi // herein regardless in any format shall remain the sole proprietary of
85*53ee8cc1Swenshuai.xi // MStar Semiconductor Inc. and be kept in strict confidence
86*53ee8cc1Swenshuai.xi // (��MStar Confidential Information��) by the recipient.
87*53ee8cc1Swenshuai.xi // Any unauthorized act including without limitation unauthorized disclosure,
88*53ee8cc1Swenshuai.xi // copying, use, reproduction, sale, distribution, modification, disassembling,
89*53ee8cc1Swenshuai.xi // reverse engineering and compiling of the contents of MStar Confidential
90*53ee8cc1Swenshuai.xi // Information is unlawful and strictly prohibited. MStar hereby reserves the
91*53ee8cc1Swenshuai.xi // rights to any and all damages, losses, costs and expenses resulting therefrom.
92*53ee8cc1Swenshuai.xi //
93*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
94*53ee8cc1Swenshuai.xi
95*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
96*53ee8cc1Swenshuai.xi //
97*53ee8cc1Swenshuai.xi /// @file INTERN_DVBT.c
98*53ee8cc1Swenshuai.xi /// @brief INTERN_DVBT DVBT
99*53ee8cc1Swenshuai.xi /// @author MStar Semiconductor, Inc.
100*53ee8cc1Swenshuai.xi //
101*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
102*53ee8cc1Swenshuai.xi
103*53ee8cc1Swenshuai.xi #define _INTERN_DVBT_C_
104*53ee8cc1Swenshuai.xi #include <math.h>
105*53ee8cc1Swenshuai.xi #include "MsCommon.h"
106*53ee8cc1Swenshuai.xi #include "MsIRQ.h"
107*53ee8cc1Swenshuai.xi #include "MsOS.h"
108*53ee8cc1Swenshuai.xi //#include "apiPWS.h"
109*53ee8cc1Swenshuai.xi
110*53ee8cc1Swenshuai.xi #include "MsTypes.h"
111*53ee8cc1Swenshuai.xi #include "drvBDMA.h"
112*53ee8cc1Swenshuai.xi //#include "drvIIC.h"
113*53ee8cc1Swenshuai.xi //#include "msAPI_Tuner.h"
114*53ee8cc1Swenshuai.xi //#include "msAPI_MIU.h"
115*53ee8cc1Swenshuai.xi //#include "BinInfo.h"
116*53ee8cc1Swenshuai.xi //#include "halVif.h"
117*53ee8cc1Swenshuai.xi #include "drvDMD_INTERN_DVBC.h"
118*53ee8cc1Swenshuai.xi #include "halDMD_INTERN_DVBC.h"
119*53ee8cc1Swenshuai.xi #include "halDMD_INTERN_common.h"
120*53ee8cc1Swenshuai.xi #ifdef SUPPORT_AP_BIN_IN_FLASH_2
121*53ee8cc1Swenshuai.xi #include "InfoBlock.h"
122*53ee8cc1Swenshuai.xi #endif
123*53ee8cc1Swenshuai.xi #include "drvMMIO.h"
124*53ee8cc1Swenshuai.xi //#include "TDAG4D01A_SSI_DVBT.c"
125*53ee8cc1Swenshuai.xi #include "drvDMD_VD_MBX.h"
126*53ee8cc1Swenshuai.xi #define TEST_EMBEDED_DEMOD 0
127*53ee8cc1Swenshuai.xi //U8 load_data_variable=1;
128*53ee8cc1Swenshuai.xi //-----------------------------------------------------------------------
129*53ee8cc1Swenshuai.xi #define BIN_ID_INTERN_DVBC_DEMOD BIN_ID_INTERN_DVBC
130*53ee8cc1Swenshuai.xi
131*53ee8cc1Swenshuai.xi #define TDE_REG_BASE 0x2400
132*53ee8cc1Swenshuai.xi #define INNC_REG_BASE 0x2600
133*53ee8cc1Swenshuai.xi #define EQE_REG_BASE 0x2c00
134*53ee8cc1Swenshuai.xi #define EQE2_REG_BASE 0x2d00
135*53ee8cc1Swenshuai.xi
136*53ee8cc1Swenshuai.xi #ifdef MS_DEBUG
137*53ee8cc1Swenshuai.xi #define DBG_INTERN_DVBC(x) x
138*53ee8cc1Swenshuai.xi #define DBG_GET_SIGNAL_DVBC(x) x
139*53ee8cc1Swenshuai.xi #define DBG_INTERN_DVBC_TIME(x) x
140*53ee8cc1Swenshuai.xi #define DBG_INTERN_DVBC_LOCK(x) x
141*53ee8cc1Swenshuai.xi #define INTERN_DVBC_INTERNAL_DEBUG 0
142*53ee8cc1Swenshuai.xi #else
143*53ee8cc1Swenshuai.xi #define DBG_INTERN_DVBC(x) //x
144*53ee8cc1Swenshuai.xi #define DBG_GET_SIGNAL_DVBC(x) //x
145*53ee8cc1Swenshuai.xi #define DBG_INTERN_DVBC_TIME(x) //x
146*53ee8cc1Swenshuai.xi #define DBG_INTERN_DVBC_LOCK(x) //x
147*53ee8cc1Swenshuai.xi #define INTERN_DVBC_INTERNAL_DEBUG 0
148*53ee8cc1Swenshuai.xi #endif
149*53ee8cc1Swenshuai.xi #define DBG_DUMP_LOAD_DSP_TIME 0
150*53ee8cc1Swenshuai.xi
151*53ee8cc1Swenshuai.xi
152*53ee8cc1Swenshuai.xi #define SIGNAL_LEVEL_OFFSET 0.00f
153*53ee8cc1Swenshuai.xi #define TAKEOVERPOINT -60.0f
154*53ee8cc1Swenshuai.xi #define TAKEOVERRANGE 0.5f
155*53ee8cc1Swenshuai.xi #define LOG10_OFFSET -0.21f
156*53ee8cc1Swenshuai.xi #define INTERN_DVBC_USE_SAR_3_ENABLE 0
157*53ee8cc1Swenshuai.xi #define INTERN_DVBT_GET_TIME msAPI_Timer_GetTime0()
158*53ee8cc1Swenshuai.xi
159*53ee8cc1Swenshuai.xi #define TUNER_IF 5000
160*53ee8cc1Swenshuai.xi
161*53ee8cc1Swenshuai.xi #define TS_SER_C 0x00 //0: parallel 1:serial
162*53ee8cc1Swenshuai.xi
163*53ee8cc1Swenshuai.xi #if (INTERN_DVBC_TS_SERIAL_INVERSION)
164*53ee8cc1Swenshuai.xi #define TS_INV_C 0x01
165*53ee8cc1Swenshuai.xi #else
166*53ee8cc1Swenshuai.xi #define TS_INV_C 0x00
167*53ee8cc1Swenshuai.xi #endif
168*53ee8cc1Swenshuai.xi
169*53ee8cc1Swenshuai.xi #define DVBC_FS 48000
170*53ee8cc1Swenshuai.xi #define CFG_ZIF 0x00 //For ZIF ,FC=0
171*53ee8cc1Swenshuai.xi #define FC_H_C ( (DVBC_FS-TUNER_IF)>0 ? (((DVBC_FS-TUNER_IF)>>8)&0xFF) : (((TUNER_IF-DVBC_FS)>>8)&0xFF) )
172*53ee8cc1Swenshuai.xi #define FC_L_C ( (DVBC_FS-TUNER_IF)>0 ? (((DVBC_FS-TUNER_IF))&0xFF) : (((TUNER_IF-DVBC_FS))&0xFF) )
173*53ee8cc1Swenshuai.xi #define FS_H_C ((DVBC_FS>>8)&0xFF) // FS
174*53ee8cc1Swenshuai.xi #define FS_L_C (DVBC_FS&0xFF)
175*53ee8cc1Swenshuai.xi #define AUTO_SCAN_C 0x00 // Auto Scan - 0:channel change, 1:auto-scan
176*53ee8cc1Swenshuai.xi #define IQ_SWAP_C 0x00
177*53ee8cc1Swenshuai.xi #define PAL_I_C 0x00 // PAL_I: 0: Non-Pal-I CCI, 1: Pal-I CCI (for UK)
178*53ee8cc1Swenshuai.xi // Bxko 6875, 6900, 7000, 6125, 4000, 6950
179*53ee8cc1Swenshuai.xi // Symbol Rate: 6875 = 0x1ADB
180*53ee8cc1Swenshuai.xi // Symbol Rate: 6900 = 0x1AF4
181*53ee8cc1Swenshuai.xi // Symbol Rate: 7000 = 0x1B58
182*53ee8cc1Swenshuai.xi // Symbol Rate: 4000 = 0x0FA0
183*53ee8cc1Swenshuai.xi // Symbol Rate: 6125 = 0x17ED
184*53ee8cc1Swenshuai.xi #define SR0_H 0x1A
185*53ee8cc1Swenshuai.xi #define SR0_L 0xF4 //6900
186*53ee8cc1Swenshuai.xi #define SR1_H 0x1B
187*53ee8cc1Swenshuai.xi #define SR1_L 0x58 //7000
188*53ee8cc1Swenshuai.xi #define SR2_H 0x17
189*53ee8cc1Swenshuai.xi #define SR2_L 0xED //6125
190*53ee8cc1Swenshuai.xi #define SR3_H 0x0F
191*53ee8cc1Swenshuai.xi #define SR3_L 0xA0 //4000
192*53ee8cc1Swenshuai.xi #define SR4_H 0x1B
193*53ee8cc1Swenshuai.xi #define SR4_L 0x26 //6950
194*53ee8cc1Swenshuai.xi #define SR5_H 0x1A //0xDB
195*53ee8cc1Swenshuai.xi #define SR5_L 0xDB //0x1A //6875
196*53ee8cc1Swenshuai.xi #define SR6_H 0x1C
197*53ee8cc1Swenshuai.xi #define SR6_L 0x20 //7200
198*53ee8cc1Swenshuai.xi #define SR7_H 0x1C
199*53ee8cc1Swenshuai.xi #define SR7_L 0x52 //7250
200*53ee8cc1Swenshuai.xi #define SR8_H 0x0B
201*53ee8cc1Swenshuai.xi #define SR8_L 0xB8 //3000
202*53ee8cc1Swenshuai.xi #define SR9_H 0x03
203*53ee8cc1Swenshuai.xi #define SR9_L 0xE8 //1000
204*53ee8cc1Swenshuai.xi #define SR10_H 0x07
205*53ee8cc1Swenshuai.xi #define SR10_L 0xD0 //2000
206*53ee8cc1Swenshuai.xi #define SR11_H 0x00
207*53ee8cc1Swenshuai.xi #define SR11_L 0x00 //0000
208*53ee8cc1Swenshuai.xi
209*53ee8cc1Swenshuai.xi
210*53ee8cc1Swenshuai.xi #define QAM 0x04 // QAM: 0:16, 1:32, 2:64, 3:128, 4:256
211*53ee8cc1Swenshuai.xi
212*53ee8cc1Swenshuai.xi // SAR dependent
213*53ee8cc1Swenshuai.xi #define NO_SIGNAL_TH_A 0xA3
214*53ee8cc1Swenshuai.xi // Tuner dependent
215*53ee8cc1Swenshuai.xi #define NO_SIGNAL_TH_B_L 0xFF //0x00 , Gain
216*53ee8cc1Swenshuai.xi #define NO_SIGNAL_TH_B_H 0xFF //0xDD
217*53ee8cc1Swenshuai.xi #define NO_SIGNAL_TH_C_L 0xff //0x64 , Err
218*53ee8cc1Swenshuai.xi #define NO_SIGNAL_TH_C_H 0xff //0x00
219*53ee8cc1Swenshuai.xi #define DAGC1_REF 0x70
220*53ee8cc1Swenshuai.xi #define DAGC2_REF 0x30
221*53ee8cc1Swenshuai.xi #define AGC_REF_L 0x00
222*53ee8cc1Swenshuai.xi #define AGC_REF_H 0x06
223*53ee8cc1Swenshuai.xi
224*53ee8cc1Swenshuai.xi #define INTERN_AUTO_SR_C 1
225*53ee8cc1Swenshuai.xi #define INTERN_AUTO_QAM_C 1
226*53ee8cc1Swenshuai.xi
227*53ee8cc1Swenshuai.xi #define ATV_DET_EN 1
228*53ee8cc1Swenshuai.xi
229*53ee8cc1Swenshuai.xi
230*53ee8cc1Swenshuai.xi MS_U8 INTERN_DVBC_DSPREG[] =
231*53ee8cc1Swenshuai.xi {
232*53ee8cc1Swenshuai.xi 0x00, 0x00, 0x00, 0x01, 0x00, 0x01, 0x00, 0x01, AUTO_SCAN_C, INTERN_AUTO_SR_C, INTERN_AUTO_QAM_C, ATV_DET_EN, 0x00, 0x00, 0x01, 0x00, //00-0F
233*53ee8cc1Swenshuai.xi 0x00, 0x00, CFG_ZIF, FS_L_C, FS_H_C, 0x88, 0x13, FC_L_C, FC_H_C, SR0_L, SR0_H, SR1_L, SR1_H, SR2_L, SR2_H, SR3_L, //10-1F
234*53ee8cc1Swenshuai.xi SR3_H, SR4_L, SR4_H, SR5_L, SR5_H, SR6_L, SR6_H, SR7_L, SR7_H, SR8_L, SR8_H, SR9_L, SR9_H, SR10_L, SR10_H, SR11_L, //20-2F
235*53ee8cc1Swenshuai.xi SR11_H, 0x00, QAM, IQ_SWAP_C, PAL_I_C, TS_SER_C, 0x00, TS_INV_C, 0x00, 0x00, AGC_REF_L, AGC_REF_H, 0x90, 0xa0, 0x03, 0x05, //30-3F
236*53ee8cc1Swenshuai.xi 0x05, 0x40, 0x04, 0x13, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x7F, 0x00, NO_SIGNAL_TH_B_L, NO_SIGNAL_TH_B_H, NO_SIGNAL_TH_C_L, //40-4F
237*53ee8cc1Swenshuai.xi NO_SIGNAL_TH_C_H, 0x00, 0x00, 0x00, 0x00, 0x00, DAGC1_REF, DAGC2_REF, 0x73, 0x73, 0x73, 0x73, 0x73, 0x83, 0x83, 0x73, //50-5F
238*53ee8cc1Swenshuai.xi 0x62, 0x62, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //60-6C
239*53ee8cc1Swenshuai.xi };
240*53ee8cc1Swenshuai.xi
241*53ee8cc1Swenshuai.xi #define TS_SERIAL_OUTPUT_IF_CI_REMOVED 1 // _UTOPIA
242*53ee8cc1Swenshuai.xi
243*53ee8cc1Swenshuai.xi //-----------------------------------------------------------------------
244*53ee8cc1Swenshuai.xi /****************************************************************
245*53ee8cc1Swenshuai.xi *Local Variables *
246*53ee8cc1Swenshuai.xi ****************************************************************/
247*53ee8cc1Swenshuai.xi
248*53ee8cc1Swenshuai.xi //static MS_BOOL TPSLock = 0;
249*53ee8cc1Swenshuai.xi static MS_U32 u32ChkScanTimeStartDVBC = 0;
250*53ee8cc1Swenshuai.xi static MS_U8 g_dvbc_lock = 0;
251*53ee8cc1Swenshuai.xi static float intern_dvb_c_qam_ref[] = {3.0, 0.0, 0.0, 0.0, 0.0, 80.0}; //16q,32q,64q,128q,256q, and others
252*53ee8cc1Swenshuai.xi
253*53ee8cc1Swenshuai.xi //Global Variables
254*53ee8cc1Swenshuai.xi S_CMDPKTREG gsCmdPacketDVBC;
255*53ee8cc1Swenshuai.xi //MS_U8 gCalIdacCh0, gCalIdacCh1;
256*53ee8cc1Swenshuai.xi static MS_BOOL bDMD_DVBC_NoChannelDetectedWithRFPower = FALSE;
257*53ee8cc1Swenshuai.xi static MS_U32 u32DMD_DVBC_NoChannelTimeAccWithRFPower = 0;
258*53ee8cc1Swenshuai.xi #ifdef INTERN_DVBC_LOAD_FW_FROM_CODE_MEMORY
259*53ee8cc1Swenshuai.xi MS_U8 INTERN_DVBC_table[] = {
260*53ee8cc1Swenshuai.xi #include "fwDMD_INTERN_DVBC.dat"
261*53ee8cc1Swenshuai.xi };
262*53ee8cc1Swenshuai.xi
263*53ee8cc1Swenshuai.xi #endif
264*53ee8cc1Swenshuai.xi
265*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_Show_Demod_Version(void);
266*53ee8cc1Swenshuai.xi // MS_BOOL INTERN_DVBC_GetPostViterbiBer(float *ber);
267*53ee8cc1Swenshuai.xi // MS_BOOL INTERN_DVBC_GetPacketErr(MS_U16 *pktErr);
268*53ee8cc1Swenshuai.xi //MS_BOOL INTERN_DVBC_GetSNR(float *f_snr);
269*53ee8cc1Swenshuai.xi // MS_BOOL INTERN_DVBC_Get_FreqOffset(float *pFreqOff);
270*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_GetCurrentModulationType(DMD_DVBC_MODULATION_TYPE *pQAMMode);
271*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_GetCurrentSymbolRate(MS_U16 *u16SymbolRate);
272*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_GetCurrentSymbolRateOffset(MS_U16 *pData);
273*53ee8cc1Swenshuai.xi
274*53ee8cc1Swenshuai.xi #if (INTERN_DVBC_INTERNAL_DEBUG)
275*53ee8cc1Swenshuai.xi void INTERN_DVBC_info(void);
276*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_Show_AGC_Info(void);
277*53ee8cc1Swenshuai.xi #endif
278*53ee8cc1Swenshuai.xi
INTERN_DVBC_DSPReg_Init(const MS_U8 * u8DVBC_DSPReg,MS_U8 u8Size)279*53ee8cc1Swenshuai.xi MS_U16 INTERN_DVBC_DSPReg_Init(const MS_U8 *u8DVBC_DSPReg, MS_U8 u8Size)
280*53ee8cc1Swenshuai.xi {
281*53ee8cc1Swenshuai.xi MS_U8 idx = 0, u8RegRead = 0, u8RegWrite = 0, u8Mask = 0;
282*53ee8cc1Swenshuai.xi MS_U8 status = TRUE;
283*53ee8cc1Swenshuai.xi MS_U16 u16DspAddr = 0;
284*53ee8cc1Swenshuai.xi
285*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf("INTERN_DVBC_DSPReg_Init\n"));
286*53ee8cc1Swenshuai.xi
287*53ee8cc1Swenshuai.xi #if 0//def MS_DEBUG
288*53ee8cc1Swenshuai.xi {
289*53ee8cc1Swenshuai.xi MS_U8 u8buffer[256];
290*53ee8cc1Swenshuai.xi printf("INTERN_DVBC_DSPReg_Init Reset\n");
291*53ee8cc1Swenshuai.xi for (idx = 0; idx<sizeof(INTERN_DVBC_DSPREG); idx++)
292*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_WriteDSPReg(idx, 0);
293*53ee8cc1Swenshuai.xi
294*53ee8cc1Swenshuai.xi for (idx = 0; idx<sizeof(INTERN_DVBC_DSPREG); idx++)
295*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadDSPReg(idx, &(u8buffer[idx]));
296*53ee8cc1Swenshuai.xi printf("INTERN_DVBC_DSPReg_Init ReadBack, should be all 0\n");
297*53ee8cc1Swenshuai.xi for (idx = 0; idx<sizeof(INTERN_DVBC_DSPREG); idx++)
298*53ee8cc1Swenshuai.xi printf("%x ", u8buffer[idx]);
299*53ee8cc1Swenshuai.xi printf("\n");
300*53ee8cc1Swenshuai.xi
301*53ee8cc1Swenshuai.xi printf("INTERN_DVBC_DSPReg_Init Value\n");
302*53ee8cc1Swenshuai.xi for (idx = 0; idx<sizeof(INTERN_DVBC_DSPREG); idx++)
303*53ee8cc1Swenshuai.xi printf("%x ", INTERN_DVBC_DSPREG[idx]);
304*53ee8cc1Swenshuai.xi printf("\n");
305*53ee8cc1Swenshuai.xi }
306*53ee8cc1Swenshuai.xi #endif
307*53ee8cc1Swenshuai.xi
308*53ee8cc1Swenshuai.xi for (idx = 0; idx<sizeof(INTERN_DVBC_DSPREG); idx++)
309*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(idx, INTERN_DVBC_DSPREG[idx]);
310*53ee8cc1Swenshuai.xi
311*53ee8cc1Swenshuai.xi // readback to confirm.
312*53ee8cc1Swenshuai.xi #ifdef MS_DEBUG
313*53ee8cc1Swenshuai.xi for (idx = 0; idx<sizeof(INTERN_DVBC_DSPREG); idx++)
314*53ee8cc1Swenshuai.xi {
315*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadDSPReg(idx, &u8RegRead);
316*53ee8cc1Swenshuai.xi if (u8RegRead != INTERN_DVBC_DSPREG[idx])
317*53ee8cc1Swenshuai.xi {
318*53ee8cc1Swenshuai.xi printf("[Error]INTERN_DVBC_DSPReg_Init, idx=%d, drv_val=0x%x, firmware_val=0x%x\n",idx,INTERN_DVBC_DSPREG[idx],u8RegRead);
319*53ee8cc1Swenshuai.xi }
320*53ee8cc1Swenshuai.xi }
321*53ee8cc1Swenshuai.xi #endif
322*53ee8cc1Swenshuai.xi
323*53ee8cc1Swenshuai.xi if (u8DVBC_DSPReg != NULL)
324*53ee8cc1Swenshuai.xi {
325*53ee8cc1Swenshuai.xi if (1 == u8DVBC_DSPReg[0])
326*53ee8cc1Swenshuai.xi {
327*53ee8cc1Swenshuai.xi u8DVBC_DSPReg+=2;
328*53ee8cc1Swenshuai.xi for (idx = 0; idx<u8Size; idx++)
329*53ee8cc1Swenshuai.xi {
330*53ee8cc1Swenshuai.xi u16DspAddr = *u8DVBC_DSPReg;
331*53ee8cc1Swenshuai.xi u8DVBC_DSPReg++;
332*53ee8cc1Swenshuai.xi u16DspAddr = (u16DspAddr) + ((*u8DVBC_DSPReg)<<8);
333*53ee8cc1Swenshuai.xi u8DVBC_DSPReg++;
334*53ee8cc1Swenshuai.xi u8Mask = *u8DVBC_DSPReg;
335*53ee8cc1Swenshuai.xi u8DVBC_DSPReg++;
336*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadDSPReg(u16DspAddr, &u8RegRead);
337*53ee8cc1Swenshuai.xi u8RegWrite = (u8RegRead & (~u8Mask)) | ((*u8DVBC_DSPReg) & (u8Mask));
338*53ee8cc1Swenshuai.xi u8DVBC_DSPReg++;
339*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf("DSP addr:%x mask:%x read:%x write:%x\n", u16DspAddr, u8Mask, u8RegRead, u8RegWrite));
340*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(u16DspAddr, u8RegWrite);
341*53ee8cc1Swenshuai.xi }
342*53ee8cc1Swenshuai.xi }
343*53ee8cc1Swenshuai.xi else
344*53ee8cc1Swenshuai.xi {
345*53ee8cc1Swenshuai.xi printf("FATAL: parameter version incorrect\n");
346*53ee8cc1Swenshuai.xi }
347*53ee8cc1Swenshuai.xi }
348*53ee8cc1Swenshuai.xi
349*53ee8cc1Swenshuai.xi #if 0//def MS_DEBUG
350*53ee8cc1Swenshuai.xi {
351*53ee8cc1Swenshuai.xi MS_U8 u8buffer[256];
352*53ee8cc1Swenshuai.xi for (idx = 0; idx<sizeof(INTERN_DVBC_DSPREG); idx++)
353*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadDSPReg(idx, &(u8buffer[idx]));
354*53ee8cc1Swenshuai.xi printf("INTERN_DVBC_DSPReg_Init ReadBack\n");
355*53ee8cc1Swenshuai.xi for (idx = 0; idx<sizeof(INTERN_DVBC_DSPREG); idx++)
356*53ee8cc1Swenshuai.xi printf("%x ", u8buffer[idx]);
357*53ee8cc1Swenshuai.xi printf("\n");
358*53ee8cc1Swenshuai.xi }
359*53ee8cc1Swenshuai.xi #endif
360*53ee8cc1Swenshuai.xi
361*53ee8cc1Swenshuai.xi #if 0//def MS_DEBUG
362*53ee8cc1Swenshuai.xi {
363*53ee8cc1Swenshuai.xi MS_U8 u8buffer[256];
364*53ee8cc1Swenshuai.xi for (idx = 0; idx<128; idx++)
365*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(0x2380+idx, &(u8buffer[idx]));
366*53ee8cc1Swenshuai.xi printf("INTERN_DVBC_DSPReg_Init ReadReg 0x2000~0x207F\n");
367*53ee8cc1Swenshuai.xi for (idx = 0; idx<128; idx++)
368*53ee8cc1Swenshuai.xi {
369*53ee8cc1Swenshuai.xi printf("%x ", u8buffer[idx]);
370*53ee8cc1Swenshuai.xi if ((idx & 0xF) == 0xF) printf("\n");
371*53ee8cc1Swenshuai.xi }
372*53ee8cc1Swenshuai.xi printf("\n");
373*53ee8cc1Swenshuai.xi }
374*53ee8cc1Swenshuai.xi #endif
375*53ee8cc1Swenshuai.xi return status;
376*53ee8cc1Swenshuai.xi }
377*53ee8cc1Swenshuai.xi
378*53ee8cc1Swenshuai.xi /***********************************************************************************
379*53ee8cc1Swenshuai.xi Subject: Command Packet Interface
380*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_Cmd_Packet_Send
381*53ee8cc1Swenshuai.xi Parmeter:
382*53ee8cc1Swenshuai.xi Return: MS_BOOL
383*53ee8cc1Swenshuai.xi Remark:
384*53ee8cc1Swenshuai.xi ************************************************************************************/
INTERN_DVBC_Cmd_Packet_Send(S_CMDPKTREG * pCmdPacket,MS_U8 param_cnt)385*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_Cmd_Packet_Send(S_CMDPKTREG* pCmdPacket, MS_U8 param_cnt)
386*53ee8cc1Swenshuai.xi {
387*53ee8cc1Swenshuai.xi return TRUE;
388*53ee8cc1Swenshuai.xi }
389*53ee8cc1Swenshuai.xi
390*53ee8cc1Swenshuai.xi
391*53ee8cc1Swenshuai.xi /***********************************************************************************
392*53ee8cc1Swenshuai.xi Subject: Command Packet Interface
393*53ee8cc1Swenshuai.xi Function: INTERN_DVBT_Cmd_Packet_Exe_Check
394*53ee8cc1Swenshuai.xi Parmeter:
395*53ee8cc1Swenshuai.xi Return: MS_BOOL
396*53ee8cc1Swenshuai.xi Remark:
397*53ee8cc1Swenshuai.xi ************************************************************************************/
INTERN_DVBC_Cmd_Packet_Exe_Check(MS_BOOL * cmd_done)398*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_Cmd_Packet_Exe_Check(MS_BOOL* cmd_done)
399*53ee8cc1Swenshuai.xi {
400*53ee8cc1Swenshuai.xi return TRUE;
401*53ee8cc1Swenshuai.xi }
402*53ee8cc1Swenshuai.xi
403*53ee8cc1Swenshuai.xi /***********************************************************************************
404*53ee8cc1Swenshuai.xi Subject: SoftStop
405*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_SoftStop
406*53ee8cc1Swenshuai.xi Parmeter:
407*53ee8cc1Swenshuai.xi Return: MS_BOOL
408*53ee8cc1Swenshuai.xi Remark:
409*53ee8cc1Swenshuai.xi ************************************************************************************/
410*53ee8cc1Swenshuai.xi
INTERN_DVBC_SoftStop(void)411*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_SoftStop ( void )
412*53ee8cc1Swenshuai.xi {
413*53ee8cc1Swenshuai.xi #if 1
414*53ee8cc1Swenshuai.xi MS_U16 u8WaitCnt=0;
415*53ee8cc1Swenshuai.xi
416*53ee8cc1Swenshuai.xi if (HAL_DMD_RIU_ReadByte(MBRegBase + 0x00))
417*53ee8cc1Swenshuai.xi {
418*53ee8cc1Swenshuai.xi printf(">> MB Busy!\n");
419*53ee8cc1Swenshuai.xi return FALSE;
420*53ee8cc1Swenshuai.xi }
421*53ee8cc1Swenshuai.xi
422*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(MBRegBase + 0x00, 0xA5); // MB_CNTL set read mode
423*53ee8cc1Swenshuai.xi
424*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103483, 0x02); // assert interrupt to VD MCU51
425*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103483, 0x00); // de-assert interrupt to VD MCU51
426*53ee8cc1Swenshuai.xi
427*53ee8cc1Swenshuai.xi while(HAL_DMD_RIU_ReadByte(MBRegBase + 0x00)!= 0x5A) // wait MB_CNTL set done
428*53ee8cc1Swenshuai.xi {
429*53ee8cc1Swenshuai.xi #if TEST_EMBEDED_DEMOD
430*53ee8cc1Swenshuai.xi MsOS_DelayTask(1); // << Ken 20090629
431*53ee8cc1Swenshuai.xi #endif
432*53ee8cc1Swenshuai.xi if (u8WaitCnt++ >= 0x7FF)
433*53ee8cc1Swenshuai.xi {
434*53ee8cc1Swenshuai.xi printf(">> DVBT SoftStop Fail!\n");
435*53ee8cc1Swenshuai.xi return FALSE;
436*53ee8cc1Swenshuai.xi }
437*53ee8cc1Swenshuai.xi }
438*53ee8cc1Swenshuai.xi
439*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x103460, 0x01); // reset VD_MCU
440*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(MBRegBase + 0x00, 0x00); // MB_CNTL clear
441*53ee8cc1Swenshuai.xi #endif
442*53ee8cc1Swenshuai.xi return TRUE;
443*53ee8cc1Swenshuai.xi }
444*53ee8cc1Swenshuai.xi
445*53ee8cc1Swenshuai.xi
446*53ee8cc1Swenshuai.xi /***********************************************************************************
447*53ee8cc1Swenshuai.xi Subject: Reset
448*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_Reset
449*53ee8cc1Swenshuai.xi Parmeter:
450*53ee8cc1Swenshuai.xi Return: MS_BOOL
451*53ee8cc1Swenshuai.xi Remark:
452*53ee8cc1Swenshuai.xi ************************************************************************************/
453*53ee8cc1Swenshuai.xi extern void HAL_SYS_DMD_VD_MBX_DVB_WaitHandShake(void);
INTERN_DVBC_Reset(void)454*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_Reset ( void )
455*53ee8cc1Swenshuai.xi {
456*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf(" @INTERN_DVBC_reset\n"));
457*53ee8cc1Swenshuai.xi
458*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC_TIME(printf("INTERN_DVBC_Reset, t = %ld\n",MsOS_GetSystemTime()));
459*53ee8cc1Swenshuai.xi
460*53ee8cc1Swenshuai.xi INTERN_DVBC_SoftStop();
461*53ee8cc1Swenshuai.xi
462*53ee8cc1Swenshuai.xi
463*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(DMDMcuBase + 0x00, 0x01); // reset DMD_MCU
464*53ee8cc1Swenshuai.xi //MDrv_SYS_DMD_VD_MBX_WriteReg(0x2002, 0x72); // reset DVB-T
465*53ee8cc1Swenshuai.xi MsOS_DelayTask(5);
466*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(MBRegBase + 0x00 , 0x00); // clear MB_CNTL
467*53ee8cc1Swenshuai.xi // MDrv_SYS_DMD_VD_MBX_WriteReg(0x2002, 0x52);
468*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(DMDMcuBase + 0x00, 0x00);
469*53ee8cc1Swenshuai.xi MsOS_DelayTask(5);
470*53ee8cc1Swenshuai.xi
471*53ee8cc1Swenshuai.xi HAL_SYS_DMD_VD_MBX_DVB_WaitHandShake();
472*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(MBRegBase + 0x00 , 0x00);
473*53ee8cc1Swenshuai.xi
474*53ee8cc1Swenshuai.xi u32ChkScanTimeStartDVBC = MsOS_GetSystemTime();
475*53ee8cc1Swenshuai.xi g_dvbc_lock = 0;
476*53ee8cc1Swenshuai.xi
477*53ee8cc1Swenshuai.xi return TRUE;
478*53ee8cc1Swenshuai.xi }
479*53ee8cc1Swenshuai.xi
480*53ee8cc1Swenshuai.xi /***********************************************************************************
481*53ee8cc1Swenshuai.xi Subject: Exit
482*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_Exit
483*53ee8cc1Swenshuai.xi Parmeter:
484*53ee8cc1Swenshuai.xi Return: MS_BOOL
485*53ee8cc1Swenshuai.xi Remark:
486*53ee8cc1Swenshuai.xi ************************************************************************************/
INTERN_DVBC_Exit(void)487*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_Exit ( void )
488*53ee8cc1Swenshuai.xi {
489*53ee8cc1Swenshuai.xi
490*53ee8cc1Swenshuai.xi INTERN_DVBC_SoftStop();
491*53ee8cc1Swenshuai.xi
492*53ee8cc1Swenshuai.xi return TRUE;
493*53ee8cc1Swenshuai.xi }
494*53ee8cc1Swenshuai.xi
495*53ee8cc1Swenshuai.xi /***********************************************************************************
496*53ee8cc1Swenshuai.xi Subject: Load DSP code to chip
497*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_LoadDSPCode
498*53ee8cc1Swenshuai.xi Parmeter:
499*53ee8cc1Swenshuai.xi Return: MS_BOOL
500*53ee8cc1Swenshuai.xi Remark:
501*53ee8cc1Swenshuai.xi ************************************************************************************/
INTERN_DVBC_LoadDSPCode(void)502*53ee8cc1Swenshuai.xi static MS_BOOL INTERN_DVBC_LoadDSPCode(void)
503*53ee8cc1Swenshuai.xi {
504*53ee8cc1Swenshuai.xi MS_U8 udata = 0x00;
505*53ee8cc1Swenshuai.xi MS_U16 i;
506*53ee8cc1Swenshuai.xi MS_U16 fail_cnt=0;
507*53ee8cc1Swenshuai.xi
508*53ee8cc1Swenshuai.xi #if (DBG_DUMP_LOAD_DSP_TIME==1)
509*53ee8cc1Swenshuai.xi MS_U32 u32Time;
510*53ee8cc1Swenshuai.xi #endif
511*53ee8cc1Swenshuai.xi
512*53ee8cc1Swenshuai.xi
513*53ee8cc1Swenshuai.xi #ifndef INTERN_DVBC_LOAD_FW_FROM_CODE_MEMORY
514*53ee8cc1Swenshuai.xi BININFO BinInfo;
515*53ee8cc1Swenshuai.xi MS_BOOL bResult;
516*53ee8cc1Swenshuai.xi MS_U32 u32GEAddr;
517*53ee8cc1Swenshuai.xi MS_U8 Data;
518*53ee8cc1Swenshuai.xi MS_S8 op;
519*53ee8cc1Swenshuai.xi MS_U32 srcaddr;
520*53ee8cc1Swenshuai.xi MS_U32 len;
521*53ee8cc1Swenshuai.xi MS_U32 SizeBy4K;
522*53ee8cc1Swenshuai.xi MS_U16 u16Counter=0;
523*53ee8cc1Swenshuai.xi MS_U8 *pU8Data;
524*53ee8cc1Swenshuai.xi #endif
525*53ee8cc1Swenshuai.xi
526*53ee8cc1Swenshuai.xi
527*53ee8cc1Swenshuai.xi
528*53ee8cc1Swenshuai.xi // MDrv_Sys_DisableWatchDog();
529*53ee8cc1Swenshuai.xi
530*53ee8cc1Swenshuai.xi
531*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(DMDMcuBase + 0x00, 0x01); // reset VD_MCU
532*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(DMDMcuBase + 0x01, 0x00); // disable SRAM
533*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(DMDMcuBase + 0x03, 0x50); // enable "vdmcu51_if"
534*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(DMDMcuBase + 0x03, 0x51); // enable auto-increase
535*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(DMDMcuBase + 0x04, 0x00); // sram address low byte
536*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(DMDMcuBase + 0x05, 0x00); // sram address high byte
537*53ee8cc1Swenshuai.xi
538*53ee8cc1Swenshuai.xi //// Load code thru VDMCU_IF ////
539*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf(">Load Code.....\n"));
540*53ee8cc1Swenshuai.xi #ifdef INTERN_DVBC_LOAD_FW_FROM_CODE_MEMORY
541*53ee8cc1Swenshuai.xi for ( i = 0; i < sizeof(INTERN_DVBC_table); i++)
542*53ee8cc1Swenshuai.xi {
543*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(DMDMcuBase + 0x0C, INTERN_DVBC_table[i]); // write data to VD MCU 51 code sram
544*53ee8cc1Swenshuai.xi }
545*53ee8cc1Swenshuai.xi #else
546*53ee8cc1Swenshuai.xi BinInfo.B_ID = BIN_ID_INTERN_DVBC_DEMOD;
547*53ee8cc1Swenshuai.xi msAPI_MIU_Get_BinInfo(&BinInfo, &bResult);
548*53ee8cc1Swenshuai.xi if ( bResult != PASS )
549*53ee8cc1Swenshuai.xi {
550*53ee8cc1Swenshuai.xi return FALSE;
551*53ee8cc1Swenshuai.xi }
552*53ee8cc1Swenshuai.xi //printf("\t DEMOD_MEM_ADR =%08LX\n", ((DEMOD_MEM_ADR & MIU1) ? (DEMOD_MEM_ADR | MIU_INTERVAL) : (DEMOD_MEM_ADR)));
553*53ee8cc1Swenshuai.xi
554*53ee8cc1Swenshuai.xi #ifdef SUPPORT_AP_BIN_IN_FLASH_2
555*53ee8cc1Swenshuai.xi InfoBlock_Flash_2_Checking_Start(&BinInfo);
556*53ee8cc1Swenshuai.xi #endif
557*53ee8cc1Swenshuai.xi
558*53ee8cc1Swenshuai.xi #if OBA2
559*53ee8cc1Swenshuai.xi MApi_BDMA_CopyFromResource(BinInfo.B_FAddr, _PA2VA((DEMOD_MEM_MEMORY_TYPE & MIU1) ? (DEMOD_MEM_ADR | MIU_INTERVAL) : (DEMOD_MEM_ADR)), MemAlign(BinInfo.B_Len, 8));
560*53ee8cc1Swenshuai.xi #else
561*53ee8cc1Swenshuai.xi msAPI_MIU_Copy(BinInfo.B_FAddr, ((DEMOD_MEM_MEMORY_TYPE & MIU1) ? (DEMOD_MEM_ADR | MIU_INTERVAL) : (DEMOD_MEM_ADR)), MemAlign(BinInfo.B_Len, 8), MIU_FLASH2SDRAM);
562*53ee8cc1Swenshuai.xi #endif
563*53ee8cc1Swenshuai.xi
564*53ee8cc1Swenshuai.xi #ifdef SUPPORT_AP_BIN_IN_FLASH_2
565*53ee8cc1Swenshuai.xi InfoBlock_Flash_2_Checking_End(&BinInfo);
566*53ee8cc1Swenshuai.xi #endif
567*53ee8cc1Swenshuai.xi
568*53ee8cc1Swenshuai.xi //W1BaseAddr = MDrv_Sys_GetXdataWindow1Base();
569*53ee8cc1Swenshuai.xi SizeBy4K=BinInfo.B_Len/0x1000;
570*53ee8cc1Swenshuai.xi //printf("\t RRR: SizeBy4K=%d (L=%d)\n", SizeBy4K,BinInfo.B_Len);
571*53ee8cc1Swenshuai.xi
572*53ee8cc1Swenshuai.xi #if (DBG_DUMP_LOAD_DSP_TIME==1)
573*53ee8cc1Swenshuai.xi u32Time = msAPI_Timer_GetTime0();
574*53ee8cc1Swenshuai.xi #endif
575*53ee8cc1Swenshuai.xi
576*53ee8cc1Swenshuai.xi u32GEAddr = _PA2VA(((DEMOD_MEM_MEMORY_TYPE & MIU1) ? (DEMOD_MEM_ADR | MIU_INTERVAL) : (DEMOD_MEM_ADR)));
577*53ee8cc1Swenshuai.xi
578*53ee8cc1Swenshuai.xi for (i=0;i<=SizeBy4K;i++)
579*53ee8cc1Swenshuai.xi {
580*53ee8cc1Swenshuai.xi if(i==SizeBy4K)
581*53ee8cc1Swenshuai.xi len=BinInfo.B_Len%0x1000;
582*53ee8cc1Swenshuai.xi else
583*53ee8cc1Swenshuai.xi len=0x1000;
584*53ee8cc1Swenshuai.xi
585*53ee8cc1Swenshuai.xi srcaddr = u32GEAddr+(0x1000*i);
586*53ee8cc1Swenshuai.xi //printf("\t i = %08X\n", i);
587*53ee8cc1Swenshuai.xi //printf("\t len = %08X\n", len);
588*53ee8cc1Swenshuai.xi op = 1;
589*53ee8cc1Swenshuai.xi u16Counter = 0 ;
590*53ee8cc1Swenshuai.xi //printf("\t (B=0x%x)(Src=0x%x)Data =",i,srcaddr);
591*53ee8cc1Swenshuai.xi while(len--)
592*53ee8cc1Swenshuai.xi {
593*53ee8cc1Swenshuai.xi u16Counter ++ ;
594*53ee8cc1Swenshuai.xi //printf("file: %s, line: %d\n", __FILE__, __LINE__);
595*53ee8cc1Swenshuai.xi //pU8Data = (MS_U8 *)(srcaddr|0x80000000);
596*53ee8cc1Swenshuai.xi #if OBA2
597*53ee8cc1Swenshuai.xi pU8Data = (MS_U8 *)(srcaddr);
598*53ee8cc1Swenshuai.xi #else
599*53ee8cc1Swenshuai.xi pU8Data = (MS_U8 *)(srcaddr|0x80000000);
600*53ee8cc1Swenshuai.xi #endif
601*53ee8cc1Swenshuai.xi Data = *pU8Data;
602*53ee8cc1Swenshuai.xi
603*53ee8cc1Swenshuai.xi #if 0
604*53ee8cc1Swenshuai.xi if(u16Counter < 0x100)
605*53ee8cc1Swenshuai.xi printf("0x%bx,", Data);
606*53ee8cc1Swenshuai.xi #endif
607*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(DMDMcuBase + 0x0C, Data); // write data to VD MCU 51 code sram
608*53ee8cc1Swenshuai.xi
609*53ee8cc1Swenshuai.xi srcaddr += op;
610*53ee8cc1Swenshuai.xi }
611*53ee8cc1Swenshuai.xi // printf("\n\n\n");
612*53ee8cc1Swenshuai.xi }
613*53ee8cc1Swenshuai.xi
614*53ee8cc1Swenshuai.xi #if (DBG_DUMP_LOAD_DSP_TIME==1)
615*53ee8cc1Swenshuai.xi printf("------> INTERN_DVBC Load DSP Time: (%lu)\n", msAPI_Timer_DiffTimeFromNow(u32Time)) ;
616*53ee8cc1Swenshuai.xi #endif
617*53ee8cc1Swenshuai.xi
618*53ee8cc1Swenshuai.xi #endif
619*53ee8cc1Swenshuai.xi
620*53ee8cc1Swenshuai.xi //// Content verification ////
621*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf(">Verify Code...\n"));
622*53ee8cc1Swenshuai.xi
623*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(DMDMcuBase + 0x04, 0x00); // sram address low byte
624*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(DMDMcuBase + 0x05, 0x00); // sram address high byte
625*53ee8cc1Swenshuai.xi
626*53ee8cc1Swenshuai.xi #ifdef INTERN_DVBC_LOAD_FW_FROM_CODE_MEMORY
627*53ee8cc1Swenshuai.xi for ( i = 0; i < sizeof(INTERN_DVBC_table); i++)
628*53ee8cc1Swenshuai.xi {
629*53ee8cc1Swenshuai.xi udata = HAL_DMD_RIU_ReadByte(DMDMcuBase + 0x10); // read sram data
630*53ee8cc1Swenshuai.xi if (udata != INTERN_DVBC_table[i])
631*53ee8cc1Swenshuai.xi {
632*53ee8cc1Swenshuai.xi printf(">fail add = 0x%x\n", i);
633*53ee8cc1Swenshuai.xi printf(">code = 0x%x\n", INTERN_DVBC_table[i]);
634*53ee8cc1Swenshuai.xi printf(">data = 0x%x\n", udata);
635*53ee8cc1Swenshuai.xi
636*53ee8cc1Swenshuai.xi if (fail_cnt > 10)
637*53ee8cc1Swenshuai.xi {
638*53ee8cc1Swenshuai.xi printf(">DVB-C DSP Loadcode fail!");
639*53ee8cc1Swenshuai.xi return false;
640*53ee8cc1Swenshuai.xi }
641*53ee8cc1Swenshuai.xi fail_cnt++;
642*53ee8cc1Swenshuai.xi }
643*53ee8cc1Swenshuai.xi }
644*53ee8cc1Swenshuai.xi #else
645*53ee8cc1Swenshuai.xi for (i=0;i<=SizeBy4K;i++)
646*53ee8cc1Swenshuai.xi {
647*53ee8cc1Swenshuai.xi if(i==SizeBy4K)
648*53ee8cc1Swenshuai.xi len=BinInfo.B_Len%0x1000;
649*53ee8cc1Swenshuai.xi else
650*53ee8cc1Swenshuai.xi len=0x1000;
651*53ee8cc1Swenshuai.xi
652*53ee8cc1Swenshuai.xi srcaddr = u32GEAddr+(0x1000*i);
653*53ee8cc1Swenshuai.xi //printf("\t i = %08LX\n", i);
654*53ee8cc1Swenshuai.xi //printf("\t len = %08LX\n", len);
655*53ee8cc1Swenshuai.xi op = 1;
656*53ee8cc1Swenshuai.xi u16Counter = 0 ;
657*53ee8cc1Swenshuai.xi //printf("\t (B=0x%bx)(Src=0x%x)Data =",i,srcaddr);
658*53ee8cc1Swenshuai.xi while(len--)
659*53ee8cc1Swenshuai.xi {
660*53ee8cc1Swenshuai.xi u16Counter ++ ;
661*53ee8cc1Swenshuai.xi //printf("file: %s, line: %d\n", __FILE__, __LINE__);
662*53ee8cc1Swenshuai.xi //pU8Data = (MS_U8 *)(srcaddr|0x80000000);
663*53ee8cc1Swenshuai.xi #if OBA2
664*53ee8cc1Swenshuai.xi pU8Data = (MS_U8 *)(srcaddr);
665*53ee8cc1Swenshuai.xi #else
666*53ee8cc1Swenshuai.xi pU8Data = (MS_U8 *)(srcaddr|0x80000000);
667*53ee8cc1Swenshuai.xi #endif
668*53ee8cc1Swenshuai.xi Data = *pU8Data;
669*53ee8cc1Swenshuai.xi
670*53ee8cc1Swenshuai.xi #if 0
671*53ee8cc1Swenshuai.xi if(u16Counter < 0x100)
672*53ee8cc1Swenshuai.xi printf("0x%bx,", Data);
673*53ee8cc1Swenshuai.xi #endif
674*53ee8cc1Swenshuai.xi udata = HAL_DMD_RIU_ReadByte(DMDMcuBase + 0x10); // read sram data
675*53ee8cc1Swenshuai.xi if (udata != Data)
676*53ee8cc1Swenshuai.xi {
677*53ee8cc1Swenshuai.xi printf(">fail add = 0x%lx\n", (MS_U32)((i*0x1000)+(0x1000-len)));
678*53ee8cc1Swenshuai.xi printf(">code = 0x%x\n", Data);
679*53ee8cc1Swenshuai.xi printf(">data = 0x%x\n", udata);
680*53ee8cc1Swenshuai.xi
681*53ee8cc1Swenshuai.xi if (fail_cnt++ > 10)
682*53ee8cc1Swenshuai.xi {
683*53ee8cc1Swenshuai.xi printf(">DVB-C DSP Loadcode fail!");
684*53ee8cc1Swenshuai.xi return false;
685*53ee8cc1Swenshuai.xi }
686*53ee8cc1Swenshuai.xi }
687*53ee8cc1Swenshuai.xi
688*53ee8cc1Swenshuai.xi srcaddr += op;
689*53ee8cc1Swenshuai.xi }
690*53ee8cc1Swenshuai.xi // printf("\n\n\n");
691*53ee8cc1Swenshuai.xi }
692*53ee8cc1Swenshuai.xi #endif
693*53ee8cc1Swenshuai.xi
694*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(DMDMcuBase + 0x03, 0x50); // diable auto-increase
695*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(DMDMcuBase + 0x03, 0x00); // disable "vdmcu51_if"
696*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(DMDMcuBase + 0x01, 0x01); // enable SRAM
697*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(DMDMcuBase + 0x00, 0x00); // release VD_MCU
698*53ee8cc1Swenshuai.xi
699*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf(">DSP Loadcode done."));
700*53ee8cc1Swenshuai.xi
701*53ee8cc1Swenshuai.xi
702*53ee8cc1Swenshuai.xi return TRUE;
703*53ee8cc1Swenshuai.xi }
704*53ee8cc1Swenshuai.xi
705*53ee8cc1Swenshuai.xi /***********************************************************************************
706*53ee8cc1Swenshuai.xi Subject: DVB-T CLKGEN initialized function
707*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_Power_On_Initialization
708*53ee8cc1Swenshuai.xi Parmeter:
709*53ee8cc1Swenshuai.xi Return: MS_BOOL
710*53ee8cc1Swenshuai.xi Remark:
711*53ee8cc1Swenshuai.xi ************************************************************************************/
INTERN_DVBC_InitClkgen(MS_BOOL bRFAGCTristateEnable)712*53ee8cc1Swenshuai.xi void INTERN_DVBC_InitClkgen(MS_BOOL bRFAGCTristateEnable)
713*53ee8cc1Swenshuai.xi {
714*53ee8cc1Swenshuai.xi MS_U8 temp_val;
715*53ee8cc1Swenshuai.xi //move to drvSYS MS_U8 tmp;
716*53ee8cc1Swenshuai.xi // MS_U8 udatatemp = 0x00;
717*53ee8cc1Swenshuai.xi /************************************************************************
718*53ee8cc1Swenshuai.xi * T10 U01
719*53ee8cc1Swenshuai.xi * This bit0 is mux for DMD muc and HK,
720*53ee8cc1Swenshuai.xi * bit0: 0:HK can rw bank 0x1120, 1: DMD mcu can rw bank 0x1120;
721*53ee8cc1Swenshuai.xi ************************************************************************/
722*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x101E39, 0x00); //mux from DMD MCU to HK.
723*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x112003, (HAL_DMD_RIU_ReadByte(0x112003)&(~(BIT(5))))); // Release Ana misc resest
724*53ee8cc1Swenshuai.xi // CLK_DMDMCU clock setting
725*53ee8cc1Swenshuai.xi // [0] disable clock
726*53ee8cc1Swenshuai.xi // [1] invert clock
727*53ee8cc1Swenshuai.xi // [4:2]
728*53ee8cc1Swenshuai.xi // 000:170 MHz(MPLL_DIV_BUf)
729*53ee8cc1Swenshuai.xi // 001:160MHz
730*53ee8cc1Swenshuai.xi // 010:144MHz
731*53ee8cc1Swenshuai.xi // 011:123MHz
732*53ee8cc1Swenshuai.xi // 100:108MHz
733*53ee8cc1Swenshuai.xi // 101:mem_clcok
734*53ee8cc1Swenshuai.xi // 110:mem_clock div 2
735*53ee8cc1Swenshuai.xi // 111:select XTAL
736*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x10331f,0x00);
737*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x10331e,0x10);
738*53ee8cc1Swenshuai.xi
739*53ee8cc1Swenshuai.xi // set parallet ts clock
740*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN1>>1)+7'h00, 2'b11, 16'h0511);
741*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN1>>1)+7'h00, 2'b11, 16'h0511);
742*53ee8cc1Swenshuai.xi // wriu 0x103301 0x06
743*53ee8cc1Swenshuai.xi // wriu 0x103300 0x19
744*53ee8cc1Swenshuai.xi
745*53ee8cc1Swenshuai.xi
746*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x103301,0x07);//0x060b,7.2M
747*53ee8cc1Swenshuai.xi temp_val=HAL_DMD_RIU_ReadByte(0x103301);
748*53ee8cc1Swenshuai.xi temp_val|=0x07;
749*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103301,temp_val);
750*53ee8cc1Swenshuai.xi
751*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103300,0x13);
752*53ee8cc1Swenshuai.xi
753*53ee8cc1Swenshuai.xi // enable atsc, DVBTC ts clock
754*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN1>>1)+7'h04, 2'b11, 16'h0000);
755*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN1>>1)+7'h04, 2'b11, 16'h0000);
756*53ee8cc1Swenshuai.xi // wriu 0x103309 0x00
757*53ee8cc1Swenshuai.xi // wriu 0x103308 0x00
758*53ee8cc1Swenshuai.xi
759*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103309,0x00);
760*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103308,0x00);
761*53ee8cc1Swenshuai.xi
762*53ee8cc1Swenshuai.xi // enable dvbc adc clock
763*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN1>>1)+7'h0a, 2'b11, 16'h0000);
764*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN1>>1)+7'h0a, 2'b11, 16'h0000);
765*53ee8cc1Swenshuai.xi // wriu 0x103315 0x00
766*53ee8cc1Swenshuai.xi // wriu 0x103314 0x00
767*53ee8cc1Swenshuai.xi
768*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103315,0x00);
769*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103314,0x00);
770*53ee8cc1Swenshuai.xi
771*53ee8cc1Swenshuai.xi // enable vif DAC clock
772*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN1>>1)+7'h0d, 2'b11, 16'h0000);
773*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN1>>1)+7'h0d, 2'b11, 16'h0000);
774*53ee8cc1Swenshuai.xi // wriu 0x10331b 0x00
775*53ee8cc1Swenshuai.xi // wriu 0x10331a 0x00
776*53ee8cc1Swenshuai.xi
777*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x10331b,0x00);
778*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x10331a,0x00);
779*53ee8cc1Swenshuai.xi
780*53ee8cc1Swenshuai.xi // Select MPLLDIV2
781*53ee8cc1Swenshuai.xi // [0] : reg_atsc_adc_sel_mplldiv2
782*53ee8cc1Swenshuai.xi // [1] : reg_atsc_eq_sel_mplldiv2
783*53ee8cc1Swenshuai.xi // [2] : reg_eq25_sel_mplldiv3
784*53ee8cc1Swenshuai.xi // [3] : reg_p4_cfo_sel_eq25
785*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_DMD_TOP>>1)+7'h14, 2'b01, 16'h0003);
786*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_DMD_TOP>>1)+7'h14, 2'b01, 16'h0003);
787*53ee8cc1Swenshuai.xi // wriu 0x112028 0x03
788*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f28,0x04);
789*53ee8cc1Swenshuai.xi
790*53ee8cc1Swenshuai.xi
791*53ee8cc1Swenshuai.xi // Select MPLLDIV2
792*53ee8cc1Swenshuai.xi // [0] : reg_fed_srd_on
793*53ee8cc1Swenshuai.xi // [1] : reg_dvbt_new_tdsfo_on
794*53ee8cc1Swenshuai.xi // [2] : reg_dvbc_p4_cfo_on
795*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_DMD_TOP>>1)+7'h15, 2'b01, 16'h0001);
796*53ee8cc1Swenshuai.xi // wriu 0x111f2a 0x01
797*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f2a,0x01);
798*53ee8cc1Swenshuai.xi
799*53ee8cc1Swenshuai.xi
800*53ee8cc1Swenshuai.xi // *** Set register at CLKGEN_DMD
801*53ee8cc1Swenshuai.xi // enable atsc clock
802*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h01, 2'b11, 16'h0404);
803*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h01, 2'b11, 16'h0404);
804*53ee8cc1Swenshuai.xi // wriu 0x111f03 0x04
805*53ee8cc1Swenshuai.xi // wriu 0x111f02 0x04
806*53ee8cc1Swenshuai.xi
807*53ee8cc1Swenshuai.xi // HAL_DMD_RIU_WriteByte(0x111f03,0x00);
808*53ee8cc1Swenshuai.xi // HAL_DMD_RIU_WriteByte(0x111f02,0x00);
809*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f03,0x04);
810*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f02,0x04);
811*53ee8cc1Swenshuai.xi
812*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h02, 2'b11, 16'h0000);
813*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h02, 2'b11, 16'h0000);
814*53ee8cc1Swenshuai.xi // wriu 0x111f05 0x00
815*53ee8cc1Swenshuai.xi // wriu 0x111f04 0x00
816*53ee8cc1Swenshuai.xi
817*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f05,0x00);
818*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f04,0x00);
819*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h03, 2'b11, 16'h0404);
820*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h03, 2'b11, 16'h0404);
821*53ee8cc1Swenshuai.xi // wriu 0x111f07 0x04
822*53ee8cc1Swenshuai.xi // wriu 0x111f06 0x04
823*53ee8cc1Swenshuai.xi
824*53ee8cc1Swenshuai.xi // HAL_DMD_RIU_WriteByte(0x111f07,0x00);
825*53ee8cc1Swenshuai.xi // HAL_DMD_RIU_WriteByte(0x111f06,0x00);
826*53ee8cc1Swenshuai.xi
827*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f07,0x04);
828*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f06,0x00);
829*53ee8cc1Swenshuai.xi
830*53ee8cc1Swenshuai.xi // enable clk_atsc_adcd_sync
831*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h05, 2'b11, 16'h0000);
832*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h05, 2'b11, 16'h0000);
833*53ee8cc1Swenshuai.xi // wriu 0x111f0b 0x00
834*53ee8cc1Swenshuai.xi // wriu 0x111f0a 0x00
835*53ee8cc1Swenshuai.xi
836*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f0b,0x00);
837*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f0a,0x00);
838*53ee8cc1Swenshuai.xi
839*53ee8cc1Swenshuai.xi // enable dvbt inner clock
840*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h06, 2'b11, 16'h0000);
841*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h06, 2'b11, 16'h0000);
842*53ee8cc1Swenshuai.xi // wriu 0x111f0d 0x00
843*53ee8cc1Swenshuai.xi // wriu 0x111f0c 0x00
844*53ee8cc1Swenshuai.xi
845*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f0d,0x00);
846*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f0c,0x00);
847*53ee8cc1Swenshuai.xi
848*53ee8cc1Swenshuai.xi // enable dvbt inner clock
849*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h07, 2'b11, 16'h0000);
850*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h07, 2'b11, 16'h0000);
851*53ee8cc1Swenshuai.xi // wriu 0x111f0f 0x00
852*53ee8cc1Swenshuai.xi // wriu 0x111f0e 0x00
853*53ee8cc1Swenshuai.xi
854*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f0f,0x00);
855*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f0e,0x00);
856*53ee8cc1Swenshuai.xi
857*53ee8cc1Swenshuai.xi // enable dvbt inner clock
858*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h08, 2'b11, 16'h0000);
859*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h08, 2'b11, 16'h0000);
860*53ee8cc1Swenshuai.xi // wriu 0x111f11 0x00
861*53ee8cc1Swenshuai.xi // wriu 0x111f10 0x00
862*53ee8cc1Swenshuai.xi
863*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f11,0x00);
864*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f10,0x00);
865*53ee8cc1Swenshuai.xi
866*53ee8cc1Swenshuai.xi // enable dvbc outer clock
867*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h09, 2'b11, 16'h0000);
868*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h09, 2'b11, 16'h0000);
869*53ee8cc1Swenshuai.xi // wriu 0x111f13 0x00
870*53ee8cc1Swenshuai.xi // wriu 0x111f12 0x00
871*53ee8cc1Swenshuai.xi
872*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f13,0x00);
873*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f12,0x00);
874*53ee8cc1Swenshuai.xi
875*53ee8cc1Swenshuai.xi // enable dvbc inner-c clock
876*53ee8cc1Swenshuai.xi // [11:8]: reg_ckg_dvbtc_innc
877*53ee8cc1Swenshuai.xi // [0] : disable clock
878*53ee8cc1Swenshuai.xi // [1] : invert clock
879*53ee8cc1Swenshuai.xi // [3:2]: Select clock source
880*53ee8cc1Swenshuai.xi // 00: clk_dmdadc
881*53ee8cc1Swenshuai.xi // 01: reserved
882*53ee8cc1Swenshuai.xi // 10: reserved
883*53ee8cc1Swenshuai.xi // 11: DFT_CLK
884*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h0a, 2'b11, 16'h0000);
885*53ee8cc1Swenshuai.xi
886*53ee8cc1Swenshuai.xi
887*53ee8cc1Swenshuai.xi
888*53ee8cc1Swenshuai.xi // enable dvbc eq
889*53ee8cc1Swenshuai.xi // [3:0] : reg_ckg_dvbtc_eq8x
890*53ee8cc1Swenshuai.xi // [0] : disable clock
891*53ee8cc1Swenshuai.xi // [1] : invert clock
892*53ee8cc1Swenshuai.xi // [3:2]: Select clock source
893*53ee8cc1Swenshuai.xi // 00: clk_dmplldiv3_div2
894*53ee8cc1Swenshuai.xi // 01: reserved
895*53ee8cc1Swenshuai.xi // 10: reserved
896*53ee8cc1Swenshuai.xi // 11: DFT_CLK
897*53ee8cc1Swenshuai.xi // [12:8]: reg_ckg_dvbtc_eq
898*53ee8cc1Swenshuai.xi // [0] : disable clock
899*53ee8cc1Swenshuai.xi // [1] : invert clock
900*53ee8cc1Swenshuai.xi // [3:2]: Select clock source
901*53ee8cc1Swenshuai.xi // 00: clk_dmplldiv3_div16
902*53ee8cc1Swenshuai.xi // 01: reserved
903*53ee8cc1Swenshuai.xi // 10: reserved
904*53ee8cc1Swenshuai.xi // 11: DFT_CLK
905*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h0b, 2'b11, 16'h0000);
906*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h0b, 2'b11, 16'h0000);
907*53ee8cc1Swenshuai.xi // wriu 0x111f17 0x00
908*53ee8cc1Swenshuai.xi // wriu 0x111f16 0x00
909*53ee8cc1Swenshuai.xi
910*53ee8cc1Swenshuai.xi
911*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f19,0x00);
912*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f18,0x00);
913*53ee8cc1Swenshuai.xi
914*53ee8cc1Swenshuai.xi
915*53ee8cc1Swenshuai.xi // [9:8] : reg_ckg_adc1x_eq1x
916*53ee8cc1Swenshuai.xi // [13:12] : reg_ckg_adc0p5x_eq0p5x
917*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h24, 2'b10, 16'h0000);
918*53ee8cc1Swenshuai.xi // wriu 0x111f49 0x00
919*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f49,0x00); // Eiffel for power4CFO open clock
920*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f48,0x00); // Eiffel for power4CFO open clock
921*53ee8cc1Swenshuai.xi
922*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f4b,0x00); // Eiffel for power4CFO open clock
923*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f4a,0x00); // Eiffel for power4CFO open clock
924*53ee8cc1Swenshuai.xi // enable sram clock
925*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h0c, 2'b11, 16'h0000);
926*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h0c, 2'b11, 16'h0000);
927*53ee8cc1Swenshuai.xi // wriu 0x111f19 0x00
928*53ee8cc1Swenshuai.xi // wriu 0x111f18 0x00
929*53ee8cc1Swenshuai.xi
930*53ee8cc1Swenshuai.xi
931*53ee8cc1Swenshuai.xi
932*53ee8cc1Swenshuai.xi
933*53ee8cc1Swenshuai.xi // enable vif clock
934*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h0e, 2'b11, 16'h0000);
935*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h0e, 2'b11, 16'h0000);
936*53ee8cc1Swenshuai.xi // wriu 0x111f1d 0x00
937*53ee8cc1Swenshuai.xi // wriu 0x111f1c 0x00
938*53ee8cc1Swenshuai.xi
939*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x111f1d,0x00);
940*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x111f1c,0x00);
941*53ee8cc1Swenshuai.xi
942*53ee8cc1Swenshuai.xi // enable DEMODE-DMA clock
943*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h10, 2'b11, 16'h0000);
944*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h10, 2'b11, 16'h0000);
945*53ee8cc1Swenshuai.xi // wriu 0x111f21 0x00
946*53ee8cc1Swenshuai.xi // wriu 0x111f20 0x00
947*53ee8cc1Swenshuai.xi
948*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x111f21,0x00);
949*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x111f20,0x00);
950*53ee8cc1Swenshuai.xi // select clock
951*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h11, 2'b11, 16'h0444);
952*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h11, 2'b11, 16'h0444);
953*53ee8cc1Swenshuai.xi // wriu 0x111f23 0x04
954*53ee8cc1Swenshuai.xi // wriu 0x111f22 0x44
955*53ee8cc1Swenshuai.xi // HAL_DMD_RIU_WriteByte(0x111f23,0x00);
956*53ee8cc1Swenshuai.xi // HAL_DMD_RIU_WriteByte(0x111f22,0x00);
957*53ee8cc1Swenshuai.xi
958*53ee8cc1Swenshuai.xi // select clock
959*53ee8cc1Swenshuai.xi // [3:0] : reg_ckg_frontend
960*53ee8cc1Swenshuai.xi // [0] : disable clock
961*53ee8cc1Swenshuai.xi // [1] : invert clock
962*53ee8cc1Swenshuai.xi // [3:2]: Select clock source
963*53ee8cc1Swenshuai.xi // 00: select clk_dmplldiv2_div7_div2(24.85 MHz, ATSC)
964*53ee8cc1Swenshuai.xi // 01: select clk_dmdadc (48 MHz, DVBT/C)
965*53ee8cc1Swenshuai.xi // 10: reserved
966*53ee8cc1Swenshuai.xi // 11: select DFT_CLK
967*53ee8cc1Swenshuai.xi // [7:4] : reg_ckg_tr
968*53ee8cc1Swenshuai.xi // [0] : disable clock
969*53ee8cc1Swenshuai.xi // [1] : invert clock
970*53ee8cc1Swenshuai.xi // [3:2]: Select clock source
971*53ee8cc1Swenshuai.xi // 00: select clk_dmplldiv2_div7_div2(24.85 MHz, ATSC)
972*53ee8cc1Swenshuai.xi // 01: select clk_dmdadc (48 MHz, DVBT/C)
973*53ee8cc1Swenshuai.xi // 10: reserved
974*53ee8cc1Swenshuai.xi // 11: select DFT_CLK
975*53ee8cc1Swenshuai.xi // [11:8]: reg_ckg_acifir
976*53ee8cc1Swenshuai.xi // [0] : disable clock
977*53ee8cc1Swenshuai.xi // [1] : invert clock
978*53ee8cc1Swenshuai.xi // [3:2]: Select clock source
979*53ee8cc1Swenshuai.xi // 00: select clk_dmplldiv2_div7_div2(24.85 MHz, ATSC)
980*53ee8cc1Swenshuai.xi // 01: select clk_dmdadc (48 MHz, DVBT/C)
981*53ee8cc1Swenshuai.xi // 10: clk_dmplldiv10_div2 (43.2 MHz, VIF)
982*53ee8cc1Swenshuai.xi // 11: select DFT_CLK
983*53ee8cc1Swenshuai.xi // [15:12]: reg_ckg_frontend_d2
984*53ee8cc1Swenshuai.xi // [0] : disable clock
985*53ee8cc1Swenshuai.xi // [1] : invert clock
986*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN_DMD>>1)+7'h11, 2'b11, 16'h0444); // ???
987*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f23,0x04);
988*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f22,0x44);
989*53ee8cc1Swenshuai.xi
990*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f51,0x00);
991*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x111f50,0x44);
992*53ee8cc1Swenshuai.xi // Turn on New symbol rate detection
993*53ee8cc1Swenshuai.xi // [3] : reg_dvbt_new_tdsfo_on
994*53ee8cc1Swenshuai.xi // [2] : reg_fed_srd_on
995*53ee8cc1Swenshuai.xi // `M3_RIU_W( (`RIUBASE_DMD_TOP_M3>>1)+7'h00, 2'b01, 16'h0004);
996*53ee8cc1Swenshuai.xi // `M3_RIU_W( (`RIUBASE_DMD_TOP_M3>>1)+7'h00, 2'b01, 16'h0004);
997*53ee8cc1Swenshuai.xi // HAL_DMD_RIU_WriteByte(0x112000, 0x04); // Eiffel
998*53ee8cc1Swenshuai.xi
999*53ee8cc1Swenshuai.xi
1000*53ee8cc1Swenshuai.xi // ----------------------------------------------
1001*53ee8cc1Swenshuai.xi // start demod CLKGEN setting
1002*53ee8cc1Swenshuai.xi // ----------------------------------------------
1003*53ee8cc1Swenshuai.xi // select DMD MCU
1004*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CHIP>>1)+7'h1c, 2'b10, 16'h0300);
1005*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CHIP>>1)+7'h1c, 2'b10, 16'h0300);
1006*53ee8cc1Swenshuai.xi // [0] 0:TOP HK; 1:DMDMCU
1007*53ee8cc1Swenshuai.xi // [1] 0:DMDANAQ HK; 1:DMDMCU
1008*53ee8cc1Swenshuai.xi // begin BY temp patch
1009*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x1120A0,0x00); // wreg vdbank_DMD_ANA_MISC+0x20 0x0000
1010*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x1120A1,0x00); // wreg vdbank_DMD_ANA_MISC+0x20 0x0000
1011*53ee8cc1Swenshuai.xi // end
1012*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x101e39,0x03);
1013*53ee8cc1Swenshuai.xi
1014*53ee8cc1Swenshuai.xi // ----------------------------------------------
1015*53ee8cc1Swenshuai.xi // Turn TSP
1016*53ee8cc1Swenshuai.xi // ----------------------------------------------
1017*53ee8cc1Swenshuai.xi // set the ts0_clk from demod
1018*53ee8cc1Swenshuai.xi // [3:0]: CLK_TS0 clock setting
1019*53ee8cc1Swenshuai.xi // [0] : disable
1020*53ee8cc1Swenshuai.xi // [1] : invert clock
1021*53ee8cc1Swenshuai.xi // [3:2]: Select clock source
1022*53ee8cc1Swenshuai.xi // 00: select TS0_CLK
1023*53ee8cc1Swenshuai.xi // 01: select TS1_CLK
1024*53ee8cc1Swenshuai.xi // 10: reserved
1025*53ee8cc1Swenshuai.xi // 11: clk_demod_ts_p
1026*53ee8cc1Swenshuai.xi // `RIU_W((`RIUBASE_CLKGEN0>>1)+7'h28 , 2'b11, 16'h000c);
1027*53ee8cc1Swenshuai.xi
1028*53ee8cc1Swenshuai.xi // PWDN_REF_eco => reg_reserve0[10] = 0
1029*53ee8cc1Swenshuai.xi // `RIU_W( (`RIUBASE_PM_SLEEP>>1)+7'h09, 2'b10, 16'h0100); // 16'bxxxx_x0xx_xxxx_xxxx=> need change channel!!!
1030*53ee8cc1Swenshuai.xi // `RIU_W( (`RIUBASE_PM_SLEEP>>1)+7'h09, 2'b10, 16'h0100); // 16'bxxxx_x0xx_xxxx_xxxx=> need change channel!!!
1031*53ee8cc1Swenshuai.xi // swch 3
1032*53ee8cc1Swenshuai.xi // wriu 0x000e13 0x01
1033*53ee8cc1Swenshuai.xi
1034*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103c0e,0x01);
1035*53ee8cc1Swenshuai.xi }
1036*53ee8cc1Swenshuai.xi
1037*53ee8cc1Swenshuai.xi /***********************************************************************************
1038*53ee8cc1Swenshuai.xi Subject: Power on initialized function
1039*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_Power_On_Initialization
1040*53ee8cc1Swenshuai.xi Parmeter:
1041*53ee8cc1Swenshuai.xi Return: MS_BOOL
1042*53ee8cc1Swenshuai.xi Remark:
1043*53ee8cc1Swenshuai.xi ************************************************************************************/
1044*53ee8cc1Swenshuai.xi
INTERN_DVBC_Power_On_Initialization(MS_BOOL bRFAGCTristateEnable,MS_U8 u8ADCIQMode,MS_U8 u8PadSel,MS_BOOL bPGAEnable,MS_U8 u8PGAGain,const MS_U8 * u8DMD_DVBC_DSPRegInitExt,MS_U8 u8DMD_DVBC_DSPRegInitSize)1045*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_Power_On_Initialization(MS_BOOL bRFAGCTristateEnable, MS_U8 u8ADCIQMode, MS_U8 u8PadSel, MS_BOOL bPGAEnable, MS_U8 u8PGAGain, const MS_U8 *u8DMD_DVBC_DSPRegInitExt, MS_U8 u8DMD_DVBC_DSPRegInitSize)
1046*53ee8cc1Swenshuai.xi {
1047*53ee8cc1Swenshuai.xi MS_U8 status = true;
1048*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf("INTERN_DVBC_Power_On_Initialization\n"));
1049*53ee8cc1Swenshuai.xi
1050*53ee8cc1Swenshuai.xi #if defined(PWS_ENABLE)
1051*53ee8cc1Swenshuai.xi Mapi_PWS_Stop_VDMCU();
1052*53ee8cc1Swenshuai.xi #endif
1053*53ee8cc1Swenshuai.xi
1054*53ee8cc1Swenshuai.xi INTERN_DVBC_InitClkgen(bRFAGCTristateEnable);
1055*53ee8cc1Swenshuai.xi HAL_DMD_ADC_IQ_Switch(u8ADCIQMode, u8PadSel, bPGAEnable, u8PGAGain);
1056*53ee8cc1Swenshuai.xi //// Firmware download //////////
1057*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf("INTERN_DVBC Load DSP...\n"));
1058*53ee8cc1Swenshuai.xi //MsOS_DelayTask(100);
1059*53ee8cc1Swenshuai.xi
1060*53ee8cc1Swenshuai.xi
1061*53ee8cc1Swenshuai.xi {
1062*53ee8cc1Swenshuai.xi if (INTERN_DVBC_LoadDSPCode() == FALSE)
1063*53ee8cc1Swenshuai.xi {
1064*53ee8cc1Swenshuai.xi printf("DVB-C Load DSP Code Fail\n");
1065*53ee8cc1Swenshuai.xi return FALSE;
1066*53ee8cc1Swenshuai.xi }
1067*53ee8cc1Swenshuai.xi else
1068*53ee8cc1Swenshuai.xi {
1069*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf("DVB-C Load DSP Code OK\n"));
1070*53ee8cc1Swenshuai.xi }
1071*53ee8cc1Swenshuai.xi }
1072*53ee8cc1Swenshuai.xi
1073*53ee8cc1Swenshuai.xi status &= INTERN_DVBC_Reset();
1074*53ee8cc1Swenshuai.xi
1075*53ee8cc1Swenshuai.xi status &= INTERN_DVBC_DSPReg_Init(u8DMD_DVBC_DSPRegInitExt, u8DMD_DVBC_DSPRegInitSize);
1076*53ee8cc1Swenshuai.xi
1077*53ee8cc1Swenshuai.xi return status;
1078*53ee8cc1Swenshuai.xi }
1079*53ee8cc1Swenshuai.xi
1080*53ee8cc1Swenshuai.xi /************************************************************************************************
1081*53ee8cc1Swenshuai.xi Subject: Driving control
1082*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_Driving_Control
1083*53ee8cc1Swenshuai.xi Parmeter: bInversionEnable : TRUE For High
1084*53ee8cc1Swenshuai.xi Return: void
1085*53ee8cc1Swenshuai.xi Remark:
1086*53ee8cc1Swenshuai.xi *************************************************************************************************/
INTERN_DVBC_Driving_Control(MS_BOOL bEnable)1087*53ee8cc1Swenshuai.xi void INTERN_DVBC_Driving_Control(MS_BOOL bEnable)
1088*53ee8cc1Swenshuai.xi {
1089*53ee8cc1Swenshuai.xi MS_U8 u8Temp;
1090*53ee8cc1Swenshuai.xi
1091*53ee8cc1Swenshuai.xi u8Temp = HAL_DMD_RIU_ReadByte(0x101E10);
1092*53ee8cc1Swenshuai.xi
1093*53ee8cc1Swenshuai.xi if (bEnable)
1094*53ee8cc1Swenshuai.xi {
1095*53ee8cc1Swenshuai.xi u8Temp = u8Temp | 0x01; //bit0: clk, bit1~8:data , bit9: sync, bit10:valid
1096*53ee8cc1Swenshuai.xi }
1097*53ee8cc1Swenshuai.xi else
1098*53ee8cc1Swenshuai.xi {
1099*53ee8cc1Swenshuai.xi u8Temp = u8Temp & (~0x01);
1100*53ee8cc1Swenshuai.xi }
1101*53ee8cc1Swenshuai.xi
1102*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf("---> INTERN_DVBC_Driving_Control(Bit0) = 0x%x \n",u8Temp));
1103*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x101E10, u8Temp);
1104*53ee8cc1Swenshuai.xi }
1105*53ee8cc1Swenshuai.xi /************************************************************************************************
1106*53ee8cc1Swenshuai.xi Subject: Clk Inversion control
1107*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_Clk_Inversion_Control
1108*53ee8cc1Swenshuai.xi Parmeter: bInversionEnable : TRUE For Inversion Action
1109*53ee8cc1Swenshuai.xi Return: void
1110*53ee8cc1Swenshuai.xi Remark:
1111*53ee8cc1Swenshuai.xi *************************************************************************************************/
INTERN_DVBC_Clk_Inversion_Control(MS_BOOL bInversionEnable)1112*53ee8cc1Swenshuai.xi void INTERN_DVBC_Clk_Inversion_Control(MS_BOOL bInversionEnable)
1113*53ee8cc1Swenshuai.xi {
1114*53ee8cc1Swenshuai.xi MS_U8 u8Temp;
1115*53ee8cc1Swenshuai.xi
1116*53ee8cc1Swenshuai.xi u8Temp = HAL_DMD_RIU_ReadByte(0x103301);
1117*53ee8cc1Swenshuai.xi
1118*53ee8cc1Swenshuai.xi if (bInversionEnable)
1119*53ee8cc1Swenshuai.xi {
1120*53ee8cc1Swenshuai.xi u8Temp = u8Temp | 0x02; //bit 9: clk inv
1121*53ee8cc1Swenshuai.xi }
1122*53ee8cc1Swenshuai.xi else
1123*53ee8cc1Swenshuai.xi {
1124*53ee8cc1Swenshuai.xi u8Temp = u8Temp & (~0x02);
1125*53ee8cc1Swenshuai.xi }
1126*53ee8cc1Swenshuai.xi
1127*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf("---> Inversion(Bit9) = 0x%x \n",u8Temp));
1128*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103301, u8Temp);
1129*53ee8cc1Swenshuai.xi }
1130*53ee8cc1Swenshuai.xi /************************************************************************************************
1131*53ee8cc1Swenshuai.xi Subject: Transport stream serial/parallel control
1132*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_Serial_Control
1133*53ee8cc1Swenshuai.xi Parmeter: bEnable : TRUE For serial
1134*53ee8cc1Swenshuai.xi Return: MS_BOOL :
1135*53ee8cc1Swenshuai.xi Remark:
1136*53ee8cc1Swenshuai.xi *************************************************************************************************/
INTERN_DVBC_Serial_Control(MS_BOOL bEnable,MS_U8 u8TSClk)1137*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_Serial_Control(MS_BOOL bEnable, MS_U8 u8TSClk)
1138*53ee8cc1Swenshuai.xi {
1139*53ee8cc1Swenshuai.xi MS_U8 status = true;
1140*53ee8cc1Swenshuai.xi MS_U8 temp_val;
1141*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf(" @INTERN_DVBC_ts... u8TSClk=%d\n", u8TSClk));
1142*53ee8cc1Swenshuai.xi
1143*53ee8cc1Swenshuai.xi return status;
1144*53ee8cc1Swenshuai.xi
1145*53ee8cc1Swenshuai.xi if (u8TSClk == 0xFF) u8TSClk=0x13;
1146*53ee8cc1Swenshuai.xi if (bEnable) //Serial mode for TS pad
1147*53ee8cc1Swenshuai.xi {
1148*53ee8cc1Swenshuai.xi // serial
1149*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103308, 0x01); // serial mode: 0x0401
1150*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103309, 0x04); // reg_ckg_dvbtc_ts@0x04
1151*53ee8cc1Swenshuai.xi
1152*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103300, 0x00); // serial mode 0x0400
1153*53ee8cc1Swenshuai.xi #if(INTERN_DVBC_TS_SERIAL_INVERSION == 0)
1154*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x103301, 0x04); // reg_ckg_dvbtmk_ts_out_mode@0x00
1155*53ee8cc1Swenshuai.xi temp_val=HAL_DMD_RIU_ReadByte(0x103301);
1156*53ee8cc1Swenshuai.xi temp_val|=0x04;
1157*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103301,temp_val);
1158*53ee8cc1Swenshuai.xi #else
1159*53ee8cc1Swenshuai.xi // HAL_DMD_RIU_WriteByte(0x103301, 0x07); // reg_ckg_dvbtmk_ts_out_mode@0x00
1160*53ee8cc1Swenshuai.xi temp_val=HAL_DMD_RIU_ReadByte(0x103301);
1161*53ee8cc1Swenshuai.xi temp_val|=0x07;
1162*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103301,temp_val);
1163*53ee8cc1Swenshuai.xi #endif
1164*53ee8cc1Swenshuai.xi
1165*53ee8cc1Swenshuai.xi
1166*53ee8cc1Swenshuai.xi //// INTERN_DVBC TS Control: Serial //////////
1167*53ee8cc1Swenshuai.xi
1168*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_CFG_TS_SERIAL, TS_SERIAL);
1169*53ee8cc1Swenshuai.xi
1170*53ee8cc1Swenshuai.xi #if(INTERN_DVBC_TS_SERIAL_INVERSION == 0)
1171*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_CFG_TS_CLK_INV, 0);
1172*53ee8cc1Swenshuai.xi #else
1173*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_CFG_TS_CLK_INV, 1);
1174*53ee8cc1Swenshuai.xi #endif
1175*53ee8cc1Swenshuai.xi gsCmdPacketDVBC.cmd_code = CMD_TS_CTRL;
1176*53ee8cc1Swenshuai.xi
1177*53ee8cc1Swenshuai.xi gsCmdPacketDVBC.param[0] = TS_SERIAL;
1178*53ee8cc1Swenshuai.xi #if(INTERN_DVBC_TS_SERIAL_INVERSION == 0)
1179*53ee8cc1Swenshuai.xi gsCmdPacketDVBC.param[1] = 0;//TS_CLK_NO_INV;
1180*53ee8cc1Swenshuai.xi #else
1181*53ee8cc1Swenshuai.xi gsCmdPacketDVBC.param[1] = 1;//TS_CLK_INVERSE;
1182*53ee8cc1Swenshuai.xi #endif
1183*53ee8cc1Swenshuai.xi status &= INTERN_DVBC_Cmd_Packet_Send(&gsCmdPacketDVBC, 2);
1184*53ee8cc1Swenshuai.xi }
1185*53ee8cc1Swenshuai.xi else
1186*53ee8cc1Swenshuai.xi {
1187*53ee8cc1Swenshuai.xi //parallel
1188*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103308, 0x01); // parallel mode:0x0001
1189*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103309, 0x00); // reg_ckg_dvbtc_ts@0x04
1190*53ee8cc1Swenshuai.xi
1191*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x103300, 0x11); // parallel mode: 0x0511 => ts_clk=288/(2*(0x11+1))=8MHz
1192*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103300, u8TSClk); // parallel mode: 0x0513 => ts_clk=288/(2*(0x16+1))=6.26MHz //@@++--
1193*53ee8cc1Swenshuai.xi #if(INTERN_DVBC_TS_PARALLEL_INVERSION == 0)
1194*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x103301, 0x05); // reg_ckg_dvbtmk_ts_out_mode@0x00
1195*53ee8cc1Swenshuai.xi temp_val=HAL_DMD_RIU_ReadByte(0x103301);
1196*53ee8cc1Swenshuai.xi temp_val|=0x05;
1197*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103301,temp_val);
1198*53ee8cc1Swenshuai.xi #else
1199*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x103301, 0x07); // reg_ckg_dvbtmk_ts_out_mode@0x00
1200*53ee8cc1Swenshuai.xi temp_val=HAL_DMD_RIU_ReadByte(0x103301);
1201*53ee8cc1Swenshuai.xi temp_val|=0x07;
1202*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103301,temp_val);
1203*53ee8cc1Swenshuai.xi #endif
1204*53ee8cc1Swenshuai.xi
1205*53ee8cc1Swenshuai.xi
1206*53ee8cc1Swenshuai.xi //// INTERN_DVBC TS Control: Parallel //////////
1207*53ee8cc1Swenshuai.xi
1208*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_CFG_TS_SERIAL, TS_PARALLEL);
1209*53ee8cc1Swenshuai.xi
1210*53ee8cc1Swenshuai.xi #if(INTERN_DVBC_TS_SERIAL_INVERSION == 0)
1211*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_CFG_TS_CLK_INV, 0);
1212*53ee8cc1Swenshuai.xi #else
1213*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_CFG_TS_CLK_INV, 1);
1214*53ee8cc1Swenshuai.xi #endif
1215*53ee8cc1Swenshuai.xi //// INTERN_DVBC TS Control: Parallel //////////
1216*53ee8cc1Swenshuai.xi gsCmdPacketDVBC.cmd_code = CMD_TS_CTRL;
1217*53ee8cc1Swenshuai.xi
1218*53ee8cc1Swenshuai.xi gsCmdPacketDVBC.param[0] = TS_PARALLEL;
1219*53ee8cc1Swenshuai.xi #if(INTERN_DVBC_TS_PARALLEL_INVERSION == 0)
1220*53ee8cc1Swenshuai.xi gsCmdPacketDVBC.param[1] = 0;//TS_CLK_NO_INV;
1221*53ee8cc1Swenshuai.xi #else
1222*53ee8cc1Swenshuai.xi gsCmdPacketDVBC.param[1] = 1;//TS_CLK_INVERSE;
1223*53ee8cc1Swenshuai.xi #endif
1224*53ee8cc1Swenshuai.xi status &= INTERN_DVBC_Cmd_Packet_Send(&gsCmdPacketDVBC, 2);
1225*53ee8cc1Swenshuai.xi }
1226*53ee8cc1Swenshuai.xi
1227*53ee8cc1Swenshuai.xi #if(INTERN_DVBC_TS_SERIAL_INVERSION == 0)
1228*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf("---> Inversion(Bit5) = %d \n",0 ));
1229*53ee8cc1Swenshuai.xi #else
1230*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf("---> Inversion(Bit5) = %d \n",1 ));
1231*53ee8cc1Swenshuai.xi #endif
1232*53ee8cc1Swenshuai.xi
1233*53ee8cc1Swenshuai.xi INTERN_DVBC_Driving_Control(INTERN_DVBC_DTV_DRIVING_LEVEL);
1234*53ee8cc1Swenshuai.xi return status;
1235*53ee8cc1Swenshuai.xi }
1236*53ee8cc1Swenshuai.xi
1237*53ee8cc1Swenshuai.xi /************************************************************************************************
1238*53ee8cc1Swenshuai.xi Subject: TS1 output control
1239*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_PAD_TS1_Enable
1240*53ee8cc1Swenshuai.xi Parmeter: flag : TRUE For Turn on TS1, FALSE For Turn off TS1
1241*53ee8cc1Swenshuai.xi Return: void
1242*53ee8cc1Swenshuai.xi Remark:
1243*53ee8cc1Swenshuai.xi *************************************************************************************************/
INTERN_DVBC_PAD_TS1_Enable(MS_BOOL flag)1244*53ee8cc1Swenshuai.xi void INTERN_DVBC_PAD_TS1_Enable(MS_BOOL flag)
1245*53ee8cc1Swenshuai.xi {
1246*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf(" @INTERN_DVBC_TS1_Enable... \n"));
1247*53ee8cc1Swenshuai.xi
1248*53ee8cc1Swenshuai.xi if(flag) // PAD_TS1 Enable TS CLK PAD
1249*53ee8cc1Swenshuai.xi {
1250*53ee8cc1Swenshuai.xi //printf("=== TS1_Enable ===\n");
1251*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x101EA5, HAL_DMD_RIU_ReadByte(0x101EA5)|0x10); //For T3
1252*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x101EAF, HAL_DMD_RIU_ReadByte(0x101EAF)|0x18); //For T4
1253*53ee8cc1Swenshuai.xi //move to drvSYS HAL_DMD_RIU_WriteByte(0x101EAF, HAL_DMD_RIU_ReadByte(0x101EAF)|0x11); //For T8
1254*53ee8cc1Swenshuai.xi }
1255*53ee8cc1Swenshuai.xi else // PAD_TS1 Disable TS CLK PAD
1256*53ee8cc1Swenshuai.xi {
1257*53ee8cc1Swenshuai.xi //printf("=== TS1_Disable ===\n");
1258*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x101EA5, HAL_DMD_RIU_ReadByte(0x101EA5)&0xEF); //For T3
1259*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x101EAF, HAL_DMD_RIU_ReadByte(0x101EAF)&0xE3); //For T4
1260*53ee8cc1Swenshuai.xi //move to drvSYS HAL_DMD_RIU_WriteByte(0x101EAF, HAL_DMD_RIU_ReadByte(0x101EAF)&0xC0); //For T8
1261*53ee8cc1Swenshuai.xi }
1262*53ee8cc1Swenshuai.xi }
1263*53ee8cc1Swenshuai.xi
1264*53ee8cc1Swenshuai.xi /************************************************************************************************
1265*53ee8cc1Swenshuai.xi Subject: channel change config
1266*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_Config
1267*53ee8cc1Swenshuai.xi Parmeter: BW: bandwidth
1268*53ee8cc1Swenshuai.xi Return: MS_BOOL :
1269*53ee8cc1Swenshuai.xi Remark:
1270*53ee8cc1Swenshuai.xi *************************************************************************************************/
INTERN_DVBC_Config(MS_U16 u16SymbolRate,DMD_DVBC_MODULATION_TYPE eQamMode,MS_U32 u32IFFreq,MS_BOOL bSpecInv,MS_BOOL bSerialTS,MS_U8 u8TSClk,MS_U16 * pu16_symbol_rate_list,MS_U8 u8_symbol_rate_list_num)1271*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_Config(MS_U16 u16SymbolRate, DMD_DVBC_MODULATION_TYPE eQamMode, MS_U32 u32IFFreq, MS_BOOL bSpecInv, MS_BOOL bSerialTS, MS_U8 u8TSClk, MS_U16 *pu16_symbol_rate_list,MS_U8 u8_symbol_rate_list_num)
1272*53ee8cc1Swenshuai.xi {
1273*53ee8cc1Swenshuai.xi
1274*53ee8cc1Swenshuai.xi MS_U8 status = true;
1275*53ee8cc1Swenshuai.xi MS_U8 reg_symrate_l, reg_symrate_h;
1276*53ee8cc1Swenshuai.xi //MS_U16 u16Fc = 0;
1277*53ee8cc1Swenshuai.xi MS_U8 temp_val;
1278*53ee8cc1Swenshuai.xi // force
1279*53ee8cc1Swenshuai.xi // u16SymbolRate = 0;
1280*53ee8cc1Swenshuai.xi // eQamMode = DMD_DVBC_QAMAUTO;
1281*53ee8cc1Swenshuai.xi
1282*53ee8cc1Swenshuai.xi pu16_symbol_rate_list = pu16_symbol_rate_list;
1283*53ee8cc1Swenshuai.xi u8_symbol_rate_list_num = u8_symbol_rate_list_num;
1284*53ee8cc1Swenshuai.xi
1285*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf(" @INTERN_DVBC_config, SR=%d, QAM=%d, u32IFFreq=%ld, bSpecInv=%d, bSerialTS=%d, u8TSClk=%d\n",u16SymbolRate,eQamMode,u32IFFreq,bSpecInv,bSerialTS, u8TSClk));
1286*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC_TIME(printf("INTERN_DVBC_Config, t = %ld\n",MsOS_GetSystemTime()));
1287*53ee8cc1Swenshuai.xi
1288*53ee8cc1Swenshuai.xi if (u8TSClk == 0xFF) u8TSClk=0x13;
1289*53ee8cc1Swenshuai.xi
1290*53ee8cc1Swenshuai.xi /*
1291*53ee8cc1Swenshuai.xi switch(u32IFFreq)
1292*53ee8cc1Swenshuai.xi {
1293*53ee8cc1Swenshuai.xi case 36125:
1294*53ee8cc1Swenshuai.xi case 36167:
1295*53ee8cc1Swenshuai.xi case 36000:
1296*53ee8cc1Swenshuai.xi case 6000:
1297*53ee8cc1Swenshuai.xi case 4560:
1298*53ee8cc1Swenshuai.xi //u16Fc = DVBC_FS - u32IFFreq;
1299*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf("Fc freq = %ld\n", DVBC_FS - u32IFFreq));
1300*53ee8cc1Swenshuai.xi break;
1301*53ee8cc1Swenshuai.xi case 44000:
1302*53ee8cc1Swenshuai.xi default:
1303*53ee8cc1Swenshuai.xi printf("IF frequency not supported\n");
1304*53ee8cc1Swenshuai.xi status = false;
1305*53ee8cc1Swenshuai.xi break;
1306*53ee8cc1Swenshuai.xi }
1307*53ee8cc1Swenshuai.xi */
1308*53ee8cc1Swenshuai.xi
1309*53ee8cc1Swenshuai.xi reg_symrate_l = (MS_U8) (u16SymbolRate & 0xff);
1310*53ee8cc1Swenshuai.xi reg_symrate_h = (MS_U8) (u16SymbolRate >> 8);
1311*53ee8cc1Swenshuai.xi
1312*53ee8cc1Swenshuai.xi status &= INTERN_DVBC_Reset();
1313*53ee8cc1Swenshuai.xi
1314*53ee8cc1Swenshuai.xi if (eQamMode == DMD_DVBC_QAMAUTO)
1315*53ee8cc1Swenshuai.xi {
1316*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf("DMD_DVBC_QAMAUTO\n"));
1317*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_OP_AUTO_SCAN_QAM, 0x01);
1318*53ee8cc1Swenshuai.xi // give default value.
1319*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_CFG_QAM, QAM);
1320*53ee8cc1Swenshuai.xi }
1321*53ee8cc1Swenshuai.xi else
1322*53ee8cc1Swenshuai.xi {
1323*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf("DMD_DVBC_QAM %d\n", eQamMode));
1324*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_OP_AUTO_SCAN_QAM, 0x00);
1325*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_CFG_QAM, eQamMode);
1326*53ee8cc1Swenshuai.xi }
1327*53ee8cc1Swenshuai.xi // auto symbol rate enable/disable
1328*53ee8cc1Swenshuai.xi if (u16SymbolRate == 0)
1329*53ee8cc1Swenshuai.xi {
1330*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_OP_AUTO_SCAN_SYM_RATE, 0x01);
1331*53ee8cc1Swenshuai.xi }
1332*53ee8cc1Swenshuai.xi else
1333*53ee8cc1Swenshuai.xi {
1334*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_OP_AUTO_SCAN_SYM_RATE, 0x00);
1335*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_CFG_BW0_L, reg_symrate_l);
1336*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_CFG_BW0_H, reg_symrate_h);
1337*53ee8cc1Swenshuai.xi }
1338*53ee8cc1Swenshuai.xi // TS mode
1339*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_CFG_TS_SERIAL, bSerialTS? 0x01:0x00);
1340*53ee8cc1Swenshuai.xi
1341*53ee8cc1Swenshuai.xi // IQ Swap
1342*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_CFG_IQ_SWAP, bSpecInv? 0x01:0x00);
1343*53ee8cc1Swenshuai.xi
1344*53ee8cc1Swenshuai.xi // Fc
1345*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_CFG_FC_L, (abs(DVBC_FS-u32IFFreq))&0xff);
1346*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_CFG_FC_H, (abs((DVBC_FS-u32IFFreq))>>8)&0xff);
1347*53ee8cc1Swenshuai.xi // Lif
1348*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_OP_LIF_EN, (u32IFFreq < 10000) ? 1 : 0);
1349*53ee8cc1Swenshuai.xi // Fif
1350*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_CFG_FIF_L, (u32IFFreq)&0xff);
1351*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteDSPReg(E_DMD_DVBC_CFG_FIF_H, (u32IFFreq>>8)&0xff);
1352*53ee8cc1Swenshuai.xi
1353*53ee8cc1Swenshuai.xi //// INTERN_DVBC system init: DVB-C //////////
1354*53ee8cc1Swenshuai.xi // gsCmdPacketDVBC.cmd_code = CMD_SYSTEM_INIT;
1355*53ee8cc1Swenshuai.xi
1356*53ee8cc1Swenshuai.xi // gsCmdPacketDVBC.param[0] = E_SYS_DVBC;
1357*53ee8cc1Swenshuai.xi // status &= INTERN_DVBC_Cmd_Packet_Send(&gsCmdPacketDVBC, 1);
1358*53ee8cc1Swenshuai.xi
1359*53ee8cc1Swenshuai.xi if (bSerialTS)
1360*53ee8cc1Swenshuai.xi {
1361*53ee8cc1Swenshuai.xi // serial
1362*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103308, 0x01); // parallel mode:0x0001 / serial mode: 0x0401
1363*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103309, 0x04); // reg_ckg_dvbtc_ts@0x04
1364*53ee8cc1Swenshuai.xi
1365*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103300, 0x00); // parallel mode: 0x0511 /serial mode 0x0400
1366*53ee8cc1Swenshuai.xi #if(INTERN_DVBC_TS_SERIAL_INVERSION == 0)
1367*53ee8cc1Swenshuai.xi // HAL_DMD_RIU_WriteByte(0x103301, 0x04); // reg_ckg_dvbtmk_ts_out_mode@0x00
1368*53ee8cc1Swenshuai.xi temp_val=HAL_DMD_RIU_ReadByte(0x103301);
1369*53ee8cc1Swenshuai.xi temp_val|=0x04;
1370*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103301,temp_val);
1371*53ee8cc1Swenshuai.xi #else
1372*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x103301, 0x07); // reg_ckg_dvbtmk_ts_out_mode@0x00
1373*53ee8cc1Swenshuai.xi temp_val=HAL_DMD_RIU_ReadByte(0x103301);
1374*53ee8cc1Swenshuai.xi temp_val|=0x07;
1375*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103301,temp_val);
1376*53ee8cc1Swenshuai.xi #endif
1377*53ee8cc1Swenshuai.xi }
1378*53ee8cc1Swenshuai.xi else
1379*53ee8cc1Swenshuai.xi {
1380*53ee8cc1Swenshuai.xi //parallel
1381*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103308, 0x01); // parallel mode:0x0001 / serial mode: 0x0401
1382*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103309, 0x00); // reg_ckg_dvbtc_ts@0x04
1383*53ee8cc1Swenshuai.xi
1384*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x103300, 0x11); // parallel mode: 0x0511 => ts_clk=288/(2*(0x11+1))=8MHz
1385*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103300, u8TSClk); // parallel mode: 0x0513 => ts_clk=288/(2*(0x16+1))=6.26MHz //@@++--
1386*53ee8cc1Swenshuai.xi #if(INTERN_DVBC_TS_PARALLEL_INVERSION == 0)
1387*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x103301, 0x05); // reg_ckg_dvbtmk_ts_out_mode@0x00
1388*53ee8cc1Swenshuai.xi temp_val=HAL_DMD_RIU_ReadByte(0x103301);
1389*53ee8cc1Swenshuai.xi temp_val|=0x05;
1390*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103301,temp_val);
1391*53ee8cc1Swenshuai.xi #else
1392*53ee8cc1Swenshuai.xi //HAL_DMD_RIU_WriteByte(0x103301, 0x07); // reg_ckg_dvbtmk_ts_out_mode@0x00
1393*53ee8cc1Swenshuai.xi temp_val=HAL_DMD_RIU_ReadByte(0x103301);
1394*53ee8cc1Swenshuai.xi temp_val|=0x07;
1395*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x103301,temp_val);
1396*53ee8cc1Swenshuai.xi #endif
1397*53ee8cc1Swenshuai.xi }
1398*53ee8cc1Swenshuai.xi #if (INTERN_DVBC_INTERNAL_DEBUG == 1)
1399*53ee8cc1Swenshuai.xi INTERN_DVBC_Show_Demod_Version();
1400*53ee8cc1Swenshuai.xi #endif
1401*53ee8cc1Swenshuai.xi
1402*53ee8cc1Swenshuai.xi return status;
1403*53ee8cc1Swenshuai.xi }
1404*53ee8cc1Swenshuai.xi /************************************************************************************************
1405*53ee8cc1Swenshuai.xi Subject: enable hw to lock channel
1406*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_Active
1407*53ee8cc1Swenshuai.xi Parmeter: bEnable
1408*53ee8cc1Swenshuai.xi Return: MS_BOOL
1409*53ee8cc1Swenshuai.xi Remark:
1410*53ee8cc1Swenshuai.xi *************************************************************************************************/
INTERN_DVBC_Active(MS_BOOL bEnable)1411*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_Active(MS_BOOL bEnable)
1412*53ee8cc1Swenshuai.xi {
1413*53ee8cc1Swenshuai.xi MS_U8 status = true;
1414*53ee8cc1Swenshuai.xi
1415*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf(" @INTERN_DVBC_active\n"));
1416*53ee8cc1Swenshuai.xi
1417*53ee8cc1Swenshuai.xi HAL_DMD_RIU_WriteByte(0x112600 + (0x0e)*2, 0x01); // FSM_EN
1418*53ee8cc1Swenshuai.xi
1419*53ee8cc1Swenshuai.xi
1420*53ee8cc1Swenshuai.xi bDMD_DVBC_NoChannelDetectedWithRFPower = FALSE;
1421*53ee8cc1Swenshuai.xi u32DMD_DVBC_NoChannelTimeAccWithRFPower = 0;
1422*53ee8cc1Swenshuai.xi return status;
1423*53ee8cc1Swenshuai.xi }
1424*53ee8cc1Swenshuai.xi
1425*53ee8cc1Swenshuai.xi
INTERN_DVBC_GetLock(DMD_DVBC_GETLOCK_TYPE eType,float fCurrRFPowerDbm,float fNoChannelRFPowerDbm,MS_U32 u32TimeInterval)1426*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_GetLock(DMD_DVBC_GETLOCK_TYPE eType, float fCurrRFPowerDbm, float fNoChannelRFPowerDbm, MS_U32 u32TimeInterval)
1427*53ee8cc1Swenshuai.xi {
1428*53ee8cc1Swenshuai.xi MS_U16 u16Address = 0;
1429*53ee8cc1Swenshuai.xi MS_U8 cData = 0;
1430*53ee8cc1Swenshuai.xi MS_U8 cBitMask = 0;
1431*53ee8cc1Swenshuai.xi
1432*53ee8cc1Swenshuai.xi if (fCurrRFPowerDbm < 100.0f)
1433*53ee8cc1Swenshuai.xi {
1434*53ee8cc1Swenshuai.xi if (eType == DMD_DVBC_GETLOCK_NO_CHANNEL)
1435*53ee8cc1Swenshuai.xi {
1436*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(FEC_REG_BASE + 0xE0, &cData);
1437*53ee8cc1Swenshuai.xi if (cData > 5)
1438*53ee8cc1Swenshuai.xi {
1439*53ee8cc1Swenshuai.xi bDMD_DVBC_NoChannelDetectedWithRFPower = FALSE;
1440*53ee8cc1Swenshuai.xi u32DMD_DVBC_NoChannelTimeAccWithRFPower = 0;
1441*53ee8cc1Swenshuai.xi }
1442*53ee8cc1Swenshuai.xi else
1443*53ee8cc1Swenshuai.xi {
1444*53ee8cc1Swenshuai.xi if ((fCurrRFPowerDbm<fNoChannelRFPowerDbm) && (u32DMD_DVBC_NoChannelTimeAccWithRFPower<10000))
1445*53ee8cc1Swenshuai.xi {
1446*53ee8cc1Swenshuai.xi u32DMD_DVBC_NoChannelTimeAccWithRFPower+=u32TimeInterval;
1447*53ee8cc1Swenshuai.xi }
1448*53ee8cc1Swenshuai.xi if (u32DMD_DVBC_NoChannelTimeAccWithRFPower>1500)
1449*53ee8cc1Swenshuai.xi {
1450*53ee8cc1Swenshuai.xi bDMD_DVBC_NoChannelDetectedWithRFPower=1;
1451*53ee8cc1Swenshuai.xi #ifdef MS_DEBUG
1452*53ee8cc1Swenshuai.xi printf("INTERN_DVBC_GetLock:DMD_DVBC_GETLOCK_NO_CHANNEL Detected Detected Detected!!\n");
1453*53ee8cc1Swenshuai.xi #endif
1454*53ee8cc1Swenshuai.xi return TRUE;
1455*53ee8cc1Swenshuai.xi }
1456*53ee8cc1Swenshuai.xi }
1457*53ee8cc1Swenshuai.xi #ifdef MS_DEBUG
1458*53ee8cc1Swenshuai.xi printf("INTERN_DVBC_GetLock:DMD_DVBC_GETLOCK_NO_CHANNEL FSM:%d InputPower:%f Threshold:%f Interval:%ld TimeAcc:%ld NoChannelDetection:%d\n",cData, fCurrRFPowerDbm, fNoChannelRFPowerDbm, u32TimeInterval, u32DMD_DVBC_NoChannelTimeAccWithRFPower, bDMD_DVBC_NoChannelDetectedWithRFPower);
1459*53ee8cc1Swenshuai.xi #endif
1460*53ee8cc1Swenshuai.xi }
1461*53ee8cc1Swenshuai.xi }
1462*53ee8cc1Swenshuai.xi
1463*53ee8cc1Swenshuai.xi {
1464*53ee8cc1Swenshuai.xi switch( eType )
1465*53ee8cc1Swenshuai.xi {
1466*53ee8cc1Swenshuai.xi case DMD_DVBC_GETLOCK_FEC_LOCK:
1467*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(FEC_REG_BASE + 0xE0, &cData);
1468*53ee8cc1Swenshuai.xi #if (INTERN_DVBC_INTERNAL_DEBUG)
1469*53ee8cc1Swenshuai.xi INTERN_DVBC_info();
1470*53ee8cc1Swenshuai.xi #endif
1471*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf(" @INTERN_DVBC_GetLock FSM 0x%x\n",cData));
1472*53ee8cc1Swenshuai.xi if (cData == 0x0C)
1473*53ee8cc1Swenshuai.xi {
1474*53ee8cc1Swenshuai.xi if(g_dvbc_lock == 0)
1475*53ee8cc1Swenshuai.xi {
1476*53ee8cc1Swenshuai.xi g_dvbc_lock = 1;
1477*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf("[T12][DVBC]lock++++\n"));
1478*53ee8cc1Swenshuai.xi
1479*53ee8cc1Swenshuai.xi }
1480*53ee8cc1Swenshuai.xi return TRUE;
1481*53ee8cc1Swenshuai.xi }
1482*53ee8cc1Swenshuai.xi else
1483*53ee8cc1Swenshuai.xi {
1484*53ee8cc1Swenshuai.xi if(g_dvbc_lock == 1)
1485*53ee8cc1Swenshuai.xi {
1486*53ee8cc1Swenshuai.xi g_dvbc_lock = 0;
1487*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf("[T12][DVBC]unlock----\n"));
1488*53ee8cc1Swenshuai.xi }
1489*53ee8cc1Swenshuai.xi return FALSE;
1490*53ee8cc1Swenshuai.xi }
1491*53ee8cc1Swenshuai.xi break;
1492*53ee8cc1Swenshuai.xi
1493*53ee8cc1Swenshuai.xi case DMD_DVBC_GETLOCK_PSYNC_LOCK:
1494*53ee8cc1Swenshuai.xi u16Address = FEC_REG_BASE + 0x2C; //FEC: P-sync Lock,
1495*53ee8cc1Swenshuai.xi cBitMask = BIT(1);
1496*53ee8cc1Swenshuai.xi break;
1497*53ee8cc1Swenshuai.xi
1498*53ee8cc1Swenshuai.xi case DMD_DVBC_GETLOCK_DCR_LOCK:
1499*53ee8cc1Swenshuai.xi u16Address = TDP_REG_BASE + 0x45; //DCR Lock,
1500*53ee8cc1Swenshuai.xi cBitMask = BIT(0);
1501*53ee8cc1Swenshuai.xi break;
1502*53ee8cc1Swenshuai.xi
1503*53ee8cc1Swenshuai.xi case DMD_DVBC_GETLOCK_AGC_LOCK:
1504*53ee8cc1Swenshuai.xi u16Address = TDP_REG_BASE + 0x2F; //AGC Lock,
1505*53ee8cc1Swenshuai.xi cBitMask = BIT(0);
1506*53ee8cc1Swenshuai.xi break;
1507*53ee8cc1Swenshuai.xi
1508*53ee8cc1Swenshuai.xi case DMD_DVBC_GETLOCK_NO_CHANNEL:
1509*53ee8cc1Swenshuai.xi u16Address = TOP_REG_BASE + 0xC3; //no channel,
1510*53ee8cc1Swenshuai.xi cBitMask = BIT(2)|BIT(3)|BIT(4);
1511*53ee8cc1Swenshuai.xi #ifdef MS_DEBUG
1512*53ee8cc1Swenshuai.xi {
1513*53ee8cc1Swenshuai.xi MS_U8 reg_frz=0, FSM=0;
1514*53ee8cc1Swenshuai.xi MS_U16 u16Timer=0;
1515*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(FEC_REG_BASE + 0xE0, &FSM);
1516*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_WriteReg(TDF_REG_BASE + 0x16, 0x03);
1517*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDF_REG_BASE + 0x03, ®_frz);
1518*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_WriteReg(TDF_REG_BASE + 0x03, reg_frz | 0x80);
1519*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDF_REG_BASE + 0x19, &cData);
1520*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_WriteReg(TDF_REG_BASE + 0x03, reg_frz);
1521*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(0x20DF, ®_frz);
1522*53ee8cc1Swenshuai.xi u16Timer=(u16Timer<<8)+reg_frz;
1523*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(0x20DE, ®_frz);
1524*53ee8cc1Swenshuai.xi u16Timer=(u16Timer<<8)+reg_frz;
1525*53ee8cc1Swenshuai.xi printf("DMD_DVBC_GETLOCK_NO_CHANNEL %d %d %x\n",FSM,u16Timer,cData);
1526*53ee8cc1Swenshuai.xi }
1527*53ee8cc1Swenshuai.xi #endif
1528*53ee8cc1Swenshuai.xi break;
1529*53ee8cc1Swenshuai.xi
1530*53ee8cc1Swenshuai.xi case DMD_DVBC_GETLOCK_ATV_DETECT:
1531*53ee8cc1Swenshuai.xi u16Address = TOP_REG_BASE + 0xC4; //ATV detection,
1532*53ee8cc1Swenshuai.xi cBitMask = BIT(1); // check atv
1533*53ee8cc1Swenshuai.xi break;
1534*53ee8cc1Swenshuai.xi
1535*53ee8cc1Swenshuai.xi case DMD_DVBC_GETLOCK_TR_LOCK:
1536*53ee8cc1Swenshuai.xi #if 0 // 20111108 temporarily solution
1537*53ee8cc1Swenshuai.xi u16Address = INNC_REG_BASE + 0x0A*2 + 1; //TR lock indicator,
1538*53ee8cc1Swenshuai.xi cBitMask = BIT(4);
1539*53ee8cc1Swenshuai.xi break;
1540*53ee8cc1Swenshuai.xi #endif
1541*53ee8cc1Swenshuai.xi case DMD_DVBC_GETLOCK_TR_EVER_LOCK:
1542*53ee8cc1Swenshuai.xi u16Address = TOP_REG_BASE + 0xC4; //TR lock indicator,
1543*53ee8cc1Swenshuai.xi cBitMask = BIT(4);
1544*53ee8cc1Swenshuai.xi break;
1545*53ee8cc1Swenshuai.xi
1546*53ee8cc1Swenshuai.xi default:
1547*53ee8cc1Swenshuai.xi return FALSE;
1548*53ee8cc1Swenshuai.xi }
1549*53ee8cc1Swenshuai.xi
1550*53ee8cc1Swenshuai.xi if (MDrv_SYS_DMD_VD_MBX_ReadReg(u16Address, &cData) == FALSE)
1551*53ee8cc1Swenshuai.xi return FALSE;
1552*53ee8cc1Swenshuai.xi
1553*53ee8cc1Swenshuai.xi if ((cData & cBitMask) != 0)
1554*53ee8cc1Swenshuai.xi {
1555*53ee8cc1Swenshuai.xi return TRUE;
1556*53ee8cc1Swenshuai.xi }
1557*53ee8cc1Swenshuai.xi
1558*53ee8cc1Swenshuai.xi return FALSE;
1559*53ee8cc1Swenshuai.xi }
1560*53ee8cc1Swenshuai.xi
1561*53ee8cc1Swenshuai.xi return FALSE;
1562*53ee8cc1Swenshuai.xi }
1563*53ee8cc1Swenshuai.xi
1564*53ee8cc1Swenshuai.xi
1565*53ee8cc1Swenshuai.xi /****************************************************************************
1566*53ee8cc1Swenshuai.xi Subject: To get the Post viterbi BER
1567*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_GetPostViterbiBer
1568*53ee8cc1Swenshuai.xi Parmeter: Quility
1569*53ee8cc1Swenshuai.xi Return: E_RESULT_SUCCESS
1570*53ee8cc1Swenshuai.xi E_RESULT_FAILURE =>Read I2C fail, INTERN_DVBC_VIT_STATUS_NG
1571*53ee8cc1Swenshuai.xi Remark: For the Performance issue, here we just return the Post Value.(Not BER)
1572*53ee8cc1Swenshuai.xi We will not read the Period, and have the "/256/8"
1573*53ee8cc1Swenshuai.xi *****************************************************************************/
INTERN_DVBC_GetPostViterbiBer(float * ber)1574*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_GetPostViterbiBer(float *ber)
1575*53ee8cc1Swenshuai.xi {
1576*53ee8cc1Swenshuai.xi MS_BOOL status = true;
1577*53ee8cc1Swenshuai.xi MS_U8 reg = 0, reg_frz = 0;
1578*53ee8cc1Swenshuai.xi MS_U16 BitErrPeriod;
1579*53ee8cc1Swenshuai.xi MS_U32 BitErr;
1580*53ee8cc1Swenshuai.xi MS_U16 PktErr;
1581*53ee8cc1Swenshuai.xi
1582*53ee8cc1Swenshuai.xi /////////// Post-Viterbi BER /////////////
1583*53ee8cc1Swenshuai.xi
1584*53ee8cc1Swenshuai.xi // bank 1f 0x03 [1:0] reg_bit_err_num_freeze
1585*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(BACKEND_REG_BASE+0x03, ®_frz);
1586*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteReg(BACKEND_REG_BASE+0x03, reg_frz|0x03);
1587*53ee8cc1Swenshuai.xi
1588*53ee8cc1Swenshuai.xi // bank 1f 0x46 [7:0] reg_bit_err_sblprd_7_0
1589*53ee8cc1Swenshuai.xi // 0x47 [15:8] reg_bit_err_sblprd_15_8
1590*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(BACKEND_REG_BASE+0x47, ®);
1591*53ee8cc1Swenshuai.xi BitErrPeriod = reg;
1592*53ee8cc1Swenshuai.xi
1593*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(BACKEND_REG_BASE+0x46, ®);
1594*53ee8cc1Swenshuai.xi BitErrPeriod = (BitErrPeriod << 8)|reg;
1595*53ee8cc1Swenshuai.xi
1596*53ee8cc1Swenshuai.xi // bank 1f 0x6a [7:0] reg_bit_err_num_7_0
1597*53ee8cc1Swenshuai.xi // 0x6b [15:8] reg_bit_err_num_15_8
1598*53ee8cc1Swenshuai.xi // bank 1f 0x6c [7:0] reg_bit_err_num_23_16
1599*53ee8cc1Swenshuai.xi // 0x6d [15:8] reg_bit_err_num_31_24
1600*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(BACKEND_REG_BASE+0x6d, ®);
1601*53ee8cc1Swenshuai.xi BitErr = reg;
1602*53ee8cc1Swenshuai.xi
1603*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(BACKEND_REG_BASE+0x6c, ®);
1604*53ee8cc1Swenshuai.xi BitErr = (BitErr << 8)|reg;
1605*53ee8cc1Swenshuai.xi
1606*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(BACKEND_REG_BASE+0x6b, ®);
1607*53ee8cc1Swenshuai.xi BitErr = (BitErr << 8)|reg;
1608*53ee8cc1Swenshuai.xi
1609*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(BACKEND_REG_BASE+0x6a, ®);
1610*53ee8cc1Swenshuai.xi BitErr = (BitErr << 8)|reg;
1611*53ee8cc1Swenshuai.xi
1612*53ee8cc1Swenshuai.xi INTERN_DVBC_GetPacketErr(&PktErr);
1613*53ee8cc1Swenshuai.xi
1614*53ee8cc1Swenshuai.xi // bank 1f 0x03 [1:0] reg_bit_err_num_freeze
1615*53ee8cc1Swenshuai.xi reg_frz=reg_frz&(~0x03);
1616*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteReg(BACKEND_REG_BASE+0x03, reg_frz);
1617*53ee8cc1Swenshuai.xi
1618*53ee8cc1Swenshuai.xi if (BitErrPeriod == 0 ) //protect 0
1619*53ee8cc1Swenshuai.xi BitErrPeriod = 1;
1620*53ee8cc1Swenshuai.xi
1621*53ee8cc1Swenshuai.xi if (BitErr <=0 )
1622*53ee8cc1Swenshuai.xi *ber = 0.5f / ((float)BitErrPeriod*128*188*8);
1623*53ee8cc1Swenshuai.xi else
1624*53ee8cc1Swenshuai.xi *ber = (float)BitErr / ((float)BitErrPeriod*128*188*8);
1625*53ee8cc1Swenshuai.xi
1626*53ee8cc1Swenshuai.xi DBG_GET_SIGNAL_DVBC(printf("INTERN_DVBC PostVitBER = %8.3e \n ", *ber));
1627*53ee8cc1Swenshuai.xi
1628*53ee8cc1Swenshuai.xi return status;
1629*53ee8cc1Swenshuai.xi }
1630*53ee8cc1Swenshuai.xi
1631*53ee8cc1Swenshuai.xi
1632*53ee8cc1Swenshuai.xi /****************************************************************************
1633*53ee8cc1Swenshuai.xi Subject: To get the Packet error
1634*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_GetPacketErr
1635*53ee8cc1Swenshuai.xi Parmeter: pktErr
1636*53ee8cc1Swenshuai.xi Return: E_RESULT_SUCCESS
1637*53ee8cc1Swenshuai.xi E_RESULT_FAILURE =>Read I2C fail, INTERN_DVBT_VIT_STATUS_NG
1638*53ee8cc1Swenshuai.xi Remark: For the Performance issue, here we just return the Post Value.(Not BER)
1639*53ee8cc1Swenshuai.xi We will not read the Period, and have the "/256/8"
1640*53ee8cc1Swenshuai.xi *****************************************************************************/
INTERN_DVBC_GetPacketErr(MS_U16 * pktErr)1641*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_GetPacketErr(MS_U16 *pktErr)
1642*53ee8cc1Swenshuai.xi {
1643*53ee8cc1Swenshuai.xi MS_BOOL status = true;
1644*53ee8cc1Swenshuai.xi MS_U8 reg = 0, reg_frz = 0;
1645*53ee8cc1Swenshuai.xi MS_U16 PktErr;
1646*53ee8cc1Swenshuai.xi
1647*53ee8cc1Swenshuai.xi // bank 1f 0x03 [1:0] reg_bit_err_num_freeze
1648*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(BACKEND_REG_BASE+0x03, ®_frz);
1649*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteReg(BACKEND_REG_BASE+0x03, reg_frz|0x03);
1650*53ee8cc1Swenshuai.xi
1651*53ee8cc1Swenshuai.xi // bank 1f 0x66 [7:0] reg_uncrt_pkt_num_7_0
1652*53ee8cc1Swenshuai.xi // 0x67 [15:8] reg_uncrt_pkt_num_15_8
1653*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(BACKEND_REG_BASE+0x67, ®);
1654*53ee8cc1Swenshuai.xi PktErr = reg;
1655*53ee8cc1Swenshuai.xi
1656*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(BACKEND_REG_BASE+0x66, ®);
1657*53ee8cc1Swenshuai.xi PktErr = (PktErr << 8)|reg;
1658*53ee8cc1Swenshuai.xi
1659*53ee8cc1Swenshuai.xi // bank 1f 0x03 [1:0] reg_bit_err_num_freeze
1660*53ee8cc1Swenshuai.xi reg_frz=reg_frz&(~0x03);
1661*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteReg(BACKEND_REG_BASE+0x03, reg_frz);
1662*53ee8cc1Swenshuai.xi
1663*53ee8cc1Swenshuai.xi DBG_GET_SIGNAL_DVBC(printf("INTERN_DVBC PktErr = %d \n ", (int)PktErr));
1664*53ee8cc1Swenshuai.xi
1665*53ee8cc1Swenshuai.xi *pktErr = PktErr;
1666*53ee8cc1Swenshuai.xi
1667*53ee8cc1Swenshuai.xi return status;
1668*53ee8cc1Swenshuai.xi }
1669*53ee8cc1Swenshuai.xi
1670*53ee8cc1Swenshuai.xi /****************************************************************************
1671*53ee8cc1Swenshuai.xi Subject: Read the signal to noise ratio (SNR)
1672*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_GetSNR
1673*53ee8cc1Swenshuai.xi Parmeter: None
1674*53ee8cc1Swenshuai.xi Return: -1 mean I2C fail, otherwise I2C success then return SNR value
1675*53ee8cc1Swenshuai.xi Remark:
1676*53ee8cc1Swenshuai.xi *****************************************************************************/
INTERN_DVBC_GetSNR(float * f_snr)1677*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_GetSNR(float *f_snr)
1678*53ee8cc1Swenshuai.xi {
1679*53ee8cc1Swenshuai.xi MS_BOOL status = true;
1680*53ee8cc1Swenshuai.xi MS_U8 u8Data = 0, reg_frz = 0;
1681*53ee8cc1Swenshuai.xi // MS_U8 freeze = 0;
1682*53ee8cc1Swenshuai.xi MS_U16 noisepower = 0;
1683*53ee8cc1Swenshuai.xi
1684*53ee8cc1Swenshuai.xi if (TRUE == INTERN_DVBC_GetLock(DMD_DVBC_GETLOCK_PSYNC_LOCK, 200.0f, -200.0f, 0) )
1685*53ee8cc1Swenshuai.xi {
1686*53ee8cc1Swenshuai.xi // bank 2c 0x3d [0] reg_bit_err_num_freeze
1687*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(EQE_REG_BASE+0x3d, ®_frz);
1688*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteReg(EQE_REG_BASE+0x3d, reg_frz|0x01);
1689*53ee8cc1Swenshuai.xi
1690*53ee8cc1Swenshuai.xi // read vk
1691*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(EQE2_REG_BASE + 0x6f, &u8Data);
1692*53ee8cc1Swenshuai.xi noisepower = u8Data;
1693*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(EQE2_REG_BASE + 0x6e, &u8Data);
1694*53ee8cc1Swenshuai.xi noisepower = (noisepower<<8)|u8Data;
1695*53ee8cc1Swenshuai.xi
1696*53ee8cc1Swenshuai.xi // bank 2c 0x3d [0] reg_bit_err_num_freeze
1697*53ee8cc1Swenshuai.xi reg_frz=reg_frz&(~0x01);
1698*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteReg(EQE_REG_BASE+0x3d, reg_frz);
1699*53ee8cc1Swenshuai.xi
1700*53ee8cc1Swenshuai.xi if(noisepower == 0x0000)
1701*53ee8cc1Swenshuai.xi noisepower = 0x0001;
1702*53ee8cc1Swenshuai.xi
1703*53ee8cc1Swenshuai.xi #ifdef MSOS_TYPE_LINUX
1704*53ee8cc1Swenshuai.xi *f_snr = 10.0f*log10f(65536.0f/(float)noisepower);
1705*53ee8cc1Swenshuai.xi #else
1706*53ee8cc1Swenshuai.xi *f_snr = 10.0f*Log10Approx(65536.0f/(float)noisepower);
1707*53ee8cc1Swenshuai.xi #endif
1708*53ee8cc1Swenshuai.xi
1709*53ee8cc1Swenshuai.xi }
1710*53ee8cc1Swenshuai.xi else
1711*53ee8cc1Swenshuai.xi {
1712*53ee8cc1Swenshuai.xi *f_snr = 0.0f;
1713*53ee8cc1Swenshuai.xi }
1714*53ee8cc1Swenshuai.xi return status;
1715*53ee8cc1Swenshuai.xi
1716*53ee8cc1Swenshuai.xi
1717*53ee8cc1Swenshuai.xi }
1718*53ee8cc1Swenshuai.xi
INTERN_DVBC_GetSignalStrength(MS_U16 * strength,const DMD_DVBC_InitData * sDMD_DVBC_InitData,MS_U8 u8SarValue,float fRFPowerDbm)1719*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_GetSignalStrength(MS_U16 *strength, const DMD_DVBC_InitData *sDMD_DVBC_InitData, MS_U8 u8SarValue, float fRFPowerDbm)
1720*53ee8cc1Swenshuai.xi {
1721*53ee8cc1Swenshuai.xi MS_BOOL status = true;
1722*53ee8cc1Swenshuai.xi float ch_power_db=0.0f, ch_power_db_rel=0.0f;
1723*53ee8cc1Swenshuai.xi DMD_DVBC_MODULATION_TYPE Qam_mode;
1724*53ee8cc1Swenshuai.xi
1725*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC_TIME(printf("INTERN_DVBC_GetSignalStrength, t=%ld, RF level=%f, Table=%lx\n",MsOS_GetSystemTime(), fRFPowerDbm, (MS_U32)(sDMD_DVBC_InitData->pTuner_RfagcSsi)));
1726*53ee8cc1Swenshuai.xi
1727*53ee8cc1Swenshuai.xi // if (INTERN_DVBC_Lock(COFDM_TPS_LOCK))
1728*53ee8cc1Swenshuai.xi //if (INTERN_DVBC_Lock(COFDM_AGC_LOCK))
1729*53ee8cc1Swenshuai.xi /* Actually, it's more reasonable, that signal level depended on cable input power level
1730*53ee8cc1Swenshuai.xi * thougth the signal isn't dvb-t signal.
1731*53ee8cc1Swenshuai.xi */
1732*53ee8cc1Swenshuai.xi // use pointer of IFAGC table to identify
1733*53ee8cc1Swenshuai.xi // case 1: RFAGC from SAR, IFAGC controlled by demod
1734*53ee8cc1Swenshuai.xi // case 2: RFAGC from tuner, ,IFAGC controlled by demod
1735*53ee8cc1Swenshuai.xi status=HAL_DMD_GetRFLevel(&ch_power_db, fRFPowerDbm, u8SarValue,
1736*53ee8cc1Swenshuai.xi sDMD_DVBC_InitData->pTuner_RfagcSsi, sDMD_DVBC_InitData->u16Tuner_RfagcSsi_Size,
1737*53ee8cc1Swenshuai.xi sDMD_DVBC_InitData->pTuner_IfagcSsi_HiRef, sDMD_DVBC_InitData->u16Tuner_IfagcSsi_HiRef_Size,
1738*53ee8cc1Swenshuai.xi sDMD_DVBC_InitData->pTuner_IfagcSsi_LoRef, sDMD_DVBC_InitData->u16Tuner_IfagcSsi_LoRef_Size,
1739*53ee8cc1Swenshuai.xi sDMD_DVBC_InitData->pTuner_IfagcErr_HiRef, sDMD_DVBC_InitData->u16Tuner_IfagcErr_HiRef_Size,
1740*53ee8cc1Swenshuai.xi sDMD_DVBC_InitData->pTuner_IfagcErr_LoRef, sDMD_DVBC_InitData->u16Tuner_IfagcErr_LoRef_Size);
1741*53ee8cc1Swenshuai.xi
1742*53ee8cc1Swenshuai.xi status &= INTERN_DVBC_GetCurrentModulationType(&Qam_mode);
1743*53ee8cc1Swenshuai.xi
1744*53ee8cc1Swenshuai.xi if( (MS_U8)Qam_mode <= (MS_U8)DMD_DVBC_QAM256)
1745*53ee8cc1Swenshuai.xi {
1746*53ee8cc1Swenshuai.xi ch_power_db_rel = ch_power_db + intern_dvb_c_qam_ref[(MS_U8)Qam_mode];
1747*53ee8cc1Swenshuai.xi }
1748*53ee8cc1Swenshuai.xi else
1749*53ee8cc1Swenshuai.xi {
1750*53ee8cc1Swenshuai.xi ch_power_db_rel = -100.0f;
1751*53ee8cc1Swenshuai.xi }
1752*53ee8cc1Swenshuai.xi
1753*53ee8cc1Swenshuai.xi if(ch_power_db_rel <= -85.0f)
1754*53ee8cc1Swenshuai.xi {*strength = 0;}
1755*53ee8cc1Swenshuai.xi else if (ch_power_db_rel <= -80.0f)
1756*53ee8cc1Swenshuai.xi {*strength = (MS_U16)(0.0f + (ch_power_db_rel+85.0f)*10.0f/5.0f);}
1757*53ee8cc1Swenshuai.xi else if (ch_power_db_rel <= -75.0f)
1758*53ee8cc1Swenshuai.xi {*strength = (MS_U16)(10.0f + (ch_power_db_rel+80.0f)*20.0f/5.0f);}
1759*53ee8cc1Swenshuai.xi else if (ch_power_db_rel <= -70.0f)
1760*53ee8cc1Swenshuai.xi {*strength = (MS_U16)(30.0f + (ch_power_db_rel+75.0f)*30.0f/5.0f);}
1761*53ee8cc1Swenshuai.xi else if (ch_power_db_rel <= -65.0f)
1762*53ee8cc1Swenshuai.xi {*strength = (MS_U16)(60.0f + (ch_power_db_rel+70.0f)*10.0f/5.0f);}
1763*53ee8cc1Swenshuai.xi else if (ch_power_db_rel <= -55.0f)
1764*53ee8cc1Swenshuai.xi {*strength = (MS_U16)(70.0f + (ch_power_db_rel+65.0f)*20.0f/10.0f);}
1765*53ee8cc1Swenshuai.xi else if (ch_power_db_rel <= -45.0f)
1766*53ee8cc1Swenshuai.xi {*strength = (MS_U16)(90.0f + (ch_power_db_rel+55.0f)*10.0f/10.0f);}
1767*53ee8cc1Swenshuai.xi else
1768*53ee8cc1Swenshuai.xi {*strength = 100;}
1769*53ee8cc1Swenshuai.xi
1770*53ee8cc1Swenshuai.xi DBG_GET_SIGNAL_DVBC(printf(">>> SSI_CH_PWR(dB) = %f , Score = %d<<<\n", ch_power_db, *strength));
1771*53ee8cc1Swenshuai.xi DBG_GET_SIGNAL_DVBC(printf(">>> SSI = %d <<<\n", (int)*strength));
1772*53ee8cc1Swenshuai.xi
1773*53ee8cc1Swenshuai.xi return status;
1774*53ee8cc1Swenshuai.xi }
1775*53ee8cc1Swenshuai.xi
1776*53ee8cc1Swenshuai.xi /****************************************************************************
1777*53ee8cc1Swenshuai.xi Subject: To get the DVT Signal quility
1778*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_GetSignalQuality
1779*53ee8cc1Swenshuai.xi Parmeter: Quility
1780*53ee8cc1Swenshuai.xi Return: E_RESULT_SUCCESS
1781*53ee8cc1Swenshuai.xi E_RESULT_FAILURE
1782*53ee8cc1Swenshuai.xi Remark: Here we have 4 level range
1783*53ee8cc1Swenshuai.xi <1>.First Range => Quility =100 (You can define it by INTERN_DVBT_SIGNAL_BASE_100)
1784*53ee8cc1Swenshuai.xi <2>.2th Range => 60 < Quality < 100 (You can define it by INTERN_DVBT_SIGNAL_BASE_60)
1785*53ee8cc1Swenshuai.xi <3>.3th Range => 10 < Quality < 60 (You can define it by INTERN_DVBT_SIGNAL_BASE_10)
1786*53ee8cc1Swenshuai.xi <4>.4th Range => Quality <10
1787*53ee8cc1Swenshuai.xi *****************************************************************************/
INTERN_DVBC_GetSignalQuality(MS_U16 * quality,const DMD_DVBC_InitData * sDMD_DVBC_InitData,MS_U8 u8SarValue,float fRFPowerDbm)1788*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_GetSignalQuality(MS_U16 *quality, const DMD_DVBC_InitData *sDMD_DVBC_InitData, MS_U8 u8SarValue, float fRFPowerDbm)
1789*53ee8cc1Swenshuai.xi {
1790*53ee8cc1Swenshuai.xi
1791*53ee8cc1Swenshuai.xi float fber;
1792*53ee8cc1Swenshuai.xi float log_ber;
1793*53ee8cc1Swenshuai.xi MS_BOOL status = true;
1794*53ee8cc1Swenshuai.xi DMD_DVBC_MODULATION_TYPE Qam_mode;
1795*53ee8cc1Swenshuai.xi float f_snr;
1796*53ee8cc1Swenshuai.xi
1797*53ee8cc1Swenshuai.xi fRFPowerDbm = fRFPowerDbm;
1798*53ee8cc1Swenshuai.xi status &= INTERN_DVBC_GetSNR(&f_snr);
1799*53ee8cc1Swenshuai.xi if (TRUE == INTERN_DVBC_GetLock(DMD_DVBC_GETLOCK_PSYNC_LOCK, 200.0f, -200.0f, 0))
1800*53ee8cc1Swenshuai.xi {
1801*53ee8cc1Swenshuai.xi if (INTERN_DVBC_GetPostViterbiBer(&fber) == FALSE)
1802*53ee8cc1Swenshuai.xi {
1803*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf("\nGetPostViterbiBer Fail!"));
1804*53ee8cc1Swenshuai.xi return FALSE;
1805*53ee8cc1Swenshuai.xi }
1806*53ee8cc1Swenshuai.xi
1807*53ee8cc1Swenshuai.xi // log_ber = log10(fber)
1808*53ee8cc1Swenshuai.xi log_ber = (-1.0f)*Log10Approx(1.0f/fber); // Log10Approx() provide 1~2^32 input range only
1809*53ee8cc1Swenshuai.xi
1810*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf("\nLog(BER) = %f",log_ber));
1811*53ee8cc1Swenshuai.xi status &= INTERN_DVBC_GetCurrentModulationType(&Qam_mode);
1812*53ee8cc1Swenshuai.xi if (Qam_mode == DMD_DVBC_QAM16)
1813*53ee8cc1Swenshuai.xi {
1814*53ee8cc1Swenshuai.xi if(log_ber <= (-5.5f))
1815*53ee8cc1Swenshuai.xi *quality = 100;
1816*53ee8cc1Swenshuai.xi else if(log_ber <= (-5.1f))
1817*53ee8cc1Swenshuai.xi *quality = (MS_U16)(90.0f + ((-5.1f)-log_ber)*10.0f/((-5.1f)-(-5.5f)));
1818*53ee8cc1Swenshuai.xi else if(log_ber <= (-4.9f))
1819*53ee8cc1Swenshuai.xi *quality = (MS_U16)(80.0f + ((-4.9f)-log_ber)*10.0f/((-4.9f)-(-5.1f)));
1820*53ee8cc1Swenshuai.xi else if(log_ber <= (-4.5f))
1821*53ee8cc1Swenshuai.xi *quality = (MS_U16)(70.0f + ((-4.5f)-log_ber)*10.0f/((-4.5f)-(-4.9f)));
1822*53ee8cc1Swenshuai.xi else if(log_ber <= (-3.7f))
1823*53ee8cc1Swenshuai.xi *quality = (MS_U16)(60.0f + ((-3.7f)-log_ber)*10.0f/((-3.7f)-(-4.5f)));
1824*53ee8cc1Swenshuai.xi else if(log_ber <= (-3.2f))
1825*53ee8cc1Swenshuai.xi *quality = (MS_U16)(50.0f + ((-3.2f)-log_ber)*10.0f/((-3.2f)-(-3.7f)));
1826*53ee8cc1Swenshuai.xi else if(log_ber <= (-2.9f))
1827*53ee8cc1Swenshuai.xi *quality = (MS_U16)(40.0f + ((-2.9f)-log_ber)*10.0f/((-2.9f)-(-3.2f)));
1828*53ee8cc1Swenshuai.xi else if(log_ber <= (-2.5f))
1829*53ee8cc1Swenshuai.xi *quality = (MS_U16)(30.0f + ((-2.5f)-log_ber)*10.0f/((-2.5f)-(-2.9f)));
1830*53ee8cc1Swenshuai.xi else if(log_ber <= (-2.2f))
1831*53ee8cc1Swenshuai.xi *quality = (MS_U16)(20.0f + ((-2.2f)-log_ber)*10.0f/((-2.2f)-(-2.5f)));
1832*53ee8cc1Swenshuai.xi else if(log_ber <= (-2.0f))
1833*53ee8cc1Swenshuai.xi *quality = (MS_U16)(0.0f + ((-2.0f)-log_ber)*10.0f/((-2.0f)-(-2.2f)));
1834*53ee8cc1Swenshuai.xi else
1835*53ee8cc1Swenshuai.xi *quality = 0;
1836*53ee8cc1Swenshuai.xi }
1837*53ee8cc1Swenshuai.xi else if (Qam_mode == DMD_DVBC_QAM32)
1838*53ee8cc1Swenshuai.xi {
1839*53ee8cc1Swenshuai.xi if(log_ber <= (-5.0f))
1840*53ee8cc1Swenshuai.xi *quality = 100;
1841*53ee8cc1Swenshuai.xi else if(log_ber <= (-4.7f))
1842*53ee8cc1Swenshuai.xi *quality = (MS_U16)(90.0f + ((-4.7f)-log_ber)*10.0f/((-4.7f)-(-5.0f)));
1843*53ee8cc1Swenshuai.xi else if(log_ber <= (-4.5f))
1844*53ee8cc1Swenshuai.xi *quality = (MS_U16)(80.0f + ((-4.5f)-log_ber)*10.0f/((-4.5f)-(-4.7f)));
1845*53ee8cc1Swenshuai.xi else if(log_ber <= (-3.8f))
1846*53ee8cc1Swenshuai.xi *quality = (MS_U16)(70.0f + ((-3.8f)-log_ber)*10.0f/((-3.8f)-(-4.5f)));
1847*53ee8cc1Swenshuai.xi else if(log_ber <= (-3.5f))
1848*53ee8cc1Swenshuai.xi *quality = (MS_U16)(60.0f + ((-3.5f)-log_ber)*10.0f/((-3.5f)-(-3.8f)));
1849*53ee8cc1Swenshuai.xi else if(log_ber <= (-3.0f))
1850*53ee8cc1Swenshuai.xi *quality = (MS_U16)(50.0f + ((-3.0f)-log_ber)*10.0f/((-3.0f)-(-3.5f)));
1851*53ee8cc1Swenshuai.xi else if(log_ber <= (-2.7f))
1852*53ee8cc1Swenshuai.xi *quality = (MS_U16)(40.0f + ((-2.7f)-log_ber)*10.0f/((-2.7f)-(-3.0f)));
1853*53ee8cc1Swenshuai.xi else if(log_ber <= (-2.4f))
1854*53ee8cc1Swenshuai.xi *quality = (MS_U16)(30.0f + ((-2.4f)-log_ber)*10.0f/((-2.4f)-(-2.7f)));
1855*53ee8cc1Swenshuai.xi else if(log_ber <= (-2.2f))
1856*53ee8cc1Swenshuai.xi *quality = (MS_U16)(20.0f + ((-2.2f)-log_ber)*10.0f/((-2.2f)-(-2.4f)));
1857*53ee8cc1Swenshuai.xi else if(log_ber <= (-2.0f))
1858*53ee8cc1Swenshuai.xi *quality = (MS_U16)(0.0f + ((-2.0f)-log_ber)*10.0f/((-2.0f)-(-2.2f)));
1859*53ee8cc1Swenshuai.xi else
1860*53ee8cc1Swenshuai.xi *quality = 0;
1861*53ee8cc1Swenshuai.xi }
1862*53ee8cc1Swenshuai.xi else if (Qam_mode == DMD_DVBC_QAM64)
1863*53ee8cc1Swenshuai.xi {
1864*53ee8cc1Swenshuai.xi if(log_ber <= (-5.4f))
1865*53ee8cc1Swenshuai.xi *quality = 100;
1866*53ee8cc1Swenshuai.xi else if(log_ber <= (-5.1f))
1867*53ee8cc1Swenshuai.xi *quality = (MS_U16)(90.0f + ((-5.1f)-log_ber)*10.0f/((-5.1f)-(-5.4f)));
1868*53ee8cc1Swenshuai.xi else if(log_ber <= (-4.9f))
1869*53ee8cc1Swenshuai.xi *quality = (MS_U16)(80.0f + ((-4.9f)-log_ber)*10.0f/((-4.9f)-(-5.1f)));
1870*53ee8cc1Swenshuai.xi else if(log_ber <= (-4.3f))
1871*53ee8cc1Swenshuai.xi *quality = (MS_U16)(70.0f + ((-4.3f)-log_ber)*10.0f/((-4.3f)-(-4.9f)));
1872*53ee8cc1Swenshuai.xi else if(log_ber <= (-3.7f))
1873*53ee8cc1Swenshuai.xi *quality = (MS_U16)(60.0f + ((-3.7f)-log_ber)*10.0f/((-3.7f)-(-4.3f)));
1874*53ee8cc1Swenshuai.xi else if(log_ber <= (-3.2f))
1875*53ee8cc1Swenshuai.xi *quality = (MS_U16)(50.0f + ((-3.2f)-log_ber)*10.0f/((-3.2f)-(-3.7f)));
1876*53ee8cc1Swenshuai.xi else if(log_ber <= (-2.9f))
1877*53ee8cc1Swenshuai.xi *quality = (MS_U16)(40.0f + ((-2.9f)-log_ber)*10.0f/((-2.9f)-(-3.2f)));
1878*53ee8cc1Swenshuai.xi else if(log_ber <= (-2.4f))
1879*53ee8cc1Swenshuai.xi *quality = (MS_U16)(30.0f + ((-2.4f)-log_ber)*10.0f/((-2.4f)-(-2.9f)));
1880*53ee8cc1Swenshuai.xi else if(log_ber <= (-2.2f))
1881*53ee8cc1Swenshuai.xi *quality = (MS_U16)(20.0f + ((-2.2f)-log_ber)*10.0f/((-2.2f)-(-2.4f)));
1882*53ee8cc1Swenshuai.xi else if(log_ber <= (-2.05f))
1883*53ee8cc1Swenshuai.xi *quality = (MS_U16)(0.0f + ((-2.05f)-log_ber)*10.0f/((-2.05f)-(-2.2f)));
1884*53ee8cc1Swenshuai.xi else
1885*53ee8cc1Swenshuai.xi *quality = 0;
1886*53ee8cc1Swenshuai.xi }
1887*53ee8cc1Swenshuai.xi else if (Qam_mode == DMD_DVBC_QAM128)
1888*53ee8cc1Swenshuai.xi {
1889*53ee8cc1Swenshuai.xi if(log_ber <= (-5.1f))
1890*53ee8cc1Swenshuai.xi *quality = 100;
1891*53ee8cc1Swenshuai.xi else if(log_ber <= (-4.9f))
1892*53ee8cc1Swenshuai.xi *quality = (MS_U16)(90.0f + ((-4.9f)-log_ber)*10.0f/((-4.9f)-(-5.1f)));
1893*53ee8cc1Swenshuai.xi else if(log_ber <= (-4.7f))
1894*53ee8cc1Swenshuai.xi *quality = (MS_U16)(80.0f + ((-4.7f)-log_ber)*10.0f/((-4.7f)-(-4.9f)));
1895*53ee8cc1Swenshuai.xi else if(log_ber <= (-4.1f))
1896*53ee8cc1Swenshuai.xi *quality = (MS_U16)(70.0f + ((-4.1f)-log_ber)*10.0f/((-4.1f)-(-4.7f)));
1897*53ee8cc1Swenshuai.xi else if(log_ber <= (-3.5f))
1898*53ee8cc1Swenshuai.xi *quality = (MS_U16)(60.0f + ((-3.5f)-log_ber)*10.0f/((-3.5f)-(-4.1f)));
1899*53ee8cc1Swenshuai.xi else if(log_ber <= (-3.1f))
1900*53ee8cc1Swenshuai.xi *quality = (MS_U16)(50.0f + ((-3.1f)-log_ber)*10.0f/((-3.1f)-(-3.5f)));
1901*53ee8cc1Swenshuai.xi else if(log_ber <= (-2.7f))
1902*53ee8cc1Swenshuai.xi *quality = (MS_U16)(40.0f + ((-2.7f)-log_ber)*10.0f/((-2.7f)-(-3.1f)));
1903*53ee8cc1Swenshuai.xi else if(log_ber <= (-2.5f))
1904*53ee8cc1Swenshuai.xi *quality = (MS_U16)(30.0f + ((-2.5f)-log_ber)*10.0f/((-2.5f)-(-2.7f)));
1905*53ee8cc1Swenshuai.xi else if(log_ber <= (-2.06f))
1906*53ee8cc1Swenshuai.xi *quality = (MS_U16)(20.0f + ((-2.06f)-log_ber)*10.0f/((-2.06f)-(-2.5f)));
1907*53ee8cc1Swenshuai.xi //else if(log_ber <= (-2.05))
1908*53ee8cc1Swenshuai.xi else
1909*53ee8cc1Swenshuai.xi {
1910*53ee8cc1Swenshuai.xi if (f_snr >= 27.2f)
1911*53ee8cc1Swenshuai.xi *quality = 20;
1912*53ee8cc1Swenshuai.xi else if (f_snr >= 25.1f)
1913*53ee8cc1Swenshuai.xi *quality = (MS_U16)(0.0f + (f_snr - 25.1f)*20.0f/(27.2f-25.1f));
1914*53ee8cc1Swenshuai.xi else
1915*53ee8cc1Swenshuai.xi *quality = 0;
1916*53ee8cc1Swenshuai.xi }
1917*53ee8cc1Swenshuai.xi }
1918*53ee8cc1Swenshuai.xi else //256QAM
1919*53ee8cc1Swenshuai.xi {
1920*53ee8cc1Swenshuai.xi if(log_ber <= (-4.8f))
1921*53ee8cc1Swenshuai.xi *quality = 100;
1922*53ee8cc1Swenshuai.xi else if(log_ber <= (-4.6f))
1923*53ee8cc1Swenshuai.xi *quality = (MS_U16)(90.0f + ((-4.6f)-log_ber)*10.0f/((-4.6f)-(-4.8f)));
1924*53ee8cc1Swenshuai.xi else if(log_ber <= (-4.4f))
1925*53ee8cc1Swenshuai.xi *quality = (MS_U16)(80.0f + ((-4.4f)-log_ber)*10.0f/((-4.4f)-(-4.6f)));
1926*53ee8cc1Swenshuai.xi else if(log_ber <= (-4.0f))
1927*53ee8cc1Swenshuai.xi *quality = (MS_U16)(70.0f + ((-4.0f)-log_ber)*10.0f/((-4.0f)-(-4.4f)));
1928*53ee8cc1Swenshuai.xi else if(log_ber <= (-3.5f))
1929*53ee8cc1Swenshuai.xi *quality = (MS_U16)(60.0f + ((-3.5f)-log_ber)*10.0f/((-3.5f)-(-4.0f)));
1930*53ee8cc1Swenshuai.xi else if(log_ber <= (-3.1f))
1931*53ee8cc1Swenshuai.xi *quality = (MS_U16)(50.0f + ((-3.1f)-log_ber)*10.0f/((-3.1f)-(-3.5f)));
1932*53ee8cc1Swenshuai.xi else if(log_ber <= (-2.7f))
1933*53ee8cc1Swenshuai.xi *quality = (MS_U16)(40.0f + ((-2.7f)-log_ber)*10.0f/((-2.7f)-(-3.1f)));
1934*53ee8cc1Swenshuai.xi else if(log_ber <= (-2.4f))
1935*53ee8cc1Swenshuai.xi *quality = (MS_U16)(30.0f + ((-2.4f)-log_ber)*10.0f/((-2.4f)-(-2.7f)));
1936*53ee8cc1Swenshuai.xi else if(log_ber <= (-2.06f))
1937*53ee8cc1Swenshuai.xi *quality = (MS_U16)(20.0f + ((-2.06f)-log_ber)*10.0f/((-2.06f)-(-2.4f)));
1938*53ee8cc1Swenshuai.xi //else if(log_ber <= (-2.05))
1939*53ee8cc1Swenshuai.xi else
1940*53ee8cc1Swenshuai.xi {
1941*53ee8cc1Swenshuai.xi if (f_snr >= 29.6f)
1942*53ee8cc1Swenshuai.xi *quality = 20;
1943*53ee8cc1Swenshuai.xi else if (f_snr >= 27.3f)
1944*53ee8cc1Swenshuai.xi *quality = (MS_U16)(0.0f + (f_snr - 27.3f)*20.0f/(29.6f-27.3f));
1945*53ee8cc1Swenshuai.xi else
1946*53ee8cc1Swenshuai.xi *quality = 0;
1947*53ee8cc1Swenshuai.xi }
1948*53ee8cc1Swenshuai.xi }
1949*53ee8cc1Swenshuai.xi }
1950*53ee8cc1Swenshuai.xi else
1951*53ee8cc1Swenshuai.xi {
1952*53ee8cc1Swenshuai.xi *quality = 0;
1953*53ee8cc1Swenshuai.xi }
1954*53ee8cc1Swenshuai.xi
1955*53ee8cc1Swenshuai.xi //DBG_GET_SIGNAL_DVBC(printf("SNR = %f, QAM = %d, code Rate = %d\n", cn_rec, tps_cnstl, tps_cr));
1956*53ee8cc1Swenshuai.xi DBG_GET_SIGNAL_DVBC(printf("BER = %8.3e\n", fber));
1957*53ee8cc1Swenshuai.xi DBG_GET_SIGNAL_DVBC(printf("Signal Quility = %d\n", *quality));
1958*53ee8cc1Swenshuai.xi return TRUE;
1959*53ee8cc1Swenshuai.xi }
1960*53ee8cc1Swenshuai.xi
1961*53ee8cc1Swenshuai.xi /****************************************************************************
1962*53ee8cc1Swenshuai.xi Subject: To get the Cell ID
1963*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_Get_CELL_ID
1964*53ee8cc1Swenshuai.xi Parmeter: point to return parameter cell_id
1965*53ee8cc1Swenshuai.xi
1966*53ee8cc1Swenshuai.xi Return: TRUE
1967*53ee8cc1Swenshuai.xi FALSE
1968*53ee8cc1Swenshuai.xi Remark:
1969*53ee8cc1Swenshuai.xi *****************************************************************************/
INTERN_DVBC_Get_CELL_ID(MS_U16 * cell_id)1970*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_Get_CELL_ID(MS_U16 *cell_id)
1971*53ee8cc1Swenshuai.xi {
1972*53ee8cc1Swenshuai.xi MS_BOOL status = true;
1973*53ee8cc1Swenshuai.xi MS_U8 value1 = 0;
1974*53ee8cc1Swenshuai.xi MS_U8 value2 = 0;
1975*53ee8cc1Swenshuai.xi
1976*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(FDP_REG_BASE+0x2B, &value2); //TPS Cell ID [15:8]
1977*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(FDP_REG_BASE+0x2A, &value1); //TPS Cell ID [7:0]
1978*53ee8cc1Swenshuai.xi
1979*53ee8cc1Swenshuai.xi *cell_id = ((MS_U16)value1<<8)|value2;
1980*53ee8cc1Swenshuai.xi return status;
1981*53ee8cc1Swenshuai.xi }
1982*53ee8cc1Swenshuai.xi
1983*53ee8cc1Swenshuai.xi /****************************************************************************
1984*53ee8cc1Swenshuai.xi Subject: To get the DVBC Carrier Freq Offset
1985*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_Get_FreqOffset
1986*53ee8cc1Swenshuai.xi Parmeter: Frequency offset (in KHz), bandwidth
1987*53ee8cc1Swenshuai.xi Return: E_RESULT_SUCCESS
1988*53ee8cc1Swenshuai.xi E_RESULT_FAILURE
1989*53ee8cc1Swenshuai.xi Remark:
1990*53ee8cc1Swenshuai.xi *****************************************************************************/
INTERN_DVBC_Get_FreqOffset(float * pFreqOff,MS_U8 u8BW)1991*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_Get_FreqOffset(float *pFreqOff, MS_U8 u8BW)
1992*53ee8cc1Swenshuai.xi {
1993*53ee8cc1Swenshuai.xi MS_U16 FreqB, config_Fc=0;
1994*53ee8cc1Swenshuai.xi float FreqCfo_offset,f_Fc;
1995*53ee8cc1Swenshuai.xi MS_U32 RegCfo_offset, Reg_Fc_over_Fs;
1996*53ee8cc1Swenshuai.xi MS_U8 reg_frz = 0, reg = 0;
1997*53ee8cc1Swenshuai.xi MS_BOOL status = TRUE;
1998*53ee8cc1Swenshuai.xi
1999*53ee8cc1Swenshuai.xi // no use.
2000*53ee8cc1Swenshuai.xi u8BW = u8BW;
2001*53ee8cc1Swenshuai.xi
2002*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf("INTERN_DVBC_Get_FreqOffset\n"));
2003*53ee8cc1Swenshuai.xi
2004*53ee8cc1Swenshuai.xi // bank 2c 0x3d [0] reg_bit_err_num_freeze
2005*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(EQE_REG_BASE+0x3d, ®_frz);
2006*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteReg(EQE_REG_BASE+0x3d, reg_frz|0x01);
2007*53ee8cc1Swenshuai.xi
2008*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(EQE2_REG_BASE + 0x75, ®);
2009*53ee8cc1Swenshuai.xi RegCfo_offset = reg;
2010*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(EQE2_REG_BASE + 0x74, ®);
2011*53ee8cc1Swenshuai.xi RegCfo_offset = (RegCfo_offset<<8)|reg;
2012*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(EQE2_REG_BASE + 0x73, ®);
2013*53ee8cc1Swenshuai.xi RegCfo_offset = (RegCfo_offset<<8)|reg;
2014*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(EQE2_REG_BASE + 0x72, ®);
2015*53ee8cc1Swenshuai.xi RegCfo_offset = (RegCfo_offset<<8)|reg;
2016*53ee8cc1Swenshuai.xi
2017*53ee8cc1Swenshuai.xi // bank 2c 0x3d [0] reg_bit_err_num_freeze
2018*53ee8cc1Swenshuai.xi reg_frz=reg_frz&(~0x01);
2019*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteReg(EQE_REG_BASE+0x3d, reg_frz);
2020*53ee8cc1Swenshuai.xi
2021*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDF_REG_BASE + 0x5b, ®);
2022*53ee8cc1Swenshuai.xi Reg_Fc_over_Fs = reg;
2023*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDF_REG_BASE + 0x5a, ®);
2024*53ee8cc1Swenshuai.xi Reg_Fc_over_Fs = (Reg_Fc_over_Fs<<8)|reg;
2025*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDF_REG_BASE + 0x59, ®);
2026*53ee8cc1Swenshuai.xi Reg_Fc_over_Fs = (Reg_Fc_over_Fs<<8)|reg;
2027*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDF_REG_BASE + 0x58, ®);
2028*53ee8cc1Swenshuai.xi Reg_Fc_over_Fs = (Reg_Fc_over_Fs<<8)|reg;
2029*53ee8cc1Swenshuai.xi
2030*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadDSPReg(E_DMD_DVBC_CFG_FC_H, ®);
2031*53ee8cc1Swenshuai.xi config_Fc = reg;
2032*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadDSPReg(E_DMD_DVBC_CFG_FC_L, ®);
2033*53ee8cc1Swenshuai.xi config_Fc = (config_Fc<<8)|reg;
2034*53ee8cc1Swenshuai.xi
2035*53ee8cc1Swenshuai.xi f_Fc = (float)Reg_Fc_over_Fs/134217728.0f * 45473.0f;
2036*53ee8cc1Swenshuai.xi
2037*53ee8cc1Swenshuai.xi FreqCfo_offset = (MS_S32)(RegCfo_offset<<4)/16;
2038*53ee8cc1Swenshuai.xi
2039*53ee8cc1Swenshuai.xi FreqCfo_offset = FreqCfo_offset/0x8000000/8.0f;
2040*53ee8cc1Swenshuai.xi
2041*53ee8cc1Swenshuai.xi status &= INTERN_DVBC_GetCurrentSymbolRate(&FreqB);
2042*53ee8cc1Swenshuai.xi
2043*53ee8cc1Swenshuai.xi FreqCfo_offset = FreqCfo_offset * FreqB - (f_Fc-(float)config_Fc);
2044*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC_LOCK(printf("[dvbc]Freq_Offset = %f KHz, Reg_offset = 0x%lx, Reg_Fc_over_Fs=0x%lx, SR = %d KS/s, Fc = %f %d\n",
2045*53ee8cc1Swenshuai.xi FreqCfo_offset,RegCfo_offset,Reg_Fc_over_Fs,FreqB,f_Fc,config_Fc));
2046*53ee8cc1Swenshuai.xi
2047*53ee8cc1Swenshuai.xi *pFreqOff = FreqCfo_offset;
2048*53ee8cc1Swenshuai.xi
2049*53ee8cc1Swenshuai.xi return status;
2050*53ee8cc1Swenshuai.xi }
2051*53ee8cc1Swenshuai.xi
2052*53ee8cc1Swenshuai.xi
2053*53ee8cc1Swenshuai.xi
INTERN_DVBC_Power_ON_OFF(MS_U8 bPowerOn)2054*53ee8cc1Swenshuai.xi void INTERN_DVBC_Power_ON_OFF(MS_U8 bPowerOn)
2055*53ee8cc1Swenshuai.xi {
2056*53ee8cc1Swenshuai.xi
2057*53ee8cc1Swenshuai.xi bPowerOn = bPowerOn;
2058*53ee8cc1Swenshuai.xi }
2059*53ee8cc1Swenshuai.xi
INTERN_DVBC_Power_Save(void)2060*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_Power_Save(void)
2061*53ee8cc1Swenshuai.xi {
2062*53ee8cc1Swenshuai.xi
2063*53ee8cc1Swenshuai.xi return TRUE;
2064*53ee8cc1Swenshuai.xi }
2065*53ee8cc1Swenshuai.xi
2066*53ee8cc1Swenshuai.xi /****************************************************************************
2067*53ee8cc1Swenshuai.xi Subject: To get the current modulation type at the DVB-C Demod
2068*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_GetCurrentModulationType
2069*53ee8cc1Swenshuai.xi Parmeter: pointer for return QAM type
2070*53ee8cc1Swenshuai.xi
2071*53ee8cc1Swenshuai.xi Return: TRUE
2072*53ee8cc1Swenshuai.xi FALSE
2073*53ee8cc1Swenshuai.xi Remark:
2074*53ee8cc1Swenshuai.xi *****************************************************************************/
INTERN_DVBC_GetCurrentModulationType(DMD_DVBC_MODULATION_TYPE * pQAMMode)2075*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_GetCurrentModulationType(DMD_DVBC_MODULATION_TYPE *pQAMMode)
2076*53ee8cc1Swenshuai.xi {
2077*53ee8cc1Swenshuai.xi MS_U8 u8Data=0;
2078*53ee8cc1Swenshuai.xi
2079*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC(printf("INTERN_DVBC_GetCurrentModulationType\n"));
2080*53ee8cc1Swenshuai.xi
2081*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(EQE2_REG_BASE + 0xC4, &u8Data);
2082*53ee8cc1Swenshuai.xi
2083*53ee8cc1Swenshuai.xi switch(u8Data&0x07)
2084*53ee8cc1Swenshuai.xi {
2085*53ee8cc1Swenshuai.xi case 0:
2086*53ee8cc1Swenshuai.xi *pQAMMode = DMD_DVBC_QAM16;
2087*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC_LOCK(printf("[dvbc]QAM=16\n"));
2088*53ee8cc1Swenshuai.xi return TRUE;
2089*53ee8cc1Swenshuai.xi break;
2090*53ee8cc1Swenshuai.xi case 1:
2091*53ee8cc1Swenshuai.xi *pQAMMode = DMD_DVBC_QAM32;
2092*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC_LOCK(printf("[dvbc]QAM=32\n"));
2093*53ee8cc1Swenshuai.xi return TRUE;
2094*53ee8cc1Swenshuai.xi break;
2095*53ee8cc1Swenshuai.xi case 2:
2096*53ee8cc1Swenshuai.xi *pQAMMode = DMD_DVBC_QAM64;
2097*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC_LOCK(printf("[dvbc]QAM=64\n"));
2098*53ee8cc1Swenshuai.xi return TRUE;
2099*53ee8cc1Swenshuai.xi break;
2100*53ee8cc1Swenshuai.xi case 3:
2101*53ee8cc1Swenshuai.xi *pQAMMode = DMD_DVBC_QAM128;
2102*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC_LOCK(printf("[dvbc]QAM=128\n"));
2103*53ee8cc1Swenshuai.xi return TRUE;
2104*53ee8cc1Swenshuai.xi break;
2105*53ee8cc1Swenshuai.xi case 4:
2106*53ee8cc1Swenshuai.xi *pQAMMode = DMD_DVBC_QAM256;
2107*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC_LOCK(printf("[dvbc]QAM=256\n"));
2108*53ee8cc1Swenshuai.xi return TRUE;
2109*53ee8cc1Swenshuai.xi break;
2110*53ee8cc1Swenshuai.xi default:
2111*53ee8cc1Swenshuai.xi *pQAMMode = DMD_DVBC_QAMAUTO;
2112*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC_LOCK(printf("[dvbc]QAM=invalid\n"));
2113*53ee8cc1Swenshuai.xi return FALSE;
2114*53ee8cc1Swenshuai.xi }
2115*53ee8cc1Swenshuai.xi }
2116*53ee8cc1Swenshuai.xi
2117*53ee8cc1Swenshuai.xi /****************************************************************************
2118*53ee8cc1Swenshuai.xi Subject: To get the current symbol rate at the DVB-C Demod
2119*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_GetCurrentSymbolRate
2120*53ee8cc1Swenshuai.xi Parmeter: pointer pData for return Symbolrate
2121*53ee8cc1Swenshuai.xi
2122*53ee8cc1Swenshuai.xi Return: TRUE
2123*53ee8cc1Swenshuai.xi FALSE
2124*53ee8cc1Swenshuai.xi Remark:
2125*53ee8cc1Swenshuai.xi *****************************************************************************/
INTERN_DVBC_GetCurrentSymbolRate(MS_U16 * u16SymbolRate)2126*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_GetCurrentSymbolRate(MS_U16 *u16SymbolRate)
2127*53ee8cc1Swenshuai.xi {
2128*53ee8cc1Swenshuai.xi MS_U8 tmp = 0;
2129*53ee8cc1Swenshuai.xi MS_U16 u16SymbolRateTmp = 0;
2130*53ee8cc1Swenshuai.xi
2131*53ee8cc1Swenshuai.xi // intp
2132*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TOP_REG_BASE + 0xd2, &tmp);
2133*53ee8cc1Swenshuai.xi u16SymbolRateTmp = tmp;
2134*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TOP_REG_BASE + 0xd1, &tmp);
2135*53ee8cc1Swenshuai.xi u16SymbolRateTmp = (u16SymbolRateTmp<<8)|tmp;
2136*53ee8cc1Swenshuai.xi
2137*53ee8cc1Swenshuai.xi if (abs(u16SymbolRateTmp-6900)<2)
2138*53ee8cc1Swenshuai.xi {
2139*53ee8cc1Swenshuai.xi u16SymbolRateTmp=6900;
2140*53ee8cc1Swenshuai.xi }
2141*53ee8cc1Swenshuai.xi
2142*53ee8cc1Swenshuai.xi if (abs(u16SymbolRateTmp-6875)<2)
2143*53ee8cc1Swenshuai.xi {
2144*53ee8cc1Swenshuai.xi u16SymbolRateTmp=6875;
2145*53ee8cc1Swenshuai.xi }
2146*53ee8cc1Swenshuai.xi
2147*53ee8cc1Swenshuai.xi *u16SymbolRate = u16SymbolRateTmp;
2148*53ee8cc1Swenshuai.xi
2149*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC_LOCK(printf("[dvbc]SR=%d\n",*u16SymbolRate));
2150*53ee8cc1Swenshuai.xi
2151*53ee8cc1Swenshuai.xi return TRUE;
2152*53ee8cc1Swenshuai.xi }
2153*53ee8cc1Swenshuai.xi
2154*53ee8cc1Swenshuai.xi
2155*53ee8cc1Swenshuai.xi /****************************************************************************
2156*53ee8cc1Swenshuai.xi Subject: To get the current symbol rate offset at the DVB-C Demod
2157*53ee8cc1Swenshuai.xi Function: INTERN_DVBC_GetCurrentSymbolRate
2158*53ee8cc1Swenshuai.xi Parmeter: pointer pData for return Symbolrate offset
2159*53ee8cc1Swenshuai.xi
2160*53ee8cc1Swenshuai.xi Return: TRUE
2161*53ee8cc1Swenshuai.xi FALSE
2162*53ee8cc1Swenshuai.xi Remark:
2163*53ee8cc1Swenshuai.xi *****************************************************************************/
INTERN_DVBC_GetCurrentSymbolRateOffset(MS_U16 * pData)2164*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_GetCurrentSymbolRateOffset(MS_U16 *pData)
2165*53ee8cc1Swenshuai.xi {
2166*53ee8cc1Swenshuai.xi MS_U8 u8Data = 0, reg_frz = 0;
2167*53ee8cc1Swenshuai.xi MS_U32 u32Data = 0;
2168*53ee8cc1Swenshuai.xi // MS_S32 s32Data = 0;
2169*53ee8cc1Swenshuai.xi MS_BOOL status = TRUE;
2170*53ee8cc1Swenshuai.xi MS_U16 u16SymbolRate = 0;
2171*53ee8cc1Swenshuai.xi float f_symb_offset = 0.0f;
2172*53ee8cc1Swenshuai.xi
2173*53ee8cc1Swenshuai.xi
2174*53ee8cc1Swenshuai.xi
2175*53ee8cc1Swenshuai.xi // bank 26 0x03 [7] reg_bit_err_num_freeze
2176*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(INNC_REG_BASE+0x03, ®_frz);
2177*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteReg(INNC_REG_BASE+0x03, reg_frz|0x80);
2178*53ee8cc1Swenshuai.xi
2179*53ee8cc1Swenshuai.xi // sel, SFO debug output.
2180*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(INNC_REG_BASE+0x2F, &u8Data);
2181*53ee8cc1Swenshuai.xi u32Data = u8Data;
2182*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(INNC_REG_BASE+0x2E, &u8Data);
2183*53ee8cc1Swenshuai.xi u32Data = (u32Data<<8)|u8Data;
2184*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(INNC_REG_BASE+0x2D, &u8Data);
2185*53ee8cc1Swenshuai.xi u32Data = (u32Data<<8)|u8Data;
2186*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(INNC_REG_BASE+0x2C, &u8Data);
2187*53ee8cc1Swenshuai.xi u32Data = (u32Data<<8)|u8Data;
2188*53ee8cc1Swenshuai.xi
2189*53ee8cc1Swenshuai.xi // bank 26 0x03 [7] reg_bit_err_num_freeze
2190*53ee8cc1Swenshuai.xi reg_frz=reg_frz&(~0x80);
2191*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteReg(INNC_REG_BASE+0x03, reg_frz);
2192*53ee8cc1Swenshuai.xi // s32Data = (MS_S32)(u32Data<<8);
2193*53ee8cc1Swenshuai.xi
2194*53ee8cc1Swenshuai.xi printf("[dvbc]u32_symb_offset = 0x%x\n",(unsigned int)u32Data);
2195*53ee8cc1Swenshuai.xi
2196*53ee8cc1Swenshuai.xi status &= INTERN_DVBC_GetCurrentSymbolRate(&u16SymbolRate);
2197*53ee8cc1Swenshuai.xi
2198*53ee8cc1Swenshuai.xi // sfo = Reg*2^(-37)*FB/FS*1000000 (2^-28 * 1000000 = 0.003725)
2199*53ee8cc1Swenshuai.xi f_symb_offset = (float)((MS_S32)u32Data) * (1000000.0f/powf(2.0f, 37.0f)) * (float)u16SymbolRate/(float)DVBC_FS;
2200*53ee8cc1Swenshuai.xi
2201*53ee8cc1Swenshuai.xi *pData = (MS_U16)(f_symb_offset + 0.5f);
2202*53ee8cc1Swenshuai.xi
2203*53ee8cc1Swenshuai.xi DBG_INTERN_DVBC_LOCK(printf("[dvbc]sfo_offset = %d,%f\n",*pData, f_symb_offset));
2204*53ee8cc1Swenshuai.xi
2205*53ee8cc1Swenshuai.xi return status;
2206*53ee8cc1Swenshuai.xi }
2207*53ee8cc1Swenshuai.xi
INTERN_DVBC_Version(MS_U16 * ver)2208*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_Version(MS_U16 *ver)
2209*53ee8cc1Swenshuai.xi {
2210*53ee8cc1Swenshuai.xi
2211*53ee8cc1Swenshuai.xi MS_U8 status = true;
2212*53ee8cc1Swenshuai.xi MS_U8 tmp = 0;
2213*53ee8cc1Swenshuai.xi MS_U16 u16_INTERN_DVBC_Version;
2214*53ee8cc1Swenshuai.xi
2215*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TOP_REG_BASE + 0xC1, &tmp);
2216*53ee8cc1Swenshuai.xi u16_INTERN_DVBC_Version = tmp;
2217*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TOP_REG_BASE + 0xC2, &tmp);
2218*53ee8cc1Swenshuai.xi u16_INTERN_DVBC_Version = u16_INTERN_DVBC_Version<<8|tmp;
2219*53ee8cc1Swenshuai.xi *ver = u16_INTERN_DVBC_Version;
2220*53ee8cc1Swenshuai.xi
2221*53ee8cc1Swenshuai.xi return status;
2222*53ee8cc1Swenshuai.xi }
2223*53ee8cc1Swenshuai.xi
2224*53ee8cc1Swenshuai.xi
INTERN_DVBC_Show_Demod_Version(void)2225*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_Show_Demod_Version(void)
2226*53ee8cc1Swenshuai.xi {
2227*53ee8cc1Swenshuai.xi
2228*53ee8cc1Swenshuai.xi MS_BOOL status = true;
2229*53ee8cc1Swenshuai.xi MS_U16 u16_INTERN_DVBC_Version;
2230*53ee8cc1Swenshuai.xi
2231*53ee8cc1Swenshuai.xi status &= INTERN_DVBC_Version(&u16_INTERN_DVBC_Version);
2232*53ee8cc1Swenshuai.xi
2233*53ee8cc1Swenshuai.xi printf("[DVBC]Version = %x\n",u16_INTERN_DVBC_Version);
2234*53ee8cc1Swenshuai.xi
2235*53ee8cc1Swenshuai.xi return status;
2236*53ee8cc1Swenshuai.xi }
2237*53ee8cc1Swenshuai.xi
2238*53ee8cc1Swenshuai.xi
2239*53ee8cc1Swenshuai.xi
2240*53ee8cc1Swenshuai.xi #if (INTERN_DVBC_INTERNAL_DEBUG)
2241*53ee8cc1Swenshuai.xi
INTERN_DVBC_Show_AGC_Info(void)2242*53ee8cc1Swenshuai.xi MS_BOOL INTERN_DVBC_Show_AGC_Info(void)
2243*53ee8cc1Swenshuai.xi {
2244*53ee8cc1Swenshuai.xi MS_U8 tmp = 0;
2245*53ee8cc1Swenshuai.xi MS_U8 agc_k = 0,agc_ref = 0,d1_k = 0,d1_ref = 0,d2_k = 0,d2_ref = 0;
2246*53ee8cc1Swenshuai.xi MS_U16 if_agc_gain = 0,d1_gain = 0,d2_gain = 0;
2247*53ee8cc1Swenshuai.xi MS_U16 if_agc_err = 0;
2248*53ee8cc1Swenshuai.xi MS_BOOL status = TRUE;
2249*53ee8cc1Swenshuai.xi
2250*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x11,&agc_k);
2251*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x13,&agc_ref);
2252*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0xB0,&d1_k);
2253*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0xB1,&d1_ref);
2254*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0xC0,&d2_k);
2255*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0xC1,&d2_ref);
2256*53ee8cc1Swenshuai.xi
2257*53ee8cc1Swenshuai.xi
2258*53ee8cc1Swenshuai.xi // select IF gain to read
2259*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x22, &tmp);
2260*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteReg(TDP_REG_BASE + 0x22, (tmp&0xF0)|0x03);
2261*53ee8cc1Swenshuai.xi
2262*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x25, &tmp);
2263*53ee8cc1Swenshuai.xi if_agc_gain = tmp;
2264*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x24, &tmp);
2265*53ee8cc1Swenshuai.xi if_agc_gain = (if_agc_gain<<8)|tmp;
2266*53ee8cc1Swenshuai.xi
2267*53ee8cc1Swenshuai.xi
2268*53ee8cc1Swenshuai.xi // select d1 gain to read.
2269*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0xb6, &tmp);
2270*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteReg(TDP_REG_BASE + 0xb6, (tmp&0xF0)|0x02);
2271*53ee8cc1Swenshuai.xi
2272*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0xb9, &tmp);
2273*53ee8cc1Swenshuai.xi d1_gain = tmp;
2274*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0xb8, &tmp);
2275*53ee8cc1Swenshuai.xi d1_gain = (d1_gain<<8)|tmp;
2276*53ee8cc1Swenshuai.xi
2277*53ee8cc1Swenshuai.xi // select d2 gain to read.
2278*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0xc6, &tmp);
2279*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteReg(TDP_REG_BASE + 0xc6, (tmp&0xF0)|0x02);
2280*53ee8cc1Swenshuai.xi
2281*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0xc9, &tmp);
2282*53ee8cc1Swenshuai.xi d2_gain = tmp;
2283*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0xc8, &tmp);
2284*53ee8cc1Swenshuai.xi d2_gain = (d2_gain<<8)|tmp;
2285*53ee8cc1Swenshuai.xi
2286*53ee8cc1Swenshuai.xi // select IF gain err to read
2287*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x22, &tmp);
2288*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_WriteReg(TDP_REG_BASE + 0x22, (tmp&0xF0)|0x00);
2289*53ee8cc1Swenshuai.xi
2290*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x25, &tmp);
2291*53ee8cc1Swenshuai.xi if_agc_err = tmp;
2292*53ee8cc1Swenshuai.xi status &= MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x24, &tmp);
2293*53ee8cc1Swenshuai.xi if_agc_err = (if_agc_err<<8)|tmp;
2294*53ee8cc1Swenshuai.xi
2295*53ee8cc1Swenshuai.xi printf("[dvbc]agc_k=0x%x, agc_ref=0x%x, d1_k=0x%x, d1_ref=0x%x, d2_k=0x%x, d2_ref=0x%x\n",
2296*53ee8cc1Swenshuai.xi agc_k,agc_ref,d1_k,d1_ref,d2_k,d2_ref);
2297*53ee8cc1Swenshuai.xi
2298*53ee8cc1Swenshuai.xi printf("[dvbc]agc_g=0x%x, d1_g=0x%x, d2_g=0x%x, agc_err=0x%x\n",if_agc_gain,d1_gain,d2_gain,if_agc_err);
2299*53ee8cc1Swenshuai.xi
2300*53ee8cc1Swenshuai.xi return status;
2301*53ee8cc1Swenshuai.xi }
2302*53ee8cc1Swenshuai.xi
INTERN_DVBC_info(void)2303*53ee8cc1Swenshuai.xi void INTERN_DVBC_info(void)
2304*53ee8cc1Swenshuai.xi {
2305*53ee8cc1Swenshuai.xi MS_U32 fb_fs = 0, fc_fs = 0, tr_error = 0, crv = 0, intp = 0;
2306*53ee8cc1Swenshuai.xi MS_U8 qam,tmp = 0;
2307*53ee8cc1Swenshuai.xi MS_U8 fft_u8 = 0;
2308*53ee8cc1Swenshuai.xi MS_U16 fft_u16bw = 0;
2309*53ee8cc1Swenshuai.xi MS_U16 version = 0,packetErr = 0,quality = 0,symb_rate = 0,symb_offset = 0;
2310*53ee8cc1Swenshuai.xi float f_snr = 0,f_freq = 0;
2311*53ee8cc1Swenshuai.xi DMD_DVBC_MODULATION_TYPE QAMMode = 0;
2312*53ee8cc1Swenshuai.xi MS_U16 f_start = 0,f_end = 0;
2313*53ee8cc1Swenshuai.xi MS_U8 s0_count = 0;
2314*53ee8cc1Swenshuai.xi MS_U8 sc4 = 0,sc3 = 0;
2315*53ee8cc1Swenshuai.xi MS_U8 kp0, kp1, kp2, kp3,kp4, fmax, era_th;
2316*53ee8cc1Swenshuai.xi MS_U16 aci_e0,aci_e1,aci_e2,aci_e3;
2317*53ee8cc1Swenshuai.xi MS_U16 count = 0;
2318*53ee8cc1Swenshuai.xi MS_U16 fb_i_1,fb_q_1;
2319*53ee8cc1Swenshuai.xi MS_U8 e0,e1,e2,e3;
2320*53ee8cc1Swenshuai.xi MS_S16 reg_freq;
2321*53ee8cc1Swenshuai.xi float freq,mag;
2322*53ee8cc1Swenshuai.xi
2323*53ee8cc1Swenshuai.xi
2324*53ee8cc1Swenshuai.xi
2325*53ee8cc1Swenshuai.xi INTERN_DVBC_Version(&version);
2326*53ee8cc1Swenshuai.xi
2327*53ee8cc1Swenshuai.xi // fb_fs
2328*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x53, &tmp);
2329*53ee8cc1Swenshuai.xi fb_fs = tmp;
2330*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x52, &tmp);
2331*53ee8cc1Swenshuai.xi fb_fs = (fb_fs<<8)|tmp;
2332*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x51, &tmp);
2333*53ee8cc1Swenshuai.xi fb_fs = (fb_fs<<8)|tmp;
2334*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x50, &tmp);
2335*53ee8cc1Swenshuai.xi fb_fs = (fb_fs<<8)|tmp;
2336*53ee8cc1Swenshuai.xi // fc_fs
2337*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x57, &tmp);
2338*53ee8cc1Swenshuai.xi fc_fs = tmp;
2339*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x56, &tmp);
2340*53ee8cc1Swenshuai.xi fc_fs = (fc_fs<<8)|tmp;
2341*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x55, &tmp);
2342*53ee8cc1Swenshuai.xi fc_fs = (fc_fs<<8)|tmp;
2343*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x54, &tmp);
2344*53ee8cc1Swenshuai.xi fc_fs = (fc_fs<<8)|tmp;
2345*53ee8cc1Swenshuai.xi // crv
2346*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(EQE_REG_BASE + 0x43, &tmp);
2347*53ee8cc1Swenshuai.xi crv = tmp;
2348*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(EQE_REG_BASE + 0x42, &tmp);
2349*53ee8cc1Swenshuai.xi crv = (crv<<8)|tmp;
2350*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(EQE_REG_BASE + 0x41, &tmp);
2351*53ee8cc1Swenshuai.xi crv = (crv<<8)|tmp;
2352*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(EQE_REG_BASE + 0x40, &tmp);
2353*53ee8cc1Swenshuai.xi crv = (crv<<8)|tmp;
2354*53ee8cc1Swenshuai.xi // tr_error
2355*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(INNC_REG_BASE + 0x4E, &tmp);
2356*53ee8cc1Swenshuai.xi tr_error = tmp;
2357*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(INNC_REG_BASE + 0x4D, &tmp);
2358*53ee8cc1Swenshuai.xi tr_error = (tr_error<<8)|tmp;
2359*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(INNC_REG_BASE + 0x4C, &tmp);
2360*53ee8cc1Swenshuai.xi tr_error = (tr_error<<8)|tmp;
2361*53ee8cc1Swenshuai.xi
2362*53ee8cc1Swenshuai.xi // intp
2363*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0xD3, &tmp);
2364*53ee8cc1Swenshuai.xi intp = tmp;
2365*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0xD2, &tmp);
2366*53ee8cc1Swenshuai.xi intp = (intp<<8)|tmp;
2367*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0xD1, &tmp);
2368*53ee8cc1Swenshuai.xi intp = (intp<<8)|tmp;
2369*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0xD0, &tmp);
2370*53ee8cc1Swenshuai.xi intp = (intp<<8)|tmp;
2371*53ee8cc1Swenshuai.xi
2372*53ee8cc1Swenshuai.xi // fft info
2373*53ee8cc1Swenshuai.xi // intp
2374*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDE_REG_BASE + 0x93, &tmp);
2375*53ee8cc1Swenshuai.xi fft_u16bw = tmp;
2376*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDE_REG_BASE + 0x92, &tmp);
2377*53ee8cc1Swenshuai.xi fft_u16bw = (fft_u16bw<<8)|tmp;
2378*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDE_REG_BASE + 0x96, &tmp);
2379*53ee8cc1Swenshuai.xi fft_u8 = tmp;
2380*53ee8cc1Swenshuai.xi
2381*53ee8cc1Swenshuai.xi
2382*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(EQE_REG_BASE + 0x02, &tmp);
2383*53ee8cc1Swenshuai.xi qam = tmp;
2384*53ee8cc1Swenshuai.xi
2385*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TOP_REG_BASE + 0xE0, &tmp);
2386*53ee8cc1Swenshuai.xi f_start = tmp;
2387*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TOP_REG_BASE + 0xE1, &tmp);
2388*53ee8cc1Swenshuai.xi f_start = (f_start<<8)|tmp;
2389*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TOP_REG_BASE + 0xE2, &tmp);
2390*53ee8cc1Swenshuai.xi f_end = tmp;
2391*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TOP_REG_BASE + 0xE3, &tmp);
2392*53ee8cc1Swenshuai.xi f_end = (f_end<<8)|tmp;
2393*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TOP_REG_BASE + 0xE4, &tmp);
2394*53ee8cc1Swenshuai.xi s0_count = tmp;
2395*53ee8cc1Swenshuai.xi
2396*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TOP_REG_BASE + 0xC3, &sc3);
2397*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TOP_REG_BASE + 0xC4, &sc4);
2398*53ee8cc1Swenshuai.xi
2399*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(EQE_REG_BASE + 0x04, &kp0);
2400*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(EQE_REG_BASE + 0x05, &kp1);
2401*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(EQE_REG_BASE + 0x06, &kp2);
2402*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(EQE_REG_BASE + 0x07, &kp3);
2403*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(EQE_REG_BASE + 0x08, &kp4);
2404*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(EQE_REG_BASE + 0x0B, &fmax);
2405*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(EQE_REG_BASE + 0x49, &era_th);
2406*53ee8cc1Swenshuai.xi
2407*53ee8cc1Swenshuai.xi
2408*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_WriteReg(TDP_REG_BASE + 0x81, 0x00);
2409*53ee8cc1Swenshuai.xi
2410*53ee8cc1Swenshuai.xi count = 0x400;
2411*53ee8cc1Swenshuai.xi while(count--);
2412*53ee8cc1Swenshuai.xi
2413*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x85, &tmp);
2414*53ee8cc1Swenshuai.xi aci_e0 = tmp&0x0f;
2415*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x84, &tmp);
2416*53ee8cc1Swenshuai.xi aci_e0 = aci_e0<<8|tmp;
2417*53ee8cc1Swenshuai.xi
2418*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_WriteReg(TDP_REG_BASE + 0x81, 0x01);
2419*53ee8cc1Swenshuai.xi
2420*53ee8cc1Swenshuai.xi count = 0x400;
2421*53ee8cc1Swenshuai.xi while(count--);
2422*53ee8cc1Swenshuai.xi
2423*53ee8cc1Swenshuai.xi
2424*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x85, &tmp);
2425*53ee8cc1Swenshuai.xi aci_e1 = tmp&0x0f;
2426*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x84, &tmp);
2427*53ee8cc1Swenshuai.xi aci_e1 = aci_e1<<8|tmp;
2428*53ee8cc1Swenshuai.xi
2429*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_WriteReg(TDP_REG_BASE + 0x81, 0x02);
2430*53ee8cc1Swenshuai.xi
2431*53ee8cc1Swenshuai.xi count = 0x400;
2432*53ee8cc1Swenshuai.xi while(count--);
2433*53ee8cc1Swenshuai.xi
2434*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x85, &tmp);
2435*53ee8cc1Swenshuai.xi aci_e2 = tmp&0x0f;
2436*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x84, &tmp);
2437*53ee8cc1Swenshuai.xi aci_e2 = aci_e2<<8|tmp;
2438*53ee8cc1Swenshuai.xi
2439*53ee8cc1Swenshuai.xi // read aci coef
2440*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_WriteReg(TDP_REG_BASE + 0x81, 0x03);
2441*53ee8cc1Swenshuai.xi
2442*53ee8cc1Swenshuai.xi count = 0x400;
2443*53ee8cc1Swenshuai.xi while(count--);
2444*53ee8cc1Swenshuai.xi
2445*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x85, &tmp);
2446*53ee8cc1Swenshuai.xi aci_e3 = tmp&0x0f;
2447*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDP_REG_BASE + 0x84, &tmp);
2448*53ee8cc1Swenshuai.xi aci_e3 = aci_e3<<8|tmp;
2449*53ee8cc1Swenshuai.xi
2450*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDE_REG_BASE + 0x13, &tmp);
2451*53ee8cc1Swenshuai.xi fb_i_1 = tmp;
2452*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDE_REG_BASE + 0x12, &tmp);
2453*53ee8cc1Swenshuai.xi fb_i_1 = fb_i_1<<8|tmp;
2454*53ee8cc1Swenshuai.xi
2455*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDE_REG_BASE + 0x15, &tmp);
2456*53ee8cc1Swenshuai.xi fb_q_1 = tmp;
2457*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TDE_REG_BASE + 0x14, &tmp);
2458*53ee8cc1Swenshuai.xi fb_q_1 = fb_q_1<<8|tmp;
2459*53ee8cc1Swenshuai.xi
2460*53ee8cc1Swenshuai.xi
2461*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TOP_REG_BASE + 0xE0, &e0);
2462*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TOP_REG_BASE + 0xE1, &e1);
2463*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TOP_REG_BASE + 0xE2, &e2);
2464*53ee8cc1Swenshuai.xi MDrv_SYS_DMD_VD_MBX_ReadReg(TOP_REG_BASE + 0xE3, &e3);
2465*53ee8cc1Swenshuai.xi
2466*53ee8cc1Swenshuai.xi reg_freq = (MS_S16)((MS_U16)e1)<<8|e0;
2467*53ee8cc1Swenshuai.xi freq = (float)reg_freq*45473.0/65536.0;
2468*53ee8cc1Swenshuai.xi mag = (float)(((MS_U16)e3)<<8|e2)/65536.0;
2469*53ee8cc1Swenshuai.xi
2470*53ee8cc1Swenshuai.xi
2471*53ee8cc1Swenshuai.xi INTERN_DVBC_GetPacketErr(&packetErr);
2472*53ee8cc1Swenshuai.xi INTERN_DVBC_GetSNR(&f_snr);
2473*53ee8cc1Swenshuai.xi INTERN_DVBC_Show_AGC_Info();
2474*53ee8cc1Swenshuai.xi INTERN_DVBC_GetSignalQuality(&quality,NULL,0, 200.0f);
2475*53ee8cc1Swenshuai.xi INTERN_DVBC_Get_FreqOffset(&f_freq,8);
2476*53ee8cc1Swenshuai.xi INTERN_DVBC_GetCurrentSymbolRate(&symb_rate);
2477*53ee8cc1Swenshuai.xi INTERN_DVBC_GetCurrentSymbolRateOffset(&symb_offset);
2478*53ee8cc1Swenshuai.xi INTERN_DVBC_GetCurrentModulationType(&QAMMode);
2479*53ee8cc1Swenshuai.xi
2480*53ee8cc1Swenshuai.xi printf("[MStar_1][1]0x%x,[2]0x%lx,[3]0x%lx,[4]0x%lx,[5]0x%lx,[6]0x%x,[7]%d\n",version,fb_fs,fc_fs,tr_error,crv,qam,packetErr);
2481*53ee8cc1Swenshuai.xi printf("[MStar_2][1]%f,[2]0x%lx,[3]%d,[4]%f,[5]%d,[6]%d,[7]%d\n",f_snr,intp,quality,f_freq,symb_rate,symb_offset,packetErr);
2482*53ee8cc1Swenshuai.xi printf("[Mstar_3][1]0x%x,[2]0x%x,[3]0x%x,[4]0x%x,[5]%d,[6]0x%x,[7]0x%x\n",fft_u16bw,fft_u8,f_end,f_start,s0_count,sc3,sc4);
2483*53ee8cc1Swenshuai.xi printf("[Mstar_4][1]0x%x,[2]0x%x,[3]0x%x,[4]0x%x,[5]0x%x,[6]0x%x,[7]0x%x\n",kp0,kp1,kp2,kp3,kp4,fmax,era_th);
2484*53ee8cc1Swenshuai.xi printf("[Mstar_5][1]0x%x,[2]0x%x,[3]0x%x,[4]0x%x,[5]0x%x,[6]0x%x,[7]0x%x\n",aci_e0,aci_e1,aci_e2,aci_e3,fb_i_1,fb_q_1,era_th);
2485*53ee8cc1Swenshuai.xi printf("[Mstar_6][1]%f,[2]%f,[3]0x%x,[4]0x%x,[5]0x%x,[6]0x%x,[7]0x%x\n",freq,mag,aci_e2,aci_e3,fb_i_1,fb_q_1,era_th);
2486*53ee8cc1Swenshuai.xi return;
2487*53ee8cc1Swenshuai.xi }
2488*53ee8cc1Swenshuai.xi
2489*53ee8cc1Swenshuai.xi
2490*53ee8cc1Swenshuai.xi #endif
2491*53ee8cc1Swenshuai.xi
2492*53ee8cc1Swenshuai.xi /***********************************************************************************
2493*53ee8cc1Swenshuai.xi Subject: read register
2494*53ee8cc1Swenshuai.xi Function: MDrv_1210_IIC_Bypass_Mode
2495*53ee8cc1Swenshuai.xi Parmeter:
2496*53ee8cc1Swenshuai.xi Return:
2497*53ee8cc1Swenshuai.xi Remark:
2498*53ee8cc1Swenshuai.xi ************************************************************************************/
2499*53ee8cc1Swenshuai.xi //void MDrv_1210_IIC_Bypass_Mode(MS_BOOL enable)
2500*53ee8cc1Swenshuai.xi //{
2501*53ee8cc1Swenshuai.xi // UNUSED(enable);
2502*53ee8cc1Swenshuai.xi // if (enable)
2503*53ee8cc1Swenshuai.xi // MDrv_SYS_DMD_VD_MBX_WriteReg(0x8010, 0x10); // IIC by-pass mode on
2504*53ee8cc1Swenshuai.xi // else
2505*53ee8cc1Swenshuai.xi // MDrv_SYS_DMD_VD_MBX_WriteReg(0x8010, 0x00); // IIC by-pass mode off
2506*53ee8cc1Swenshuai.xi //}
2507