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