xref: /utopia/UTPA2-700.0.x/modules/dscmb/hal/curry/nsk2/halEMMflt.c (revision 53ee8cc121a030b8d368113ac3e966b4705770ef)
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) 2008-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 #define _HAL_EMMFLT_C
94*53ee8cc1Swenshuai.xi 
95*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
96*53ee8cc1Swenshuai.xi /// @file halEMMflt.c
97*53ee8cc1Swenshuai.xi /// @author MStar Semiconductor Inc.
98*53ee8cc1Swenshuai.xi /// @brief
99*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
100*53ee8cc1Swenshuai.xi 
101*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
102*53ee8cc1Swenshuai.xi // Header Files
103*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
104*53ee8cc1Swenshuai.xi #include "MsCommon.h"
105*53ee8cc1Swenshuai.xi #include "MsTypes.h"
106*53ee8cc1Swenshuai.xi #include "drvEMMFlt.h"
107*53ee8cc1Swenshuai.xi #include "halEMMflt.h"
108*53ee8cc1Swenshuai.xi #include "regEMMflt.h"
109*53ee8cc1Swenshuai.xi #include "../../include/drvNSK2Type.h"
110*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
111*53ee8cc1Swenshuai.xi // Define & data type
112*53ee8cc1Swenshuai.xi ///////////////////////////////////////////////////////////////////////////////
113*53ee8cc1Swenshuai.xi //0x113c for emm filter..
114*53ee8cc1Swenshuai.xi 
115*53ee8cc1Swenshuai.xi //0x100B
116*53ee8cc1Swenshuai.xi #define CLKGEN0_REG(addr)       (*((volatile MS_U16*)(_gCLKGEN0_Addr + ((addr)<<2))))
117*53ee8cc1Swenshuai.xi 
118*53ee8cc1Swenshuai.xi //0x100A
119*53ee8cc1Swenshuai.xi #define CLKGEN2_REG(addr)       (*((volatile MS_U16*)(_gCLKGEN2_Addr + ((addr)<<2))))
120*53ee8cc1Swenshuai.xi 
121*53ee8cc1Swenshuai.xi //bank 0x101E
122*53ee8cc1Swenshuai.xi #define CHIP_REG(addr)          (*((volatile MS_U16*)(_gCHIPTOP_Addr + ((addr)<<2))))
123*53ee8cc1Swenshuai.xi 
124*53ee8cc1Swenshuai.xi //bank 0x1137
125*53ee8cc1Swenshuai.xi #define PVR0_REG(addr)          (*((volatile MS_U16*)(_gPVR0_Addr + ((addr)<<2))))
126*53ee8cc1Swenshuai.xi 
127*53ee8cc1Swenshuai.xi //bank 0x19xx
128*53ee8cc1Swenshuai.xi #define OTP_REG(addr)           (*((volatile MS_U32*)(_gOTP_Addr + addr )))
129*53ee8cc1Swenshuai.xi 
130*53ee8cc1Swenshuai.xi //bank 0x1713
131*53ee8cc1Swenshuai.xi #define OTP_CTRL_REG(addr)      (*((volatile MS_U32*)(_gOTP_CTRL_Addr + (addr<<2) )))
132*53ee8cc1Swenshuai.xi 
133*53ee8cc1Swenshuai.xi 
134*53ee8cc1Swenshuai.xi static MS_U32 _g32EMMHalDbgLv = EMM_DBGLV_INFO;
135*53ee8cc1Swenshuai.xi 
136*53ee8cc1Swenshuai.xi #define HALEMM_DBG(lv, x, args...)   if (lv <= _g32EMMHalDbgLv ) \
137*53ee8cc1Swenshuai.xi                                         {printf(x, ##args);}
138*53ee8cc1Swenshuai.xi 
139*53ee8cc1Swenshuai.xi 
140*53ee8cc1Swenshuai.xi #define ConnectionCheck(x) { if(x>EMMENG_NUMBER)  \
141*53ee8cc1Swenshuai.xi                             { printf("only one emm allow\n"); \
142*53ee8cc1Swenshuai.xi                             return FALSE;} }
143*53ee8cc1Swenshuai.xi 
144*53ee8cc1Swenshuai.xi 
145*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
146*53ee8cc1Swenshuai.xi // Local variable
147*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
148*53ee8cc1Swenshuai.xi 
149*53ee8cc1Swenshuai.xi //static MS_U32 _gEMMflt_BankAddr = 0;
150*53ee8cc1Swenshuai.xi static MS_U32 _gEMMflt_Addr[EMMENG_NUMBER];
151*53ee8cc1Swenshuai.xi static MS_U32 _gBasicAddr = 0;
152*53ee8cc1Swenshuai.xi static MS_U32 _gOTP_Addr = 0;
153*53ee8cc1Swenshuai.xi static MS_U32 _gOTP_CTRL_Addr = 0;
154*53ee8cc1Swenshuai.xi static MS_U32 _gPVR0_Addr = 0;
155*53ee8cc1Swenshuai.xi static MS_U32 _gCLKGEN0_Addr = 0;
156*53ee8cc1Swenshuai.xi static MS_U32 _gCLKGEN2_Addr = 0;
157*53ee8cc1Swenshuai.xi static MS_U32 _gCHIPTOP_Addr = 0;
158*53ee8cc1Swenshuai.xi 
159*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
160*53ee8cc1Swenshuai.xi // Global variable
161*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
162*53ee8cc1Swenshuai.xi 
163*53ee8cc1Swenshuai.xi 
164*53ee8cc1Swenshuai.xi 
165*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
166*53ee8cc1Swenshuai.xi // Extern Function
167*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
168*53ee8cc1Swenshuai.xi 
169*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
170*53ee8cc1Swenshuai.xi // Function Declaration
171*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
172*53ee8cc1Swenshuai.xi void PrintSetting(void);
173*53ee8cc1Swenshuai.xi 
174*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
175*53ee8cc1Swenshuai.xi // Local Function
176*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
177*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_WriteReg_Word(MS_U32 connection,MS_U32 u32RegAddr,MS_U16 u16Data)178*53ee8cc1Swenshuai.xi static void HAL_EMMFLT_WriteReg_Word(MS_U32 connection, MS_U32 u32RegAddr, MS_U16 u16Data)
179*53ee8cc1Swenshuai.xi {
180*53ee8cc1Swenshuai.xi     MS_U32 u32reg;
181*53ee8cc1Swenshuai.xi     u32reg = (u32RegAddr*4) + _gEMMflt_Addr[connection];
182*53ee8cc1Swenshuai.xi     (*(volatile MS_U16*)(u32reg)) = u16Data;
183*53ee8cc1Swenshuai.xi }
184*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_ReadReg_Word(MS_U32 connection,MS_U32 u32RegAddr)185*53ee8cc1Swenshuai.xi static MS_U16 HAL_EMMFLT_ReadReg_Word(MS_U32 connection, MS_U32 u32RegAddr)
186*53ee8cc1Swenshuai.xi {
187*53ee8cc1Swenshuai.xi     MS_U32 u32reg;
188*53ee8cc1Swenshuai.xi     MS_U16 u16Data;
189*53ee8cc1Swenshuai.xi     u32reg = (u32RegAddr*4) + _gEMMflt_Addr[connection];
190*53ee8cc1Swenshuai.xi     u16Data = (*(volatile MS_U16*)(u32reg));
191*53ee8cc1Swenshuai.xi 
192*53ee8cc1Swenshuai.xi     return u16Data;
193*53ee8cc1Swenshuai.xi }
194*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_WriteReg_Dword(MS_U32 connection,MS_U32 u32RegAddr,MS_U32 u32Data)195*53ee8cc1Swenshuai.xi static void HAL_EMMFLT_WriteReg_Dword(MS_U32 connection, MS_U32 u32RegAddr, MS_U32 u32Data)
196*53ee8cc1Swenshuai.xi {
197*53ee8cc1Swenshuai.xi     MS_U32 u32reg;
198*53ee8cc1Swenshuai.xi 
199*53ee8cc1Swenshuai.xi     u32reg = (u32RegAddr*4) + _gEMMflt_Addr[connection];
200*53ee8cc1Swenshuai.xi     (*(volatile MS_U16*)(u32reg)) = (MS_U16)(u32Data&0xffff);
201*53ee8cc1Swenshuai.xi 
202*53ee8cc1Swenshuai.xi     u32reg += 4;
203*53ee8cc1Swenshuai.xi     (*(volatile MS_U16*)(u32reg)) = (MS_U16)((u32Data>>16)&0xffff);
204*53ee8cc1Swenshuai.xi }
205*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_ReadReg_Dword(MS_U32 connection,MS_U32 u32RegAddr)206*53ee8cc1Swenshuai.xi static MS_U32 HAL_EMMFLT_ReadReg_Dword(MS_U32 connection, MS_U32 u32RegAddr)
207*53ee8cc1Swenshuai.xi {
208*53ee8cc1Swenshuai.xi     MS_U32 u32reg,u32Data;
209*53ee8cc1Swenshuai.xi     MS_U16 u16Data1,u16Data2;
210*53ee8cc1Swenshuai.xi 
211*53ee8cc1Swenshuai.xi     u32reg = (u32RegAddr*4) + _gEMMflt_Addr[connection];
212*53ee8cc1Swenshuai.xi     u16Data1 = (*(volatile MS_U16*)(u32reg));
213*53ee8cc1Swenshuai.xi 
214*53ee8cc1Swenshuai.xi     u32reg += 4;
215*53ee8cc1Swenshuai.xi     u16Data2 = (*(volatile MS_U16*)(u32reg));
216*53ee8cc1Swenshuai.xi     u32Data = (u16Data1) + ((MS_U32)u16Data2<<16);
217*53ee8cc1Swenshuai.xi 
218*53ee8cc1Swenshuai.xi     return u32Data;
219*53ee8cc1Swenshuai.xi }
220*53ee8cc1Swenshuai.xi 
221*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
222*53ee8cc1Swenshuai.xi // Global Function
223*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
224*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_SetBank(MS_U32 u32Base)225*53ee8cc1Swenshuai.xi void HAL_EMMFLT_SetBank(MS_U32 u32Base)
226*53ee8cc1Swenshuai.xi {
227*53ee8cc1Swenshuai.xi     MS_U16 u16I,u16J;
228*53ee8cc1Swenshuai.xi     MS_U16 u16Data;
229*53ee8cc1Swenshuai.xi 
230*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "%s: u32Base = 0x%x\n", __FUNCTION__, u32Base);
231*53ee8cc1Swenshuai.xi 
232*53ee8cc1Swenshuai.xi     _gBasicAddr = u32Base;
233*53ee8cc1Swenshuai.xi 
234*53ee8cc1Swenshuai.xi     _gEMMflt_Addr[0] = _gBasicAddr + REG_EMMFLT_BASE1;
235*53ee8cc1Swenshuai.xi     _gEMMflt_Addr[1] = _gBasicAddr + REG_EMMFLT_BASE2;
236*53ee8cc1Swenshuai.xi 
237*53ee8cc1Swenshuai.xi     _gOTP_Addr  = _gBasicAddr + REG_OTP_BASE;
238*53ee8cc1Swenshuai.xi     _gOTP_CTRL_Addr  = _gBasicAddr + REG_OTP_CTRL_BASE;
239*53ee8cc1Swenshuai.xi     _gPVR0_Addr  = _gBasicAddr + REG_PVR0_BASE;
240*53ee8cc1Swenshuai.xi     _gCHIPTOP_Addr= _gBasicAddr + REG_CHIPTOP_BASE;
241*53ee8cc1Swenshuai.xi     _gCLKGEN0_Addr= _gBasicAddr + REG_CLKGEN0_BASE;
242*53ee8cc1Swenshuai.xi     _gCLKGEN2_Addr= _gBasicAddr + REG_CLKGEN2_BASE;
243*53ee8cc1Swenshuai.xi 
244*53ee8cc1Swenshuai.xi 
245*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO,"_gBasicAddr = %x, _gEMMflt_Addr[0] = %x, _gEMMflt_Addr[1] = %x\n",_gBasicAddr,_gEMMflt_Addr[0],_gEMMflt_Addr[1]);
246*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO,"_gCHIPTOP_Addr = %x, _gCLKGEN0_Addr = %x\n",_gCHIPTOP_Addr,_gCLKGEN0_Addr);
247*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO,"int ctrl addr = %x\n", (_gBasicAddr+ (0x101900<<1) ));
248*53ee8cc1Swenshuai.xi 
249*53ee8cc1Swenshuai.xi     for( u16J=0; u16J<EMMENG_NUMBER; u16J++ )
250*53ee8cc1Swenshuai.xi     {
251*53ee8cc1Swenshuai.xi         for(u16I=0; u16I<=REG_EMM_TSIF_LOCKED_CNT_STATUS; u16I++)
252*53ee8cc1Swenshuai.xi         {
253*53ee8cc1Swenshuai.xi             u16Data = HAL_EMMFLT_ReadReg_Word(u16J,u16I);
254*53ee8cc1Swenshuai.xi             HALEMM_DBG(EMM_DBGLV_ARRAY, " %x = %x \n",u16I,u16Data);
255*53ee8cc1Swenshuai.xi         }
256*53ee8cc1Swenshuai.xi     }
257*53ee8cc1Swenshuai.xi 
258*53ee8cc1Swenshuai.xi }
259*53ee8cc1Swenshuai.xi 
260*53ee8cc1Swenshuai.xi #define FileInTest
261*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_FileInSet(void)262*53ee8cc1Swenshuai.xi static void HAL_EMMFLT_FileInSet(void)
263*53ee8cc1Swenshuai.xi {
264*53ee8cc1Swenshuai.xi     //MS_U32 u32Addr;
265*53ee8cc1Swenshuai.xi     MS_U16 u16Data,i;
266*53ee8cc1Swenshuai.xi 
267*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "CHIP_REG(0x2) = %x\n",CHIP_REG(0x2));
268*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "CHIP_REG(0x3A) = %x\n",CHIP_REG(0x3A));
269*53ee8cc1Swenshuai.xi 
270*53ee8cc1Swenshuai.xi #if 0
271*53ee8cc1Swenshuai.xi     HALEMM_DBG(0, "CHIP_REG(0x2A) = %x\n",CHIP_REG(0x2A));
272*53ee8cc1Swenshuai.xi     HALEMM_DBG(0, "CHIP_REG(0x28) = %x\n",CHIP_REG(0x28));
273*53ee8cc1Swenshuai.xi     HALEMM_DBG(0, "CHIP_REG(0x29) = %x\n",CHIP_REG(0x29));
274*53ee8cc1Swenshuai.xi 
275*53ee8cc1Swenshuai.xi 
276*53ee8cc1Swenshuai.xi     if(CHIP_REG(0x29) != 0)
277*53ee8cc1Swenshuai.xi     {
278*53ee8cc1Swenshuai.xi         CHIP_REG(0x29) = 0;
279*53ee8cc1Swenshuai.xi     }
280*53ee8cc1Swenshuai.xi #endif
281*53ee8cc1Swenshuai.xi 
282*53ee8cc1Swenshuai.xi     for( i=0 ; i<EMMENG_NUMBER ; i++ )
283*53ee8cc1Swenshuai.xi     {
284*53ee8cc1Swenshuai.xi         u16Data = HAL_EMMFLT_ReadReg_Word(i,REG_EMM_CTRL0_L);
285*53ee8cc1Swenshuai.xi 
286*53ee8cc1Swenshuai.xi #if 0 //file in and bypass
287*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "File in and bypass\n");
288*53ee8cc1Swenshuai.xi     u16Data |= (EMM_FW_FILEIN | EMM_FLT_BYPASS);
289*53ee8cc1Swenshuai.xi #else //file in only
290*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "File in only\n");
291*53ee8cc1Swenshuai.xi     u16Data |= (EMM_FW_FILEIN);
292*53ee8cc1Swenshuai.xi #endif
293*53ee8cc1Swenshuai.xi 
294*53ee8cc1Swenshuai.xi         HAL_EMMFLT_WriteReg_Word(i,REG_EMM_CTRL0_L, u16Data);
295*53ee8cc1Swenshuai.xi     }
296*53ee8cc1Swenshuai.xi 
297*53ee8cc1Swenshuai.xi 
298*53ee8cc1Swenshuai.xi }
299*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_LiveInSet(void)300*53ee8cc1Swenshuai.xi static void HAL_EMMFLT_LiveInSet(void)
301*53ee8cc1Swenshuai.xi {
302*53ee8cc1Swenshuai.xi     MS_U16 u16Data,i;
303*53ee8cc1Swenshuai.xi 
304*53ee8cc1Swenshuai.xi     for( i=0 ; i<EMMENG_NUMBER ; i++ )
305*53ee8cc1Swenshuai.xi     {
306*53ee8cc1Swenshuai.xi         u16Data = HAL_EMMFLT_ReadReg_Word(i,REG_EMM_CTRL0_L);
307*53ee8cc1Swenshuai.xi         u16Data &= ~(EMM_FW_FILEIN);
308*53ee8cc1Swenshuai.xi 
309*53ee8cc1Swenshuai.xi         HAL_EMMFLT_WriteReg_Word(i,REG_EMM_CTRL0_L, u16Data);
310*53ee8cc1Swenshuai.xi     }
311*53ee8cc1Swenshuai.xi 
312*53ee8cc1Swenshuai.xi }
313*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_SrcSelect(MS_U32 connection,MS_U32 u32SrcFrom,MS_U32 u32SrcType)314*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_SrcSelect(MS_U32 connection, MS_U32 u32SrcFrom, MS_U32 u32SrcType)
315*53ee8cc1Swenshuai.xi {
316*53ee8cc1Swenshuai.xi 
317*53ee8cc1Swenshuai.xi     //CLKGEN0 bank, [0x29]_bit[11:8]=4'h8
318*53ee8cc1Swenshuai.xi     //CLKGEN0_REG(0x29) = ( CLKGEN0_REG(0x29) & 0xf0ff ) | 0x800 ;
319*53ee8cc1Swenshuai.xi 
320*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO,"Enter %s.....\n",__FUNCTION__);
321*53ee8cc1Swenshuai.xi 
322*53ee8cc1Swenshuai.xi     //[0x1137]_[0x1e]_[9] = 0
323*53ee8cc1Swenshuai.xi     //[0x101e]_[0x3a]_[6:4] = 3'b100: from demod0
324*53ee8cc1Swenshuai.xi     //[0x101e]_[0x43]_[15:0] = 16'h8000: reg_miu_wc_bypass
325*53ee8cc1Swenshuai.xi     //[0x101e]_[0x44]_[15:0] = 16'h0003: reg_miu_wc_bypass
326*53ee8cc1Swenshuai.xi     //[0x101e]_[0x02]_[7:0] = 8'h11  (reg_ts1_mode = 1, reg_ts0_mode=1)
327*53ee8cc1Swenshuai.xi     //[0x100b]_[0x2f]_[12:8] = 5'b100_00  :  clk_ts6_p
328*53ee8cc1Swenshuai.xi     //[0x100b]_[0x2a]_[4:0]  = 5'b010_00  :  clk_tsp
329*53ee8cc1Swenshuai.xi     //[0x1015]_[0x7a]_[15:0] = 16'h0002  software reset
330*53ee8cc1Swenshuai.xi 
331*53ee8cc1Swenshuai.xi 
332*53ee8cc1Swenshuai.xi     MS_U32 addr;
333*53ee8cc1Swenshuai.xi     MS_U16 u16Reg;
334*53ee8cc1Swenshuai.xi 
335*53ee8cc1Swenshuai.xi #if 1
336*53ee8cc1Swenshuai.xi 	addr = _gBasicAddr + (0x101200*2 + 0x18*4);		// MIU_EN
337*53ee8cc1Swenshuai.xi     (*((volatile MS_U16*)(addr))) = 0xffff;
338*53ee8cc1Swenshuai.xi 
339*53ee8cc1Swenshuai.xi 	addr = _gBasicAddr + (0x161300*2 + 0x00*4);		//$ enable MIUCrossbar
340*53ee8cc1Swenshuai.xi     (*((volatile MS_U16*)(addr))) = 0x000f;
341*53ee8cc1Swenshuai.xi #endif
342*53ee8cc1Swenshuai.xi 
343*53ee8cc1Swenshuai.xi 
344*53ee8cc1Swenshuai.xi     MsOS_DelayTask(1);
345*53ee8cc1Swenshuai.xi     PrintSetting();
346*53ee8cc1Swenshuai.xi 
347*53ee8cc1Swenshuai.xi 
348*53ee8cc1Swenshuai.xi     //connection needs to modify for K3
349*53ee8cc1Swenshuai.xi     if(u32SrcFrom == EMM_SRC_FILEIN)
350*53ee8cc1Swenshuai.xi     {
351*53ee8cc1Swenshuai.xi         HAL_EMMFLT_FileInSet();
352*53ee8cc1Swenshuai.xi     }
353*53ee8cc1Swenshuai.xi     else //EMM_LIVEIN
354*53ee8cc1Swenshuai.xi     {
355*53ee8cc1Swenshuai.xi         HAL_EMMFLT_LiveInSet();
356*53ee8cc1Swenshuai.xi 
357*53ee8cc1Swenshuai.xi         if(u32SrcType == EMM_SRC_TS0)
358*53ee8cc1Swenshuai.xi         {
359*53ee8cc1Swenshuai.xi             HALEMM_DBG(EMM_DBGLV_INFO,"[%s][%d] EMM_SRC_TS0\n",__FUNCTION__,__LINE__);
360*53ee8cc1Swenshuai.xi 
361*53ee8cc1Swenshuai.xi             //clock setting to TS0
362*53ee8cc1Swenshuai.xi             u16Reg = CLKGEN0_REG(0x26);
363*53ee8cc1Swenshuai.xi             CLKGEN0_REG(0x26) = 0;
364*53ee8cc1Swenshuai.xi 
365*53ee8cc1Swenshuai.xi             //pad set to TS0
366*53ee8cc1Swenshuai.xi             u16Reg = CHIP_REG(0x39);
367*53ee8cc1Swenshuai.xi             u16Reg &= (~0xf00<<(connection*4));
368*53ee8cc1Swenshuai.xi             u16Reg |= (EMM_FROM_TS0<<(8+connection*4));
369*53ee8cc1Swenshuai.xi             CHIP_REG(0x39) = u16Reg;
370*53ee8cc1Swenshuai.xi 
371*53ee8cc1Swenshuai.xi 
372*53ee8cc1Swenshuai.xi             u16Reg = CLKGEN2_REG(0x04+connection);
373*53ee8cc1Swenshuai.xi             u16Reg &= (~0x001f);
374*53ee8cc1Swenshuai.xi             u16Reg |= (EMM_FROM_TS0<<2);
375*53ee8cc1Swenshuai.xi             CLKGEN2_REG(0x04+connection) = u16Reg;
376*53ee8cc1Swenshuai.xi         }
377*53ee8cc1Swenshuai.xi         else if(u32SrcType == EMM_SRC_TS1)
378*53ee8cc1Swenshuai.xi         {
379*53ee8cc1Swenshuai.xi             HALEMM_DBG(EMM_DBGLV_INFO,"[%s][%d] EMM_SRC_TS1\n",__FUNCTION__,__LINE__);
380*53ee8cc1Swenshuai.xi 
381*53ee8cc1Swenshuai.xi             //clock setting to TS1
382*53ee8cc1Swenshuai.xi             u16Reg = CLKGEN0_REG(0x26);
383*53ee8cc1Swenshuai.xi             CLKGEN0_REG(0x26) = 0x404;
384*53ee8cc1Swenshuai.xi 
385*53ee8cc1Swenshuai.xi             //pad set to TS1
386*53ee8cc1Swenshuai.xi             u16Reg = CHIP_REG(0x39);
387*53ee8cc1Swenshuai.xi             u16Reg &= ~(0xf00<<(connection*4));
388*53ee8cc1Swenshuai.xi             u16Reg |= (EMM_FROM_TS1<<(8+connection*4));
389*53ee8cc1Swenshuai.xi             CHIP_REG(0x39) = u16Reg;
390*53ee8cc1Swenshuai.xi 
391*53ee8cc1Swenshuai.xi 
392*53ee8cc1Swenshuai.xi             u16Reg = CLKGEN2_REG(0x04+connection);
393*53ee8cc1Swenshuai.xi             u16Reg &= (~0x001f);
394*53ee8cc1Swenshuai.xi             u16Reg |= (EMM_FROM_TS1<<2);
395*53ee8cc1Swenshuai.xi             CLKGEN2_REG(0x04+connection) = u16Reg;
396*53ee8cc1Swenshuai.xi         }
397*53ee8cc1Swenshuai.xi         else if(u32SrcType == EMM_SRC_TS3)
398*53ee8cc1Swenshuai.xi         {
399*53ee8cc1Swenshuai.xi             //u16Reg = CHIP_REG(0x2);
400*53ee8cc1Swenshuai.xi             //u16Reg |= 0x18;
401*53ee8cc1Swenshuai.xi             //CHIP_REG(0x2) = u16Reg;
402*53ee8cc1Swenshuai.xi 
403*53ee8cc1Swenshuai.xi             //pad set to TS3
404*53ee8cc1Swenshuai.xi             u16Reg = CHIP_REG(0x39);
405*53ee8cc1Swenshuai.xi             u16Reg &= ~(0xf00<<(connection*4));
406*53ee8cc1Swenshuai.xi             u16Reg |= (EMM_FROM_TS3<<(8+connection*4));
407*53ee8cc1Swenshuai.xi             CHIP_REG(0x39) = u16Reg;
408*53ee8cc1Swenshuai.xi 
409*53ee8cc1Swenshuai.xi 
410*53ee8cc1Swenshuai.xi             u16Reg = CLKGEN2_REG(0x04+connection);
411*53ee8cc1Swenshuai.xi             u16Reg &= (~0x003f);
412*53ee8cc1Swenshuai.xi             u16Reg |= (EMM_FROM_TS3<<2);
413*53ee8cc1Swenshuai.xi             CLKGEN2_REG(0x04+connection) = u16Reg;
414*53ee8cc1Swenshuai.xi         }
415*53ee8cc1Swenshuai.xi 
416*53ee8cc1Swenshuai.xi 
417*53ee8cc1Swenshuai.xi     }
418*53ee8cc1Swenshuai.xi 
419*53ee8cc1Swenshuai.xi     return TRUE;
420*53ee8cc1Swenshuai.xi }
421*53ee8cc1Swenshuai.xi 
422*53ee8cc1Swenshuai.xi 
PrintSetting(void)423*53ee8cc1Swenshuai.xi void PrintSetting(void)
424*53ee8cc1Swenshuai.xi {
425*53ee8cc1Swenshuai.xi 
426*53ee8cc1Swenshuai.xi     MS_U32 addr;
427*53ee8cc1Swenshuai.xi     MS_U16 u16Reg;
428*53ee8cc1Swenshuai.xi 
429*53ee8cc1Swenshuai.xi 
430*53ee8cc1Swenshuai.xi 	#if 0
431*53ee8cc1Swenshuai.xi 
432*53ee8cc1Swenshuai.xi 	KERES EMM PADDING
433*53ee8cc1Swenshuai.xi 	//a.	reg_ts0_mode : bank_101e_0x02_[2:0]    = 3'd001;		//TS0 Mode
434*53ee8cc1Swenshuai.xi     u16Reg = CHIP_REG(0x02);
435*53ee8cc1Swenshuai.xi     u16Reg = (u16Reg & ~0x0007) | 0x1;
436*53ee8cc1Swenshuai.xi     CHIP_REG(0x02) = u16Reg;
437*53ee8cc1Swenshuai.xi 
438*53ee8cc1Swenshuai.xi 	//b.	reg_ckg_ts4 :	   bank_100b_0x26_[3:0]    = 4'b0;
439*53ee8cc1Swenshuai.xi 	//clk source for ts4: ts0_clk
440*53ee8cc1Swenshuai.xi 	u16Reg = CLKGEN0_REG(0x26);
441*53ee8cc1Swenshuai.xi     u16Reg = (u16Reg & ~0x000f) | 0x0;
442*53ee8cc1Swenshuai.xi     CLKGEN0_REG(0x26) = u16Reg;
443*53ee8cc1Swenshuai.xi 
444*53ee8cc1Swenshuai.xi 	//c.	reg_ckg_ts5 :	   bank_100b_0x26_[11:8]  = 4'b0;
445*53ee8cc1Swenshuai.xi 	//clk source for ts5: ts0_clk
446*53ee8cc1Swenshuai.xi 	u16Reg = CLKGEN0_REG(0x26);
447*53ee8cc1Swenshuai.xi     u16Reg = (u16Reg & ~0x0f00) | 0x0;
448*53ee8cc1Swenshuai.xi     CLKGEN0_REG(0x26) = u16Reg;
449*53ee8cc1Swenshuai.xi 
450*53ee8cc1Swenshuai.xi 	//d.	reg_emmflt0_mux:  bank_101e_0x39_[10:8]    = 3'd000
451*53ee8cc1Swenshuai.xi 	//Source Selections for EMMFLT Channel 0: come from PAD_TS0
452*53ee8cc1Swenshuai.xi 	u16Reg = CHIP_REG(0x39);
453*53ee8cc1Swenshuai.xi     u16Reg = (u16Reg & ~0x0700) | 0x0;
454*53ee8cc1Swenshuai.xi     CHIP_REG(0x39) = u16Reg;
455*53ee8cc1Swenshuai.xi 
456*53ee8cc1Swenshuai.xi 	//e.	reg_emmflt1_mux:  bank_101e_0x39_[14:12]	= 3'd000
457*53ee8cc1Swenshuai.xi 	//Source Selections for EMMFLT Channel 1: come from PAD_TS0
458*53ee8cc1Swenshuai.xi 	u16Reg = CHIP_REG(0x39);
459*53ee8cc1Swenshuai.xi     u16Reg = (u16Reg & ~0x7000) | 0x0;
460*53ee8cc1Swenshuai.xi     CHIP_REG(0x39) = u16Reg;
461*53ee8cc1Swenshuai.xi 
462*53ee8cc1Swenshuai.xi 	#endif
463*53ee8cc1Swenshuai.xi 
464*53ee8cc1Swenshuai.xi     u16Reg = CHIP_REG(0x2);
465*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_DEBUG, "CHIP 0x2 = %x\n", u16Reg);
466*53ee8cc1Swenshuai.xi 
467*53ee8cc1Swenshuai.xi     u16Reg = CHIP_REG(0x39);
468*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_DEBUG, "CHIP 0x39 = %x\n", u16Reg);
469*53ee8cc1Swenshuai.xi 
470*53ee8cc1Swenshuai.xi     u16Reg = CLKGEN0_REG(0x26);
471*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_DEBUG, "CLKGEN0 0x26 = %x\n", u16Reg);
472*53ee8cc1Swenshuai.xi 
473*53ee8cc1Swenshuai.xi 
474*53ee8cc1Swenshuai.xi     addr = _gBasicAddr + (0x101500*2 + 0x7a*4);
475*53ee8cc1Swenshuai.xi     u16Reg = (*((volatile MS_U16*)(addr)));
476*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_DEBUG, "(TSP0, 0x101500*2 + 0x7a*4) = %x\n", u16Reg);
477*53ee8cc1Swenshuai.xi 
478*53ee8cc1Swenshuai.xi 	#if 0
479*53ee8cc1Swenshuai.xi     addr = _gBasicAddr + (0x113700*2 + 0x1e*4);
480*53ee8cc1Swenshuai.xi     u16Reg = (*((volatile MS_U16*)(addr)));
481*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_DEBUG, "(0x113700*2 + 0x1e*4) = %x\n", u16Reg);
482*53ee8cc1Swenshuai.xi 	#endif
483*53ee8cc1Swenshuai.xi }
484*53ee8cc1Swenshuai.xi 
485*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_Init(void)486*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_Init(void)
487*53ee8cc1Swenshuai.xi {
488*53ee8cc1Swenshuai.xi     MS_U16 u16Data;
489*53ee8cc1Swenshuai.xi     MS_U32 i;
490*53ee8cc1Swenshuai.xi 
491*53ee8cc1Swenshuai.xi     for( i=0 ; i<EMMENG_NUMBER ; i++ )
492*53ee8cc1Swenshuai.xi     {
493*53ee8cc1Swenshuai.xi         u16Data = HAL_EMMFLT_ReadReg_Word(i,REG_EMM_RESET);
494*53ee8cc1Swenshuai.xi 
495*53ee8cc1Swenshuai.xi         u16Data |= EMM_RESET_UNLOCK;
496*53ee8cc1Swenshuai.xi         HAL_EMMFLT_WriteReg_Word(i,REG_EMM_RESET, u16Data);
497*53ee8cc1Swenshuai.xi     }
498*53ee8cc1Swenshuai.xi 
499*53ee8cc1Swenshuai.xi     for( i=0 ; i<EMMENG_NUMBER ; i++ )
500*53ee8cc1Swenshuai.xi     {
501*53ee8cc1Swenshuai.xi         u16Data = HAL_EMMFLT_ReadReg_Word(i,REG_EMM_STR2MIU_EN);
502*53ee8cc1Swenshuai.xi         u16Data |= EMM_STR2MIU_EN;
503*53ee8cc1Swenshuai.xi         HAL_EMMFLT_WriteReg_Word(i, REG_EMM_STR2MIU_EN, u16Data); //string 2 miu enable
504*53ee8cc1Swenshuai.xi 
505*53ee8cc1Swenshuai.xi         HALEMM_DBG(EMM_DBGLV_INFO, "enable stream to miu \n");
506*53ee8cc1Swenshuai.xi 
507*53ee8cc1Swenshuai.xi         //designer suggest setting....still needs to confirm
508*53ee8cc1Swenshuai.xi 
509*53ee8cc1Swenshuai.xi 		HAL_EMMFLT_WriteReg_Word(i, REG_EMM_TS_IF2_CTRL, 0x80e1);
510*53ee8cc1Swenshuai.xi         //HAL_EMMFLT_WriteReg_Word(i, REG_EMM_TS_IF2_CTRL, 0x8fe1);		//DEBUG
511*53ee8cc1Swenshuai.xi     }
512*53ee8cc1Swenshuai.xi 
513*53ee8cc1Swenshuai.xi     return TRUE;
514*53ee8cc1Swenshuai.xi }
515*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_GetHwBufCnt(MS_U32 * pHwBufCnt)516*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_GetHwBufCnt(MS_U32 *pHwBufCnt)
517*53ee8cc1Swenshuai.xi {
518*53ee8cc1Swenshuai.xi     *pHwBufCnt = EMMFLT_HWBUF_NUM;
519*53ee8cc1Swenshuai.xi     return TRUE;
520*53ee8cc1Swenshuai.xi }
521*53ee8cc1Swenshuai.xi 
522*53ee8cc1Swenshuai.xi //does connection needs to be increased.
HAL_EMMFLT_SWReset(MS_U32 connection)523*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_SWReset(MS_U32 connection)
524*53ee8cc1Swenshuai.xi {
525*53ee8cc1Swenshuai.xi     MS_U16 u16Data;
526*53ee8cc1Swenshuai.xi 
527*53ee8cc1Swenshuai.xi     u16Data = HAL_EMMFLT_ReadReg_Word(connection,REG_EMM_RESET);
528*53ee8cc1Swenshuai.xi     u16Data &= (~EMM_RESET_UNLOCK);
529*53ee8cc1Swenshuai.xi 
530*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(connection,REG_EMM_RESET, u16Data);
531*53ee8cc1Swenshuai.xi 
532*53ee8cc1Swenshuai.xi     u16Data |= EMM_RESET_UNLOCK;
533*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(connection,REG_EMM_RESET, u16Data);
534*53ee8cc1Swenshuai.xi 
535*53ee8cc1Swenshuai.xi     return TRUE;
536*53ee8cc1Swenshuai.xi }
537*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_SetDbgLevel(MS_U32 u32Level)538*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_SetDbgLevel(MS_U32 u32Level)
539*53ee8cc1Swenshuai.xi {
540*53ee8cc1Swenshuai.xi     _g32EMMHalDbgLv = u32Level;
541*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_DEBUG, "%s level: %x\n", __FUNCTION__, u32Level);
542*53ee8cc1Swenshuai.xi     return TRUE;
543*53ee8cc1Swenshuai.xi }
544*53ee8cc1Swenshuai.xi 
545*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_SetOutputType(MS_U32 connection,MS_U32 u32Type)546*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_SetOutputType(MS_U32 connection, MS_U32 u32Type)
547*53ee8cc1Swenshuai.xi {
548*53ee8cc1Swenshuai.xi     MS_U16 u16Data;
549*53ee8cc1Swenshuai.xi 
550*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "SetOutputType conn = %x, Type = %x \n",connection,u32Type);
551*53ee8cc1Swenshuai.xi     if(u32Type == EMM_OUT_NORMAL)
552*53ee8cc1Swenshuai.xi     {
553*53ee8cc1Swenshuai.xi         u16Data = HAL_EMMFLT_ReadReg_Word(connection,REG_EMM_GENERAL_CTRL_L);
554*53ee8cc1Swenshuai.xi         u16Data &= ~(__BIT2);
555*53ee8cc1Swenshuai.xi         HAL_EMMFLT_WriteReg_Word(connection,REG_EMM_GENERAL_CTRL_L, u16Data);
556*53ee8cc1Swenshuai.xi     }
557*53ee8cc1Swenshuai.xi     else if(u32Type == EMM_OUT_184BYTES)
558*53ee8cc1Swenshuai.xi     {
559*53ee8cc1Swenshuai.xi 
560*53ee8cc1Swenshuai.xi     }
561*53ee8cc1Swenshuai.xi     else if(u32Type == EMM_OUT_PACKETNUM)
562*53ee8cc1Swenshuai.xi     {
563*53ee8cc1Swenshuai.xi         u16Data = HAL_EMMFLT_ReadReg_Word(connection,REG_EMM_GENERAL_CTRL_L);
564*53ee8cc1Swenshuai.xi         u16Data |= (__BIT2);
565*53ee8cc1Swenshuai.xi         HAL_EMMFLT_WriteReg_Word(connection,REG_EMM_GENERAL_CTRL_L, u16Data);
566*53ee8cc1Swenshuai.xi     }
567*53ee8cc1Swenshuai.xi     return TRUE;
568*53ee8cc1Swenshuai.xi }
569*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_Enable_Int(void)570*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_Enable_Int(void)
571*53ee8cc1Swenshuai.xi {
572*53ee8cc1Swenshuai.xi     MS_U32 i;
573*53ee8cc1Swenshuai.xi 
574*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "EMMFLT_Enable_Int\n");
575*53ee8cc1Swenshuai.xi     for( i=0 ; i<EMMENG_NUMBER ; i++ )
576*53ee8cc1Swenshuai.xi     {
577*53ee8cc1Swenshuai.xi         //HAL_EMMFLT_WriteReg_Word(REG_EMM_CA_INT,0);
578*53ee8cc1Swenshuai.xi         //HAL_EMMFLT_WriteReg_Word( i, 0x0075, 0x3);
579*53ee8cc1Swenshuai.xi         HAL_EMMFLT_WriteReg_Word( i, REG_EMM_CA_INT, (EMM_ONEPAKCET_INT | EMM_OVERFLOW_INT));
580*53ee8cc1Swenshuai.xi     }
581*53ee8cc1Swenshuai.xi     return TRUE;
582*53ee8cc1Swenshuai.xi }
583*53ee8cc1Swenshuai.xi 
584*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_SetTidMode(MS_U32 connection,MS_U8 u8TidValue,EMM_TIDMODE_e eTIDMODE)585*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_SetTidMode(MS_U32 connection, MS_U8 u8TidValue, EMM_TIDMODE_e eTIDMODE)
586*53ee8cc1Swenshuai.xi {
587*53ee8cc1Swenshuai.xi 
588*53ee8cc1Swenshuai.xi     MS_U32 u32Data;
589*53ee8cc1Swenshuai.xi 
590*53ee8cc1Swenshuai.xi     ConnectionCheck(connection);
591*53ee8cc1Swenshuai.xi 
592*53ee8cc1Swenshuai.xi     u32Data = HAL_EMMFLT_ReadReg_Dword(connection,REG_EMM_TID_MODE_L);
593*53ee8cc1Swenshuai.xi 
594*53ee8cc1Swenshuai.xi     u32Data &= ~((MS_U32)E_TIDMODE_RESERVED<<u8TidValue);
595*53ee8cc1Swenshuai.xi     u32Data |= ((MS_U32)eTIDMODE<<u8TidValue);
596*53ee8cc1Swenshuai.xi 
597*53ee8cc1Swenshuai.xi 
598*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Dword(connection,REG_EMM_TID_MODE_L,u32Data);
599*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "%s SetTidMode value : %x\n", __FUNCTION__, u32Data);
600*53ee8cc1Swenshuai.xi     return TRUE;
601*53ee8cc1Swenshuai.xi }
602*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_SetIRDMode(MS_U32 connection,MS_U8 u8IRDNum,MS_U8 u8CompareMode)603*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_SetIRDMode(MS_U32 connection,MS_U8 u8IRDNum, MS_U8 u8CompareMode)
604*53ee8cc1Swenshuai.xi {
605*53ee8cc1Swenshuai.xi     MS_U16 u16Mask,u16Data;
606*53ee8cc1Swenshuai.xi 
607*53ee8cc1Swenshuai.xi     ConnectionCheck(connection);
608*53ee8cc1Swenshuai.xi     if(u8CompareMode > REG_EMM_CTRL_MAX)
609*53ee8cc1Swenshuai.xi     {
610*53ee8cc1Swenshuai.xi         return HAL_EMMFLT_INVALID_REQUEST;
611*53ee8cc1Swenshuai.xi     }
612*53ee8cc1Swenshuai.xi 
613*53ee8cc1Swenshuai.xi     if(u8IRDNum > REG_EMM_IRD_MAX)
614*53ee8cc1Swenshuai.xi     {
615*53ee8cc1Swenshuai.xi         return HAL_EMMFLT_INVALID_REQUEST;
616*53ee8cc1Swenshuai.xi     }
617*53ee8cc1Swenshuai.xi 
618*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "%s u8IRDNum= %d, u8CompareMode = %d\n", __FUNCTION__, u8IRDNum, u8CompareMode );
619*53ee8cc1Swenshuai.xi     u16Mask = (EMM_IRD_REG_MASK << (u8IRDNum*2));
620*53ee8cc1Swenshuai.xi 
621*53ee8cc1Swenshuai.xi     u16Data = HAL_EMMFLT_ReadReg_Word(connection,REG_EMM_CTRL_ID);
622*53ee8cc1Swenshuai.xi 
623*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "REG_EMM_CTRL_ID = %x\n",u16Data);
624*53ee8cc1Swenshuai.xi     u16Data &= ~u16Mask;
625*53ee8cc1Swenshuai.xi 
626*53ee8cc1Swenshuai.xi 
627*53ee8cc1Swenshuai.xi     u16Data |= (u8CompareMode << (u8IRDNum*2));
628*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "%s u16Data= %x \n", __FUNCTION__, u16Data);
629*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(connection,REG_EMM_CTRL_ID, u16Data);
630*53ee8cc1Swenshuai.xi 
631*53ee8cc1Swenshuai.xi     return TRUE;
632*53ee8cc1Swenshuai.xi }
633*53ee8cc1Swenshuai.xi 
634*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_SetEmmDataIDx(MS_U32 connection,MS_U8 u8IRDNum,MS_U8 * pu8Data)635*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_SetEmmDataIDx(MS_U32 connection, MS_U8 u8IRDNum, MS_U8 *pu8Data)
636*53ee8cc1Swenshuai.xi {
637*53ee8cc1Swenshuai.xi     MS_U32 u32IRDAddr,u32EMMAddr;
638*53ee8cc1Swenshuai.xi     MS_U32 u32Mapping[] = {REG_EMM_DATA_ID1_L, REG_EMM_DATA_ID2_L,
639*53ee8cc1Swenshuai.xi                            REG_EMM_DATA_ID3_L, REG_EMM_DATA_ID4_L,
640*53ee8cc1Swenshuai.xi                            REG_EMM_DATA_ID5_L, REG_EMM_DATA_ID6_L,
641*53ee8cc1Swenshuai.xi                            REG_EMM_DATA_ID7_L, REG_EMM_DATA_ID8_L, };
642*53ee8cc1Swenshuai.xi 
643*53ee8cc1Swenshuai.xi 
644*53ee8cc1Swenshuai.xi     ConnectionCheck(connection);
645*53ee8cc1Swenshuai.xi 
646*53ee8cc1Swenshuai.xi     u32EMMAddr = ((MS_U32)pu8Data[0]<<24) + ((MS_U32)pu8Data[1]<<16) +
647*53ee8cc1Swenshuai.xi                  ((MS_U32)pu8Data[2]<<8) + ((MS_U32)pu8Data[3]) ;
648*53ee8cc1Swenshuai.xi 
649*53ee8cc1Swenshuai.xi 
650*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "%s u8IRDNum= %x, u32EMMAddr = %x\n", __FUNCTION__, u8IRDNum, u32EMMAddr);
651*53ee8cc1Swenshuai.xi 
652*53ee8cc1Swenshuai.xi     if(u8IRDNum >= REG_EMM_IRD_MAX)
653*53ee8cc1Swenshuai.xi     {
654*53ee8cc1Swenshuai.xi         return HAL_EMMFLT_INVALID_REQUEST;
655*53ee8cc1Swenshuai.xi     }
656*53ee8cc1Swenshuai.xi 
657*53ee8cc1Swenshuai.xi 
658*53ee8cc1Swenshuai.xi     u32IRDAddr = u32Mapping[u8IRDNum];
659*53ee8cc1Swenshuai.xi 
660*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Dword(connection,u32IRDAddr,u32EMMAddr);
661*53ee8cc1Swenshuai.xi 
662*53ee8cc1Swenshuai.xi     return TRUE;
663*53ee8cc1Swenshuai.xi }
664*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_SetEmmMaskIDx(MS_U32 connection,MS_U8 u8IRDNum,MS_U8 * pu8Data)665*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_SetEmmMaskIDx(MS_U32 connection,MS_U8 u8IRDNum, MS_U8 *pu8Data)
666*53ee8cc1Swenshuai.xi {
667*53ee8cc1Swenshuai.xi     MS_U32 u32IRDAddr,u32EMMMask;
668*53ee8cc1Swenshuai.xi     MS_U32 u32Mapping[] = {REG_EMM_MASK_ID1_L, REG_EMM_MASK_ID2_L,
669*53ee8cc1Swenshuai.xi                            REG_EMM_MASK_ID3_L, REG_EMM_MASK_ID4_L,
670*53ee8cc1Swenshuai.xi                            REG_EMM_MASK_ID5_L, REG_EMM_MASK_ID6_L,
671*53ee8cc1Swenshuai.xi                            REG_EMM_MASK_ID7_L, REG_EMM_MASK_ID8_L, };
672*53ee8cc1Swenshuai.xi 
673*53ee8cc1Swenshuai.xi 
674*53ee8cc1Swenshuai.xi     ConnectionCheck(connection);
675*53ee8cc1Swenshuai.xi 
676*53ee8cc1Swenshuai.xi     u32EMMMask = ((MS_U32)pu8Data[0]<<24) + ((MS_U32)pu8Data[1]<<16) +
677*53ee8cc1Swenshuai.xi                  ((MS_U32)pu8Data[2]<<8) + ((MS_U32)pu8Data[3]) ;
678*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "%s u8IRDNum= %x, u32EMMMask = %x\n", __FUNCTION__, u8IRDNum, u32EMMMask);
679*53ee8cc1Swenshuai.xi 
680*53ee8cc1Swenshuai.xi     if(u8IRDNum >= REG_EMM_IRD_MAX)
681*53ee8cc1Swenshuai.xi     {
682*53ee8cc1Swenshuai.xi         return HAL_EMMFLT_INVALID_REQUEST;
683*53ee8cc1Swenshuai.xi     }
684*53ee8cc1Swenshuai.xi 
685*53ee8cc1Swenshuai.xi 
686*53ee8cc1Swenshuai.xi     u32IRDAddr = u32Mapping[u8IRDNum];
687*53ee8cc1Swenshuai.xi 
688*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Dword(connection,u32IRDAddr,u32EMMMask);
689*53ee8cc1Swenshuai.xi 
690*53ee8cc1Swenshuai.xi     return TRUE;
691*53ee8cc1Swenshuai.xi }
692*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_DisableEMM(MS_U32 connection)693*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_DisableEMM(MS_U32 connection)
694*53ee8cc1Swenshuai.xi {
695*53ee8cc1Swenshuai.xi     ConnectionCheck(connection);
696*53ee8cc1Swenshuai.xi 
697*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(connection,REG_EMM_PID, 0);
698*53ee8cc1Swenshuai.xi     return TRUE;
699*53ee8cc1Swenshuai.xi }
700*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_SetEmmPID(MS_U32 connection,MS_U16 u16EmmPID)701*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_SetEmmPID(MS_U32 connection,MS_U16 u16EmmPID)
702*53ee8cc1Swenshuai.xi {
703*53ee8cc1Swenshuai.xi     MS_U16 u16Data;
704*53ee8cc1Swenshuai.xi 
705*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "EMMFLT_SetEmmPID conn = %x, u16EmmPID = %x \n",connection,u16EmmPID);
706*53ee8cc1Swenshuai.xi     PrintSetting();
707*53ee8cc1Swenshuai.xi 
708*53ee8cc1Swenshuai.xi     ConnectionCheck(connection);
709*53ee8cc1Swenshuai.xi #if 1
710*53ee8cc1Swenshuai.xi     u16Data = 0;
711*53ee8cc1Swenshuai.xi     u16Data = u16EmmPID;
712*53ee8cc1Swenshuai.xi #else
713*53ee8cc1Swenshuai.xi     u16Data = HAL_EMMFLT_ReadReg_Word(connection,REG_EMM_PID);
714*53ee8cc1Swenshuai.xi 
715*53ee8cc1Swenshuai.xi     u16Data = ( u16Data & ~(REG_EMM_ENABLE_TID | REG_EMM_ENABLE_PID) ) | u16EmmPID;
716*53ee8cc1Swenshuai.xi #endif
717*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(connection,REG_EMM_PID, u16Data);
718*53ee8cc1Swenshuai.xi     return TRUE;
719*53ee8cc1Swenshuai.xi }
720*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_SetEmmTID(MS_U32 connection,MS_U16 u16EmmTID)721*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_SetEmmTID(MS_U32 connection,MS_U16 u16EmmTID)
722*53ee8cc1Swenshuai.xi {
723*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "EMMFLT_SetEmmTID conn = %x, u16EmmTID = %x \n",connection,u16EmmTID);
724*53ee8cc1Swenshuai.xi     ConnectionCheck(connection);
725*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(connection,REG_EMM_TID, u16EmmTID);
726*53ee8cc1Swenshuai.xi     return TRUE;
727*53ee8cc1Swenshuai.xi }
728*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_EnableEmmTID(MS_U32 connection,MS_BOOL bEnable)729*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_EnableEmmTID(MS_U32 connection, MS_BOOL bEnable)
730*53ee8cc1Swenshuai.xi {
731*53ee8cc1Swenshuai.xi     MS_U16 u16Data;
732*53ee8cc1Swenshuai.xi 
733*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "EMMFLT_EnableEmmTID conn = %x, bEnable = %x \n",connection,bEnable);
734*53ee8cc1Swenshuai.xi     ConnectionCheck(connection);
735*53ee8cc1Swenshuai.xi     u16Data = HAL_EMMFLT_ReadReg_Word(connection,REG_EMM_PID);
736*53ee8cc1Swenshuai.xi 
737*53ee8cc1Swenshuai.xi     if(TRUE == bEnable)
738*53ee8cc1Swenshuai.xi     {
739*53ee8cc1Swenshuai.xi         u16Data |= REG_EMM_ENABLE_TID;
740*53ee8cc1Swenshuai.xi     }
741*53ee8cc1Swenshuai.xi     else
742*53ee8cc1Swenshuai.xi     {
743*53ee8cc1Swenshuai.xi         u16Data &= (~REG_EMM_ENABLE_TID);
744*53ee8cc1Swenshuai.xi     }
745*53ee8cc1Swenshuai.xi 
746*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(connection,REG_EMM_PID, u16Data);
747*53ee8cc1Swenshuai.xi 
748*53ee8cc1Swenshuai.xi     return TRUE;
749*53ee8cc1Swenshuai.xi }
750*53ee8cc1Swenshuai.xi 
751*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_ResetInt(MS_U32 connection)752*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_ResetInt(MS_U32 connection)
753*53ee8cc1Swenshuai.xi {
754*53ee8cc1Swenshuai.xi     MS_U16 u16Data;
755*53ee8cc1Swenshuai.xi 
756*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_ERR, "EMMFLT_ResetInt conn = %x\n",connection);
757*53ee8cc1Swenshuai.xi 
758*53ee8cc1Swenshuai.xi     u16Data = HAL_EMMFLT_ReadReg_Word(connection,REG_EMM_CA_INT);
759*53ee8cc1Swenshuai.xi 
760*53ee8cc1Swenshuai.xi     u16Data |= EMM_RESET_INT;
761*53ee8cc1Swenshuai.xi 
762*53ee8cc1Swenshuai.xi 	HAL_EMMFLT_WriteReg_Word(connection,REG_EMM_CA_INT, u16Data);
763*53ee8cc1Swenshuai.xi 
764*53ee8cc1Swenshuai.xi     return TRUE;
765*53ee8cc1Swenshuai.xi }
766*53ee8cc1Swenshuai.xi 
767*53ee8cc1Swenshuai.xi #if 0
768*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_GetIntReg(MS_U16 *pu16Data)
769*53ee8cc1Swenshuai.xi {
770*53ee8cc1Swenshuai.xi     MS_U16 u16Data = 0,u16I;
771*53ee8cc1Swenshuai.xi     *pu16Data = 0;
772*53ee8cc1Swenshuai.xi 
773*53ee8cc1Swenshuai.xi     for( u16I=0 ; u16I<EMMENG_NUMBER ; u16I++)
774*53ee8cc1Swenshuai.xi     {
775*53ee8cc1Swenshuai.xi         u16Data = HAL_EMMFLT_ReadReg_Word( u16I, REG_EMM_CA_INT );
776*53ee8cc1Swenshuai.xi         *pu16Data = u16Data & (EMM_ONEPAKCET_INT | EMM_OVERFLOW_INT);
777*53ee8cc1Swenshuai.xi     }
778*53ee8cc1Swenshuai.xi 
779*53ee8cc1Swenshuai.xi     return TRUE;
780*53ee8cc1Swenshuai.xi }
781*53ee8cc1Swenshuai.xi #endif
782*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_GetIntStatus(MS_U16 * pu16EMMInt,MS_U16 * pu16IntStat,MS_U8 * pu8conflag)783*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_GetIntStatus(MS_U16 *pu16EMMInt, MS_U16 *pu16IntStat, MS_U8 *pu8conflag)
784*53ee8cc1Swenshuai.xi {
785*53ee8cc1Swenshuai.xi     MS_U16 u16Data,i;
786*53ee8cc1Swenshuai.xi 
787*53ee8cc1Swenshuai.xi     for( i=0; i<EMMENG_NUMBER ; i++)
788*53ee8cc1Swenshuai.xi     {
789*53ee8cc1Swenshuai.xi         pu8conflag[i] = FALSE;
790*53ee8cc1Swenshuai.xi         u16Data = HAL_EMMFLT_ReadReg_Word(i,REG_EMM_CA_INT);
791*53ee8cc1Swenshuai.xi         HALEMM_DBG(EMM_DBGLV_DEBUG, "%s i= %x, u16Data = %x\n", __FUNCTION__, i, u16Data);
792*53ee8cc1Swenshuai.xi 
793*53ee8cc1Swenshuai.xi         //that means the first emm has interrupt....
794*53ee8cc1Swenshuai.xi         if( (u16Data & EMMFLT_EMM_OVERFLOW_INT) || (u16Data & EMMFLT_EMM_INT) )
795*53ee8cc1Swenshuai.xi         {
796*53ee8cc1Swenshuai.xi             pu8conflag[i]  =  TRUE;
797*53ee8cc1Swenshuai.xi             pu16IntStat[i] = (u16Data & EMM_INT_MASK) ;
798*53ee8cc1Swenshuai.xi             pu16EMMInt[i]  =  u16Data;
799*53ee8cc1Swenshuai.xi         }
800*53ee8cc1Swenshuai.xi     }
801*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_DEBUG, "Int status = %x\n",u16Data);
802*53ee8cc1Swenshuai.xi 
803*53ee8cc1Swenshuai.xi     return TRUE;
804*53ee8cc1Swenshuai.xi }
805*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_GetCurrentBufIndex(MS_U32 connection)806*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_GetCurrentBufIndex(MS_U32 connection)
807*53ee8cc1Swenshuai.xi {
808*53ee8cc1Swenshuai.xi     MS_U32 index = HAL_EMMFLT_ReadReg_Word(connection, REG_EMM_INT_STAT);
809*53ee8cc1Swenshuai.xi 
810*53ee8cc1Swenshuai.xi     //MS_U32 index = (HAL_EMMFLT_ReadReg_Word(connection, REG_EMM_CA_INT)>>8);
811*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "current index = %x\n",index);
812*53ee8cc1Swenshuai.xi     return index;
813*53ee8cc1Swenshuai.xi }
814*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_ReqDstBufSize(MS_U32 * p32DstBufSize,MS_U32 * p32AlignBytes,MS_U8 * p8BufBum)815*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_ReqDstBufSize(MS_U32 *p32DstBufSize, MS_U32 *p32AlignBytes, MS_U8 *p8BufBum)
816*53ee8cc1Swenshuai.xi {
817*53ee8cc1Swenshuai.xi     *p32DstBufSize = EMMFLT_HWBUF_SIZE;
818*53ee8cc1Swenshuai.xi     *p32AlignBytes = EMMFLT_BUF_ALIGNMENT;
819*53ee8cc1Swenshuai.xi     *p8BufBum = EMMENG_NUMBER;
820*53ee8cc1Swenshuai.xi 
821*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "ReqDstBufSize HWBUF_SIZE = %x, BUF_ALIGNMENT = %x, EMMENG_NUMBER = %x\n",EMMFLT_HWBUF_SIZE, EMMFLT_BUF_ALIGNMENT,EMMENG_NUMBER);
822*53ee8cc1Swenshuai.xi     return TRUE;
823*53ee8cc1Swenshuai.xi }
824*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_SetDstBufInfo(MS_U32 connection,MS_U32 u32BufAddr,MS_U32 u32BufSize,MS_U32 * p32BufAddrs)825*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_SetDstBufInfo(MS_U32 connection, MS_U32 u32BufAddr, MS_U32 u32BufSize, MS_U32 *p32BufAddrs)
826*53ee8cc1Swenshuai.xi {
827*53ee8cc1Swenshuai.xi     MS_U32 u32I;
828*53ee8cc1Swenshuai.xi     MS_U16 u16Reg;
829*53ee8cc1Swenshuai.xi 
830*53ee8cc1Swenshuai.xi     ConnectionCheck(connection);
831*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "%s u32BufAddr= %x, u32BufSize= %x \n", __FUNCTION__, u32BufAddr,u32BufSize);
832*53ee8cc1Swenshuai.xi 
833*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Dword(connection,REG_EMM_STR2MIU_HEAD1_L, (u32BufAddr>>4));
834*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Dword(connection,REG_EMM_STR2MIU_TAIL1_L, ((u32BufAddr+u32BufSize)>>4));
835*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Dword(connection,REG_EMM_STR2MIU_MID1_L,  ((u32BufAddr+u32BufSize)>>4));
836*53ee8cc1Swenshuai.xi 
837*53ee8cc1Swenshuai.xi 
838*53ee8cc1Swenshuai.xi     u16Reg = HAL_EMMFLT_ReadReg_Word(connection,REG_EMM_STR2MIU_EN);
839*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(connection,REG_EMM_STR2MIU_EN, (u16Reg | 0x4) );
840*53ee8cc1Swenshuai.xi 
841*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(connection,REG_EMM_STR2MIU_EN,u16Reg);
842*53ee8cc1Swenshuai.xi 
843*53ee8cc1Swenshuai.xi     for(u32I = 0; u32I<MAX_EMMFLT_NUM ; u32I++)
844*53ee8cc1Swenshuai.xi     {
845*53ee8cc1Swenshuai.xi         p32BufAddrs[u32I] = u32BufAddr + (u32I*U01_NDS_EMMFLT_BUF_SIZE);
846*53ee8cc1Swenshuai.xi         HALEMM_DBG(EMM_DBGLV_INFO, "%s p32BufAddr[%x] = %x, \n", __FUNCTION__, u32I, p32BufAddrs[u32I]);
847*53ee8cc1Swenshuai.xi     }
848*53ee8cc1Swenshuai.xi 
849*53ee8cc1Swenshuai.xi     return TRUE;
850*53ee8cc1Swenshuai.xi }
851*53ee8cc1Swenshuai.xi 
852*53ee8cc1Swenshuai.xi 
853*53ee8cc1Swenshuai.xi //does connection needs to be increased.
HAL_EMMFLT_PacketCount(MS_U32 connection,MS_U8 * pCount)854*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_PacketCount(MS_U32 connection,MS_U8 *pCount)
855*53ee8cc1Swenshuai.xi {
856*53ee8cc1Swenshuai.xi     MS_U16 PacketCnt;
857*53ee8cc1Swenshuai.xi     PacketCnt = HAL_EMMFLT_ReadReg_Word(connection,REG_EMM_PACKET_CNT);
858*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "REG_EMM_PACKET_CNT = %x\n",PacketCnt);
859*53ee8cc1Swenshuai.xi     *pCount = (MS_U8)((PacketCnt>>8)&0xff);
860*53ee8cc1Swenshuai.xi     return TRUE;
861*53ee8cc1Swenshuai.xi }
862*53ee8cc1Swenshuai.xi 
863*53ee8cc1Swenshuai.xi 
864*53ee8cc1Swenshuai.xi 
865*53ee8cc1Swenshuai.xi //does connection needs to be increased.
HAL_EMMFLT_PacketAct(MS_U32 connection)866*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_PacketAct(MS_U32 connection)
867*53ee8cc1Swenshuai.xi {
868*53ee8cc1Swenshuai.xi #if 0
869*53ee8cc1Swenshuai.xi     MS_U16 u16Rg;
870*53ee8cc1Swenshuai.xi     u16Rg = HAL_EMMFLT_ReadReg_Word(connection,REG_EMM_CA_INT);
871*53ee8cc1Swenshuai.xi     u16Rg = (0x10<<8);
872*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(connection,REG_EMM_CA_INT,u16Rg);
873*53ee8cc1Swenshuai.xi #else
874*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "HAL_EMMFLT_PacketAct = %x\n",connection);
875*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_INT_STAT,EMM_RECIEVE_ACT);
876*53ee8cc1Swenshuai.xi     //HAL_EMMFLT_WriteReg_Word(connection,REG_EMM_CA_INT,(EMM_RECIEVE_ACT<<8) + 0x6);
877*53ee8cc1Swenshuai.xi #endif
878*53ee8cc1Swenshuai.xi 
879*53ee8cc1Swenshuai.xi     //MS_U16 u16Data;
880*53ee8cc1Swenshuai.xi     //MsOS_DelayTaskUs(10);
881*53ee8cc1Swenshuai.xi 
882*53ee8cc1Swenshuai.xi     //u16Data = HAL_EMMFLT_ReadReg_Word(REG_EMM_INT_STAT);
883*53ee8cc1Swenshuai.xi 
884*53ee8cc1Swenshuai.xi     //HALEMM_DBG(0, "HAL_EMMFLT_PacketAct = %x\n",u16Data);
885*53ee8cc1Swenshuai.xi 
886*53ee8cc1Swenshuai.xi     return TRUE;
887*53ee8cc1Swenshuai.xi }
888*53ee8cc1Swenshuai.xi 
889*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_IntCtrl(MS_U8 u8En)890*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_IntCtrl(MS_U8 u8En)
891*53ee8cc1Swenshuai.xi {
892*53ee8cc1Swenshuai.xi     MS_U16 u16Data;
893*53ee8cc1Swenshuai.xi 
894*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "EMMFLT_IntCtrl u8En = %x\n",u8En);
895*53ee8cc1Swenshuai.xi 
896*53ee8cc1Swenshuai.xi     u16Data = HAL_EMMFLT_ReadReg_Word(0,REG_EMM_CA_INT);
897*53ee8cc1Swenshuai.xi 
898*53ee8cc1Swenshuai.xi     if(1 == u8En ) //mask interrupt
899*53ee8cc1Swenshuai.xi     {
900*53ee8cc1Swenshuai.xi         u16Data &= (~EMM_RESET_INT);
901*53ee8cc1Swenshuai.xi         u16Data &= ~(EMM_ONEPAKCET_INT | EMM_OVERFLOW_INT);
902*53ee8cc1Swenshuai.xi     }
903*53ee8cc1Swenshuai.xi     else //unmask interrupt....
904*53ee8cc1Swenshuai.xi     {
905*53ee8cc1Swenshuai.xi         u16Data &= (~EMM_RESET_INT);
906*53ee8cc1Swenshuai.xi         u16Data |= (EMM_ONEPAKCET_INT | EMM_OVERFLOW_INT);
907*53ee8cc1Swenshuai.xi     }
908*53ee8cc1Swenshuai.xi 
909*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_CA_INT, u16Data);
910*53ee8cc1Swenshuai.xi     return TRUE;
911*53ee8cc1Swenshuai.xi }
912*53ee8cc1Swenshuai.xi 
913*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_SetDebugMode(MS_U16 u16Mode)914*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_SetDebugMode(MS_U16 u16Mode)
915*53ee8cc1Swenshuai.xi {
916*53ee8cc1Swenshuai.xi     MS_U16 u16Reg,u16I;
917*53ee8cc1Swenshuai.xi 
918*53ee8cc1Swenshuai.xi     for(u16I=0; u16I<EMMENG_NUMBER; u16I++)
919*53ee8cc1Swenshuai.xi     {
920*53ee8cc1Swenshuai.xi         u16Reg = HAL_EMMFLT_ReadReg_Word(u16I,REG_EMM_TS_IF2_CTRL);
921*53ee8cc1Swenshuai.xi 
922*53ee8cc1Swenshuai.xi         u16Reg &= ~(REG_EMM_DGB_SEL);
923*53ee8cc1Swenshuai.xi         u16Reg |= (u16Mode<<8);
924*53ee8cc1Swenshuai.xi 
925*53ee8cc1Swenshuai.xi         u16Reg |= (0x1<<13);
926*53ee8cc1Swenshuai.xi         HAL_EMMFLT_WriteReg_Word(u16I,REG_EMM_TS_IF2_CTRL, u16Reg);
927*53ee8cc1Swenshuai.xi     }
928*53ee8cc1Swenshuai.xi     return TRUE;
929*53ee8cc1Swenshuai.xi }
930*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_GetDebugStatus(MS_U32 * pRegValue)931*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_GetDebugStatus(MS_U32 *pRegValue)
932*53ee8cc1Swenshuai.xi {
933*53ee8cc1Swenshuai.xi     *pRegValue = HAL_EMMFLT_ReadReg_Dword(0,REG_EMM_TS_IF2_DEBUG_L);
934*53ee8cc1Swenshuai.xi     return TRUE;
935*53ee8cc1Swenshuai.xi }
936*53ee8cc1Swenshuai.xi 
937*53ee8cc1Swenshuai.xi 
938*53ee8cc1Swenshuai.xi //#define PureFileInOut
939*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_GeneralCtrl(MS_U32 connection)940*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_GeneralCtrl(MS_U32 connection)
941*53ee8cc1Swenshuai.xi {
942*53ee8cc1Swenshuai.xi 
943*53ee8cc1Swenshuai.xi #if 0
944*53ee8cc1Swenshuai.xi     u16Data = HAL_EMMFLT_ReadReg_Word(REG_EMM_STR2MIU_EN);
945*53ee8cc1Swenshuai.xi     u16Data |= REG_STR2MIU_RST_WADR;
946*53ee8cc1Swenshuai.xi 
947*53ee8cc1Swenshuai.xi     HALEMM_DBG(0, "REG_EMM_STR2MIU_EN = %x\n",(u16Data | REG_STR2MIU_RST_WADR));
948*53ee8cc1Swenshuai.xi 
949*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(REG_EMM_STR2MIU_EN, (u16Data | REG_STR2MIU_RST_WADR) );
950*53ee8cc1Swenshuai.xi 
951*53ee8cc1Swenshuai.xi     MsOS_DelayTaskUs(1);
952*53ee8cc1Swenshuai.xi 
953*53ee8cc1Swenshuai.xi     u16Data &= ~(REG_STR2MIU_RST_WADR);
954*53ee8cc1Swenshuai.xi     HALEMM_DBG(0, "REG_EMM_STR2MIU_EN = %x\n",u16Data);
955*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(REG_EMM_STR2MIU_EN, u16Data);
956*53ee8cc1Swenshuai.xi #endif
957*53ee8cc1Swenshuai.xi 
958*53ee8cc1Swenshuai.xi #ifdef PureFileInOut
959*53ee8cc1Swenshuai.xi     MS_U16 u16Data;
960*53ee8cc1Swenshuai.xi     u16Data = HAL_EMMFLT_ReadReg_Word(connection,REG_EMM_PID);
961*53ee8cc1Swenshuai.xi     u16Data &= 0x3fff;
962*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(connection,REG_EMM_PID, u16Data);
963*53ee8cc1Swenshuai.xi #endif
964*53ee8cc1Swenshuai.xi 
965*53ee8cc1Swenshuai.xi     //HAL_EMMFLT_WriteReg_Word(REG_EMM_GENERAL_CTRL_L, 0x0004);
966*53ee8cc1Swenshuai.xi 
967*53ee8cc1Swenshuai.xi 	/*	select parallel TS interface for TS interface 2 in emm_flt0
968*53ee8cc1Swenshuai.xi 	select exteranl sync for ts_if2 in emm_flt0
969*53ee8cc1Swenshuai.xi 	Set 1 to enable the patch of internal sync in ��tsif�� in emm_flt0
970*53ee8cc1Swenshuai.xi 	set 1 to enable ts_if2 in emm_flt0		*/
971*53ee8cc1Swenshuai.xi 	//HAL_EMMFLT_WriteReg_Word(connection,REG_EMM_TS_IF2_CTRL, 0x80e1);
972*53ee8cc1Swenshuai.xi 
973*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(connection,REG_EMM_GENERAL_CTRL_L, 0x0000);
974*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(connection,REG_EMM_GENERAL_CTRL_H, 0x0010);	//Bit[23:20]: packet number enable bits for TS3-TS0
975*53ee8cc1Swenshuai.xi 
976*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_ERR, "fire EMM filter\n");
977*53ee8cc1Swenshuai.xi 
978*53ee8cc1Swenshuai.xi     return TRUE;
979*53ee8cc1Swenshuai.xi }
980*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_ConnectCheck(MS_U32 connection)981*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_ConnectCheck(MS_U32 connection)
982*53ee8cc1Swenshuai.xi {
983*53ee8cc1Swenshuai.xi 
984*53ee8cc1Swenshuai.xi     ConnectionCheck(connection);
985*53ee8cc1Swenshuai.xi     return TRUE;
986*53ee8cc1Swenshuai.xi }
987*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_HWSimulation(void)988*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_HWSimulation(void)
989*53ee8cc1Swenshuai.xi {
990*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_GENERAL_CTRL_L, 0x0004);
991*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_GENERAL_CTRL_H, 0x0010);
992*53ee8cc1Swenshuai.xi 
993*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_CA_INT, 0x0006);
994*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_TS_IF2_CTRL, 0x80e1);
995*53ee8cc1Swenshuai.xi 
996*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_PID, 0xC000);
997*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_TID, 0x0000);
998*53ee8cc1Swenshuai.xi 
999*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_TID_MODE_L, 0xFFFF);
1000*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_TID_MODE_H, 0x0000);
1001*53ee8cc1Swenshuai.xi 
1002*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_STR2MIU_EN, 0x0002); //string 2 miu enable
1003*53ee8cc1Swenshuai.xi 
1004*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_STR2MIU_HEAD1_L, 0x0000);
1005*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_STR2MIU_HEAD1_H, 0x0000);
1006*53ee8cc1Swenshuai.xi 
1007*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_STR2MIU_TAIL1_L, 0x006C);
1008*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_STR2MIU_TAIL1_H, 0x0000);
1009*53ee8cc1Swenshuai.xi 
1010*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_STR2MIU_MID1_L, 0x0010);
1011*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_STR2MIU_MID1_H, 0x0000);
1012*53ee8cc1Swenshuai.xi 
1013*53ee8cc1Swenshuai.xi 
1014*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_STR2MIU_HEAD2_L, 0x1000);
1015*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_STR2MIU_HEAD2_H, 0x0000);
1016*53ee8cc1Swenshuai.xi 
1017*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_STR2MIU_TAIL2_L, 0x106C);
1018*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_STR2MIU_TAIL2_H, 0x0000);
1019*53ee8cc1Swenshuai.xi 
1020*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_STR2MIU_MID2_L, 0x1010);
1021*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_STR2MIU_MID2_H, 0x0000);
1022*53ee8cc1Swenshuai.xi 
1023*53ee8cc1Swenshuai.xi     return TRUE;
1024*53ee8cc1Swenshuai.xi }
1025*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_IntStatusTest(void)1026*53ee8cc1Swenshuai.xi void HAL_EMMFLT_IntStatusTest(void)
1027*53ee8cc1Swenshuai.xi {
1028*53ee8cc1Swenshuai.xi     MS_U16 CA_INT, INT_STAT;
1029*53ee8cc1Swenshuai.xi 
1030*53ee8cc1Swenshuai.xi     CA_INT = HAL_EMMFLT_ReadReg_Word(0,REG_EMM_CA_INT);
1031*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "REG_EMM_CA_INT = %x\n",CA_INT);
1032*53ee8cc1Swenshuai.xi 
1033*53ee8cc1Swenshuai.xi     INT_STAT = HAL_EMMFLT_ReadReg_Word(0,REG_EMM_INT_STAT);
1034*53ee8cc1Swenshuai.xi     HALEMM_DBG(EMM_DBGLV_INFO, "REG_EMM_INT_STAT = %x\n",INT_STAT);
1035*53ee8cc1Swenshuai.xi 
1036*53ee8cc1Swenshuai.xi 
1037*53ee8cc1Swenshuai.xi     if(CA_INT == 0x2)
1038*53ee8cc1Swenshuai.xi     {
1039*53ee8cc1Swenshuai.xi         HAL_EMMFLT_WriteReg_Word(0,REG_EMM_INT_STAT,EMM_RECIEVE_ACT);
1040*53ee8cc1Swenshuai.xi         HAL_EMMFLT_WriteReg_Word(0,REG_EMM_CA_INT,(EMM_RECIEVE_ACT<<8) + 0x6);
1041*53ee8cc1Swenshuai.xi     }
1042*53ee8cc1Swenshuai.xi     else if(CA_INT == 0x6)
1043*53ee8cc1Swenshuai.xi     {
1044*53ee8cc1Swenshuai.xi         HALEMM_DBG(EMM_DBGLV_INFO, "Buffer overflow\n");
1045*53ee8cc1Swenshuai.xi     }
1046*53ee8cc1Swenshuai.xi 
1047*53ee8cc1Swenshuai.xi }
1048*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_SetExtendConfig(MS_U32 x_connection,MS_U16 type,MS_U16 extendbytes,MS_U16 syncbyte)1049*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_SetExtendConfig(MS_U32 x_connection, MS_U16 type, MS_U16 extendbytes, MS_U16 syncbyte)
1050*53ee8cc1Swenshuai.xi {
1051*53ee8cc1Swenshuai.xi     MS_U16 Reg;
1052*53ee8cc1Swenshuai.xi 
1053*53ee8cc1Swenshuai.xi     Reg = 0x204;
1054*53ee8cc1Swenshuai.xi     Reg = (Reg&(~0x1f0)) | ((extendbytes&0x1f)<<4);
1055*53ee8cc1Swenshuai.xi     printf("EMM HW Config 0 is %x\n",Reg);
1056*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(x_connection,REG_EMM_HW_CONFIG0, 0x02C4);
1057*53ee8cc1Swenshuai.xi 
1058*53ee8cc1Swenshuai.xi 
1059*53ee8cc1Swenshuai.xi     Reg = HAL_EMMFLT_ReadReg_Word(x_connection,REG_EMM_SYNC_BYTES);
1060*53ee8cc1Swenshuai.xi 
1061*53ee8cc1Swenshuai.xi     Reg = ((extendbytes + 188)<<0x8) | (syncbyte&0xff);
1062*53ee8cc1Swenshuai.xi     printf("sync byte reg is %x\n",Reg);
1063*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(x_connection,REG_EMM_SYNC_BYTES, Reg);
1064*53ee8cc1Swenshuai.xi 
1065*53ee8cc1Swenshuai.xi     return TRUE;
1066*53ee8cc1Swenshuai.xi }
1067*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_Bypass(void)1068*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_Bypass(void)
1069*53ee8cc1Swenshuai.xi {
1070*53ee8cc1Swenshuai.xi     MS_U16 Reg;
1071*53ee8cc1Swenshuai.xi     Reg = HAL_EMMFLT_ReadReg_Word(0,REG_EMM_CTRL0_L);
1072*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(0,REG_EMM_CTRL0_L, (Reg | EMM_FLT_BYPASS) );
1073*53ee8cc1Swenshuai.xi 
1074*53ee8cc1Swenshuai.xi     return TRUE;
1075*53ee8cc1Swenshuai.xi }
1076*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_En192Output(MS_U32 x_connection)1077*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_En192Output(MS_U32 x_connection)
1078*53ee8cc1Swenshuai.xi {
1079*53ee8cc1Swenshuai.xi     MS_U16 Reg;
1080*53ee8cc1Swenshuai.xi 
1081*53ee8cc1Swenshuai.xi     Reg = HAL_EMMFLT_ReadReg_Word(x_connection,REG_EMM_CTRL0_L);
1082*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(x_connection,REG_EMM_CTRL0_L, (Reg & ~(EMM_PACKET256_EN | EMM_PVR_EN)) );
1083*53ee8cc1Swenshuai.xi 
1084*53ee8cc1Swenshuai.xi     Reg = HAL_EMMFLT_ReadReg_Word(x_connection,REG_EMM_STR2MIU_CTRL);
1085*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word(x_connection,REG_EMM_STR2MIU_CTRL, (Reg | REG_PKT192_EN) );
1086*53ee8cc1Swenshuai.xi 
1087*53ee8cc1Swenshuai.xi     return TRUE;
1088*53ee8cc1Swenshuai.xi }
1089*53ee8cc1Swenshuai.xi 
HAL_EMMFLT_InputMode(MS_U32 x_connection,MS_BOOL bSerial)1090*53ee8cc1Swenshuai.xi MS_U32 HAL_EMMFLT_InputMode(MS_U32 x_connection, MS_BOOL bSerial)
1091*53ee8cc1Swenshuai.xi {
1092*53ee8cc1Swenshuai.xi     MS_U16 Reg_TS_IF2_CTRL = 0, Reg_STR2MIU_CTRL = 0;
1093*53ee8cc1Swenshuai.xi 
1094*53ee8cc1Swenshuai.xi     Reg_TS_IF2_CTRL = HAL_EMMFLT_ReadReg_Word(x_connection, REG_EMM_TS_IF2_CTRL );
1095*53ee8cc1Swenshuai.xi     Reg_TS_IF2_CTRL &= ~(REG_SIM_C0_CONFIG | REG_SIM_C1_CONFIG | REG_P_SEL2 | REG_EXT_SYNC_SEL2 | REG_SERIAL_EXT_SYNC_1T); // bit 2,3,5,6,12
1096*53ee8cc1Swenshuai.xi 
1097*53ee8cc1Swenshuai.xi     Reg_STR2MIU_CTRL = HAL_EMMFLT_ReadReg_Word(x_connection, REG_EMM_STR2MIU_CTRL );
1098*53ee8cc1Swenshuai.xi 
1099*53ee8cc1Swenshuai.xi     if( bSerial == TRUE ) //input with serial mode....
1100*53ee8cc1Swenshuai.xi     {
1101*53ee8cc1Swenshuai.xi         Reg_TS_IF2_CTRL |= (REG_SIM_C0_CONFIG | REG_SIM_C1_CONFIG | REG_EXT_SYNC_SEL2 | REG_SERIAL_EXT_SYNC_1T);  // bit[3..2]=11, bit[6..5]=10,bit[12]=1
1102*53ee8cc1Swenshuai.xi         Reg_STR2MIU_CTRL |= REG_RECORD_AT_SYNC_DIS;  // bit[10]=1
1103*53ee8cc1Swenshuai.xi     }
1104*53ee8cc1Swenshuai.xi     else  //input with parallel mode....
1105*53ee8cc1Swenshuai.xi     {
1106*53ee8cc1Swenshuai.xi         Reg_TS_IF2_CTRL |= (REG_P_SEL2 | REG_EXT_SYNC_SEL2);  // bit[3..2]=00, bit[6..5]=11,bit[12]=0
1107*53ee8cc1Swenshuai.xi         Reg_STR2MIU_CTRL &= ~(REG_RECORD_AT_SYNC_DIS);  // bit[10]=0
1108*53ee8cc1Swenshuai.xi     }
1109*53ee8cc1Swenshuai.xi 
1110*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word( x_connection, REG_EMM_TS_IF2_CTRL, Reg_TS_IF2_CTRL );
1111*53ee8cc1Swenshuai.xi     HAL_EMMFLT_WriteReg_Word( x_connection, REG_EMM_STR2MIU_CTRL, Reg_STR2MIU_CTRL );
1112*53ee8cc1Swenshuai.xi     return TRUE;
1113*53ee8cc1Swenshuai.xi }
1114*53ee8cc1Swenshuai.xi 
1115