xref: /utopia/UTPA2-700.0.x/modules/dms/hal/M7221/dms/halDMS.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) 2006-2009 MStar Semiconductor, Inc.
81*53ee8cc1Swenshuai.xi // All rights reserved.
82*53ee8cc1Swenshuai.xi //
83*53ee8cc1Swenshuai.xi // Unless otherwise stipulated in writing, any and all information contained
84*53ee8cc1Swenshuai.xi // herein regardless in any format shall remain the sole proprietary of
85*53ee8cc1Swenshuai.xi // MStar Semiconductor Inc. and be kept in strict confidence
86*53ee8cc1Swenshuai.xi // (��MStar Confidential Information��) by the recipient.
87*53ee8cc1Swenshuai.xi // Any unauthorized act including without limitation unauthorized disclosure,
88*53ee8cc1Swenshuai.xi // copying, use, reproduction, sale, distribution, modification, disassembling,
89*53ee8cc1Swenshuai.xi // reverse engineering and compiling of the contents of MStar Confidential
90*53ee8cc1Swenshuai.xi // Information is unlawful and strictly prohibited. MStar hereby reserves the
91*53ee8cc1Swenshuai.xi // rights to any and all damages, losses, costs and expenses resulting therefrom.
92*53ee8cc1Swenshuai.xi //
93*53ee8cc1Swenshuai.xi ////////////////////////////////////////////////////////////////////////////////
94*53ee8cc1Swenshuai.xi 
95*53ee8cc1Swenshuai.xi ///////////////////////////////////////////////////////////////////////////////////////////////////
96*53ee8cc1Swenshuai.xi ///
97*53ee8cc1Swenshuai.xi /// file    halDMS.c
98*53ee8cc1Swenshuai.xi /// @author MStar Semiconductor Inc.
99*53ee8cc1Swenshuai.xi /// @brief  DMS Utility HAL
100*53ee8cc1Swenshuai.xi ///////////////////////////////////////////////////////////////////////////////////////////////////
101*53ee8cc1Swenshuai.xi #define  HAL_DMS_C
102*53ee8cc1Swenshuai.xi 
103*53ee8cc1Swenshuai.xi //-------------------------------------------------------------------------------------------------
104*53ee8cc1Swenshuai.xi //  Include Files
105*53ee8cc1Swenshuai.xi //-------------------------------------------------------------------------------------------------
106*53ee8cc1Swenshuai.xi // Common Definition
107*53ee8cc1Swenshuai.xi #ifdef MSOS_TYPE_LINUX_KERNEL
108*53ee8cc1Swenshuai.xi #include <linux/string.h>
109*53ee8cc1Swenshuai.xi #else
110*53ee8cc1Swenshuai.xi #include <stdlib.h>
111*53ee8cc1Swenshuai.xi #include <string.h>
112*53ee8cc1Swenshuai.xi #include <unistd.h>
113*53ee8cc1Swenshuai.xi #endif
114*53ee8cc1Swenshuai.xi 
115*53ee8cc1Swenshuai.xi #include "MsCommon.h"
116*53ee8cc1Swenshuai.xi #include "MsVersion.h"
117*53ee8cc1Swenshuai.xi #include "drvMMIO.h"
118*53ee8cc1Swenshuai.xi //#include "apiDMS_Type.h"
119*53ee8cc1Swenshuai.xi #include "drvDMS.h"
120*53ee8cc1Swenshuai.xi #include "halDMS.h"
121*53ee8cc1Swenshuai.xi #include "UFO.h"
122*53ee8cc1Swenshuai.xi #include "apiPNL.h"
123*53ee8cc1Swenshuai.xi 
124*53ee8cc1Swenshuai.xi #include "utopia.h"
125*53ee8cc1Swenshuai.xi #include "utopia_dapi.h"
126*53ee8cc1Swenshuai.xi #include "apiDMS_private.h"
127*53ee8cc1Swenshuai.xi 
128*53ee8cc1Swenshuai.xi #ifndef ANDROID
129*53ee8cc1Swenshuai.xi #define DMS_PRINTF printf
130*53ee8cc1Swenshuai.xi #else
131*53ee8cc1Swenshuai.xi #include <sys/mman.h>
132*53ee8cc1Swenshuai.xi #include <cutils/ashmem.h>
133*53ee8cc1Swenshuai.xi #include <cutils/log.h>
134*53ee8cc1Swenshuai.xi 
135*53ee8cc1Swenshuai.xi #define DMS_PRINTF ALOGD
136*53ee8cc1Swenshuai.xi #endif
137*53ee8cc1Swenshuai.xi 
138*53ee8cc1Swenshuai.xi //-------------------------------------------------------------------------------------------------
139*53ee8cc1Swenshuai.xi //  Driver Compiler Options
140*53ee8cc1Swenshuai.xi //-------------------------------------------------------------------------------------------------
141*53ee8cc1Swenshuai.xi 
142*53ee8cc1Swenshuai.xi //-------------------------------------------------------------------------------------------------
143*53ee8cc1Swenshuai.xi //  Local Defines
144*53ee8cc1Swenshuai.xi //-------------------------------------------------------------------------------------------------
145*53ee8cc1Swenshuai.xi #define REG_MEMSYNC_BLACK_MODE               (0x117E)
146*53ee8cc1Swenshuai.xi #define BIT_MEMSYNC_PIXEL_MASK_EN            (0x100)
147*53ee8cc1Swenshuai.xi #define BIT_MEMSYNC_MOTION_RATIO_MASK_EN     (0x200)
148*53ee8cc1Swenshuai.xi #define BIT_MEMSYNC_RESET                    (0x400)
149*53ee8cc1Swenshuai.xi #define BIT_MEMSYNC_DELAY_ONE_FRAME          (0x800)
150*53ee8cc1Swenshuai.xi #define BIT_MEMSYNC_DOTLINE                  (0x1000)
_DMS_XC_SetVideoMute_AutoSync(MS_BOOL bEnable)151*53ee8cc1Swenshuai.xi static MS_BOOL _DMS_XC_SetVideoMute_AutoSync(MS_BOOL bEnable)
152*53ee8cc1Swenshuai.xi {
153*53ee8cc1Swenshuai.xi     E_APIXC_ReturnValue eXcRet;
154*53ee8cc1Swenshuai.xi 
155*53ee8cc1Swenshuai.xi     eXcRet = MApi_XC_GenerateBlackVideoByMode(bEnable, MAIN_WINDOW,E_XC_BLACK_VIDEO_MEMSYNC);
156*53ee8cc1Swenshuai.xi     if(eXcRet != E_APIXC_RET_OK)
157*53ee8cc1Swenshuai.xi     {
158*53ee8cc1Swenshuai.xi         DMS_PRINTF("[%s][%d]MApi_XC_GenerateBlackVideoByMode fail:%d", __FUNCTION__, __LINE__, eXcRet);
159*53ee8cc1Swenshuai.xi         return FALSE;
160*53ee8cc1Swenshuai.xi     }
161*53ee8cc1Swenshuai.xi     return TRUE;
162*53ee8cc1Swenshuai.xi }
163*53ee8cc1Swenshuai.xi 
Hal_DMS_XC_SetMute(void * pInstance,MS_BOOL bEnable)164*53ee8cc1Swenshuai.xi MS_BOOL Hal_DMS_XC_SetMute(void* pInstance, MS_BOOL bEnable)
165*53ee8cc1Swenshuai.xi {
166*53ee8cc1Swenshuai.xi     MS_BOOL bRet = FALSE;
167*53ee8cc1Swenshuai.xi     MApi_XC_SkipWaitVsync(MAIN_WINDOW,TRUE);
168*53ee8cc1Swenshuai.xi     bRet = _DMS_XC_SetVideoMute_AutoSync(bEnable);
169*53ee8cc1Swenshuai.xi     MApi_XC_SkipWaitVsync(MAIN_WINDOW,FALSE);
170*53ee8cc1Swenshuai.xi     return bRet;
171*53ee8cc1Swenshuai.xi }
172*53ee8cc1Swenshuai.xi 
173*53ee8cc1Swenshuai.xi #define H_PostScalingRatio(Input, Output)          ((MS_U32)( ((MS_U64)(Input)) * 2097152ul / (Output) + 1 )/2)
174*53ee8cc1Swenshuai.xi #define V_PostScalingRatio(Input, Output)          ((MS_U32)( ((MS_U64)(Input) * 2097152ul) / Output + 1) / 2)
175*53ee8cc1Swenshuai.xi #define DMS_DS_DEPTH 0x8
176*53ee8cc1Swenshuai.xi #define DMS_DS_SET_COUNT 0x6
177*53ee8cc1Swenshuai.xi #define ALL_IP_COMMAND 0
178*53ee8cc1Swenshuai.xi extern void* g_pDMSRes;
179*53ee8cc1Swenshuai.xi 
HAL_DMS_XC_DSSetConfig(void * pInstance)180*53ee8cc1Swenshuai.xi MS_BOOL HAL_DMS_XC_DSSetConfig(void* pInstance)
181*53ee8cc1Swenshuai.xi {
182*53ee8cc1Swenshuai.xi     DMS_RESOURCE_PRIVATE* pDMSResPri = NULL;
183*53ee8cc1Swenshuai.xi     UtopiaResourceGetPrivate(g_pDMSRes,(void**)(&pDMSResPri));
184*53ee8cc1Swenshuai.xi     memset(&pDMSResPri->stHalDMS.stDMS_DSSWDB, 0 , sizeof(pDMSResPri->stHalDMS.stDMS_DSSWDB));
185*53ee8cc1Swenshuai.xi     pDMSResPri->stHalDMS.phyDSAddr = MApi_XC_R4BYTE(0x1F22);
186*53ee8cc1Swenshuai.xi     pDMSResPri->stHalDMS.phyDSAddr *= 0x20;
187*53ee8cc1Swenshuai.xi     printf("Get DS Addr 0x%tx\n",(ptrdiff_t)pDMSResPri->stHalDMS.phyDSAddr);
188*53ee8cc1Swenshuai.xi     // SC0_MCU_DS_AVAILABLE
189*53ee8cc1Swenshuai.xi     //Set DS is out of DMS
190*53ee8cc1Swenshuai.xi     #if 0
191*53ee8cc1Swenshuai.xi     XC_DynamicScaling_Info stDSInfo;
192*53ee8cc1Swenshuai.xi     stDSInfo.u32DS_Info_BaseAddr = gphy_DSAddr;
193*53ee8cc1Swenshuai.xi     stDSInfo.bOP_DS_On           = 0;
194*53ee8cc1Swenshuai.xi     stDSInfo.u8DS_Index_Depth    = DMS_DS_DEPTH;
195*53ee8cc1Swenshuai.xi     stDSInfo.bOP_DS_On           = TRUE;
196*53ee8cc1Swenshuai.xi     stDSInfo.bIPS_DS_On          = FALSE;
197*53ee8cc1Swenshuai.xi     stDSInfo.bIPM_DS_On          = TRUE;
198*53ee8cc1Swenshuai.xi     MApi_XC_SetDynamicScaling(&stDSInfo,sizeof(stDSInfo),MAIN_WINDOW);
199*53ee8cc1Swenshuai.xi     #endif
200*53ee8cc1Swenshuai.xi     #if ALL_IP_COMMAND
201*53ee8cc1Swenshuai.xi     MApi_XC_W2BYTEMSK(0x1F26,0x10,0xFF);
202*53ee8cc1Swenshuai.xi     #else
203*53ee8cc1Swenshuai.xi     //MApi_XC_W2BYTEMSK(0x2032,0x0,0x300);
204*53ee8cc1Swenshuai.xi     #endif
205*53ee8cc1Swenshuai.xi     return TRUE;
206*53ee8cc1Swenshuai.xi }
207*53ee8cc1Swenshuai.xi 
208*53ee8cc1Swenshuai.xi #define DS_CMD_LEN_64BITS                   8
209*53ee8cc1Swenshuai.xi #define BYTE_PER_WORD           (32)  // MIU 128: 16Byte/W, MIU 256: 32Byte/W
210*53ee8cc1Swenshuai.xi #define OP_BASE_OFFSET (2 * DMS_DS_SET_COUNT * DMS_DS_DEPTH * BYTE_PER_WORD)
Hal_DMS_ResetSWDSCommand(void * pInstance,MS_U8 u8DSIndex)211*53ee8cc1Swenshuai.xi void Hal_DMS_ResetSWDSCommand(void* pInstance, MS_U8 u8DSIndex)
212*53ee8cc1Swenshuai.xi {
213*53ee8cc1Swenshuai.xi     DMS_RESOURCE_PRIVATE* pDMSResPri = NULL;
214*53ee8cc1Swenshuai.xi     UtopiaResourceGetPrivate(g_pDMSRes,(void**)(&pDMSResPri));
215*53ee8cc1Swenshuai.xi 
216*53ee8cc1Swenshuai.xi #if ALL_IP_COMMAND
217*53ee8cc1Swenshuai.xi     MS_PHY u32IndexBase = pDMSResPri->stHalDMS.phyDSAddr + u8DSIndex * DMS_DS_DEPTH * 2 * BYTE_PER_WORD;
218*53ee8cc1Swenshuai.xi #else
219*53ee8cc1Swenshuai.xi     MS_PHY u32IndexBase = pDMSResPri->stHalDMS.phyDSAddr + u8DSIndex * DMS_DS_DEPTH * BYTE_PER_WORD;
220*53ee8cc1Swenshuai.xi     MS_PHY u32IndexBase_OP = u32IndexBase + OP_BASE_OFFSET;
221*53ee8cc1Swenshuai.xi #endif
222*53ee8cc1Swenshuai.xi 
223*53ee8cc1Swenshuai.xi     MS_U16 u16TotalCmdCnt = DMS_DS_DEPTH;
224*53ee8cc1Swenshuai.xi     MS_U16 i = 0;
225*53ee8cc1Swenshuai.xi 
226*53ee8cc1Swenshuai.xi     MS_U64 *pu64Data = NULL;
227*53ee8cc1Swenshuai.xi     u16TotalCmdCnt *= 2;
228*53ee8cc1Swenshuai.xi     u16TotalCmdCnt *= 2;
229*53ee8cc1Swenshuai.xi 
230*53ee8cc1Swenshuai.xi     for(i = 0; i < u16TotalCmdCnt; i++)
231*53ee8cc1Swenshuai.xi     {
232*53ee8cc1Swenshuai.xi         pu64Data  = (MS_U64*)MsOS_PA2KSEG1(u32IndexBase + i*DS_CMD_LEN_64BITS);
233*53ee8cc1Swenshuai.xi         *pu64Data = 0x00000009FFFF0000;
234*53ee8cc1Swenshuai.xi     }
235*53ee8cc1Swenshuai.xi #if (ALL_IP_COMMAND == 0)
236*53ee8cc1Swenshuai.xi     for(i = 0; i < u16TotalCmdCnt; i++)
237*53ee8cc1Swenshuai.xi     {
238*53ee8cc1Swenshuai.xi         pu64Data  = (MS_U64*)MsOS_PA2KSEG1(u32IndexBase_OP + i*DS_CMD_LEN_64BITS);
239*53ee8cc1Swenshuai.xi         *pu64Data = 0x00000009FFFF0000;
240*53ee8cc1Swenshuai.xi     }
241*53ee8cc1Swenshuai.xi #endif
242*53ee8cc1Swenshuai.xi }
243*53ee8cc1Swenshuai.xi 
Hal_DMS_WriteSWDSCommand(void * pInstance,SCALER_WIN eWindow,MS_U32 u32CmdRegAddr,MS_U16 u16CmdRegValue,DMS_ds_reg_ip_op_sel IPOP_Sel,DMS_ds_reg_source_sel Source_Select,DMS_DS_CMDCNT * pstXC_DS_CmdCnt)244*53ee8cc1Swenshuai.xi void Hal_DMS_WriteSWDSCommand(void* pInstance, SCALER_WIN eWindow, MS_U32 u32CmdRegAddr, MS_U16 u16CmdRegValue, DMS_ds_reg_ip_op_sel IPOP_Sel, DMS_ds_reg_source_sel Source_Select, DMS_DS_CMDCNT *pstXC_DS_CmdCnt)
245*53ee8cc1Swenshuai.xi {
246*53ee8cc1Swenshuai.xi     DMS_RESOURCE_PRIVATE* pDMSResPri = NULL;
247*53ee8cc1Swenshuai.xi     UtopiaResourceGetPrivate(g_pDMSRes,(void**)(&pDMSResPri));
248*53ee8cc1Swenshuai.xi 
249*53ee8cc1Swenshuai.xi     if(pstXC_DS_CmdCnt->u16CMDCNT_IPM == 0 && pstXC_DS_CmdCnt->u16CMDCNT_OPM == 0)
250*53ee8cc1Swenshuai.xi     {
251*53ee8cc1Swenshuai.xi         Hal_DMS_ResetSWDSCommand(pInstance, pDMSResPri->stHalDMS.u8DSIndex);
252*53ee8cc1Swenshuai.xi     }
253*53ee8cc1Swenshuai.xi #if ALL_IP_COMMAND
254*53ee8cc1Swenshuai.xi     MS_PHY u32Addr = pDMSResPri->stHalDMS.phyDSAddr + pDMSResPri->stHalDMS.u8DSIndex * DMS_DS_DEPTH * 2 * BYTE_PER_WORD;
255*53ee8cc1Swenshuai.xi #else
256*53ee8cc1Swenshuai.xi     MS_PHY u32Addr = pDMSResPri->stHalDMS.phyDSAddr + pDMSResPri->stHalDMS.u8DSIndex * DMS_DS_DEPTH * BYTE_PER_WORD;
257*53ee8cc1Swenshuai.xi #endif
258*53ee8cc1Swenshuai.xi 
259*53ee8cc1Swenshuai.xi     //XC_LOG_TRACE(XC_DBGLEVEL_SETWINDOW,"[%s,%5d] [DS] u32DynamicScalingBaseAddr:%x  CurIdx:%d  IdxDepth:%d  BYTE_PER_WORD:%d  \n",__func__,__LINE__,(int)pXCResourcePrivate->sthal_SC.u32DynamicScalingBaseAddr,(int)pXCResourcePrivate->sthal_SC.u8DynamicScalingCurrentIndex[eWindow],(int)pXCResourcePrivate->sthal_SC.u8DynamicScalingIndexDepth,(int)BYTE_PER_WORD);
260*53ee8cc1Swenshuai.xi     //XC_LOG_TRACE(XC_DBGLEVEL_SETWINDOW,"[%s,%5d] [DS] u32Addr:%x  \n",__func__,__LINE__,(int)u32Addr);
261*53ee8cc1Swenshuai.xi 
262*53ee8cc1Swenshuai.xi     MS_U64 *pu64Data = NULL;
263*53ee8cc1Swenshuai.xi     MS_U64 u64CmdTemp = 0;
264*53ee8cc1Swenshuai.xi     MS_U8  u8AddrTemp = 0;
265*53ee8cc1Swenshuai.xi     MS_U16 u16BankTemp = 0;
266*53ee8cc1Swenshuai.xi     MS_U16 u16DataTemp = 0;
267*53ee8cc1Swenshuai.xi     MS_U16 u16MaskTemp = 0;
268*53ee8cc1Swenshuai.xi     MS_U8 u8MaxCmdCnt = DMS_DS_DEPTH * 2;
269*53ee8cc1Swenshuai.xi #if ALL_IP_COMMAND
270*53ee8cc1Swenshuai.xi     u8MaxCmdCnt *= 2;
271*53ee8cc1Swenshuai.xi #endif
272*53ee8cc1Swenshuai.xi 
273*53ee8cc1Swenshuai.xi     if(Source_Select == DMS_DS_XC)
274*53ee8cc1Swenshuai.xi     {
275*53ee8cc1Swenshuai.xi         u16MaskTemp = 0xFFFF;
276*53ee8cc1Swenshuai.xi         u16DataTemp = u16CmdRegValue;
277*53ee8cc1Swenshuai.xi 
278*53ee8cc1Swenshuai.xi         u8AddrTemp= (u32CmdRegAddr & 0x000000FF) >> 1;
279*53ee8cc1Swenshuai.xi         u16BankTemp= 0x1300 | ((u32CmdRegAddr >> 8) & 0x000000FF); // 0x13XX xc sread mode address
280*53ee8cc1Swenshuai.xi 
281*53ee8cc1Swenshuai.xi         u64CmdTemp|= (MS_U64)u16DataTemp;
282*53ee8cc1Swenshuai.xi         u64CmdTemp|= ((MS_U64)u8AddrTemp<<16);
283*53ee8cc1Swenshuai.xi         u64CmdTemp|= ((MS_U64)u16BankTemp<<23);
284*53ee8cc1Swenshuai.xi         u64CmdTemp|= ((MS_U64)u16MaskTemp<<48);
285*53ee8cc1Swenshuai.xi 
286*53ee8cc1Swenshuai.xi         if(IPOP_Sel == DS_IP)
287*53ee8cc1Swenshuai.xi         {
288*53ee8cc1Swenshuai.xi             if(eWindow == MAIN_WINDOW)
289*53ee8cc1Swenshuai.xi             {
290*53ee8cc1Swenshuai.xi                 MS_U32 u32MemShift_IPM;
291*53ee8cc1Swenshuai.xi 
292*53ee8cc1Swenshuai.xi                 if((pstXC_DS_CmdCnt->u16CMDCNT_IPM % 2) == 0)
293*53ee8cc1Swenshuai.xi                 {
294*53ee8cc1Swenshuai.xi                     u32MemShift_IPM = (pstXC_DS_CmdCnt->u16CMDCNT_IPM / 2) * BYTE_PER_WORD;
295*53ee8cc1Swenshuai.xi                 }
296*53ee8cc1Swenshuai.xi                 else
297*53ee8cc1Swenshuai.xi                 {
298*53ee8cc1Swenshuai.xi                     u32MemShift_IPM = (pstXC_DS_CmdCnt->u16CMDCNT_IPM / 2) * BYTE_PER_WORD  + DS_CMD_LEN_64BITS;
299*53ee8cc1Swenshuai.xi                 }
300*53ee8cc1Swenshuai.xi                 //XC_PRINTF("[%s,%5d] [DS_IP]pstXC_DS_CmdCnt->u16CMDCNT_IPM:%d u32MemShift_IPM:%lx \n",__func__,__LINE__,pstXC_DS_CmdCnt->u16CMDCNT_IPM,(MS_U32)u32MemShift_IPM);
301*53ee8cc1Swenshuai.xi                 //u32Addr = u32Addr + DS_CMD_LEN_64BITS * pstXC_DS_CmdCnt->u16CMDCNT_IPM;
302*53ee8cc1Swenshuai.xi                 u32Addr = u32Addr + u32MemShift_IPM;
303*53ee8cc1Swenshuai.xi                 if(0)//u32Addr == 0x11956200)
304*53ee8cc1Swenshuai.xi                 {
305*53ee8cc1Swenshuai.xi                     printf("[%s] addr 0x%llx, 0x%llx\n",__FUNCTION__,*((MS_U64*)MsOS_PA2KSEG1(0x11956200)),u64CmdTemp);
306*53ee8cc1Swenshuai.xi                 }
307*53ee8cc1Swenshuai.xi 
308*53ee8cc1Swenshuai.xi                 pu64Data = (MS_U64*)MsOS_PA2KSEG1(u32Addr);//IPM
309*53ee8cc1Swenshuai.xi 
310*53ee8cc1Swenshuai.xi                 if(pstXC_DS_CmdCnt->u16CMDCNT_IPM < u8MaxCmdCnt)
311*53ee8cc1Swenshuai.xi                 {
312*53ee8cc1Swenshuai.xi                     *pu64Data = u64CmdTemp;
313*53ee8cc1Swenshuai.xi                     pstXC_DS_CmdCnt->u16CMDCNT_IPM++;
314*53ee8cc1Swenshuai.xi                 }
315*53ee8cc1Swenshuai.xi                 else
316*53ee8cc1Swenshuai.xi                 {
317*53ee8cc1Swenshuai.xi                     printf("[%s,%5d] [DS] IPM Command count overflow !!  u16CMDCNT_IPM:%d  Max command count: %d\n",__func__,__LINE__,pstXC_DS_CmdCnt->u16CMDCNT_IPM,DMS_DS_DEPTH * 2);
318*53ee8cc1Swenshuai.xi                 }
319*53ee8cc1Swenshuai.xi             }
320*53ee8cc1Swenshuai.xi         }
321*53ee8cc1Swenshuai.xi         else
322*53ee8cc1Swenshuai.xi         {
323*53ee8cc1Swenshuai.xi             if(eWindow == MAIN_WINDOW)
324*53ee8cc1Swenshuai.xi             {
325*53ee8cc1Swenshuai.xi                 MS_U32 u32MemShift_OPM;
326*53ee8cc1Swenshuai.xi 
327*53ee8cc1Swenshuai.xi                 if((pstXC_DS_CmdCnt->u16CMDCNT_OPM % 2) == 0)
328*53ee8cc1Swenshuai.xi                 {
329*53ee8cc1Swenshuai.xi                     u32MemShift_OPM = (pstXC_DS_CmdCnt->u16CMDCNT_OPM / 2) * BYTE_PER_WORD;
330*53ee8cc1Swenshuai.xi                 }
331*53ee8cc1Swenshuai.xi                 else
332*53ee8cc1Swenshuai.xi                 {
333*53ee8cc1Swenshuai.xi                     u32MemShift_OPM = (pstXC_DS_CmdCnt->u16CMDCNT_OPM / 2) * BYTE_PER_WORD  + DS_CMD_LEN_64BITS;
334*53ee8cc1Swenshuai.xi                 }
335*53ee8cc1Swenshuai.xi                 //XC_PRINTF("[%s,%5d] [DS_IP]pstXC_DS_CmdCnt->u16CMDCNT_IPM:%d u32MemShift_IPM:%lx \n",__func__,__LINE__,pstXC_DS_CmdCnt->u16CMDCNT_IPM,(MS_U32)u32MemShift_IPM);
336*53ee8cc1Swenshuai.xi                 //u32Addr = u32Addr + DS_CMD_LEN_64BITS * pstXC_DS_CmdCnt->u16CMDCNT_IPM;
337*53ee8cc1Swenshuai.xi                 u32Addr = u32Addr + u32MemShift_OPM + OP_BASE_OFFSET;
338*53ee8cc1Swenshuai.xi                 pu64Data = (MS_U64*)MsOS_PA2KSEG1(u32Addr);//IPM
339*53ee8cc1Swenshuai.xi 
340*53ee8cc1Swenshuai.xi                 if(pstXC_DS_CmdCnt->u16CMDCNT_OPM < u8MaxCmdCnt)
341*53ee8cc1Swenshuai.xi                 {
342*53ee8cc1Swenshuai.xi                     *pu64Data = u64CmdTemp;
343*53ee8cc1Swenshuai.xi                     pstXC_DS_CmdCnt->u16CMDCNT_OPM++;
344*53ee8cc1Swenshuai.xi                 }
345*53ee8cc1Swenshuai.xi                 else
346*53ee8cc1Swenshuai.xi                 {
347*53ee8cc1Swenshuai.xi                     printf("[%s,%5d] [DS] OPM Command count overflow !!  u16CMDCNT_OPM:%d  Max command count: %d\n",__func__,__LINE__,pstXC_DS_CmdCnt->u16CMDCNT_OPM,DMS_DS_DEPTH * 2);
348*53ee8cc1Swenshuai.xi                 }
349*53ee8cc1Swenshuai.xi             }
350*53ee8cc1Swenshuai.xi         }
351*53ee8cc1Swenshuai.xi     }
352*53ee8cc1Swenshuai.xi     else if(Source_Select == DMS_DS_MVOP)// only in IP cmd
353*53ee8cc1Swenshuai.xi     {
354*53ee8cc1Swenshuai.xi         u16DataTemp = u16CmdRegValue;
355*53ee8cc1Swenshuai.xi         u8AddrTemp = (u32CmdRegAddr&0x000000FF);
356*53ee8cc1Swenshuai.xi         u16BankTemp = (u32CmdRegAddr&0x00FFFF00) >> 8; //EX: mvop mainwinodw: 0x1014 mvop bank
357*53ee8cc1Swenshuai.xi         u16MaskTemp = 0xFFFF;
358*53ee8cc1Swenshuai.xi 
359*53ee8cc1Swenshuai.xi         u64CmdTemp|= (MS_U64)u16DataTemp;
360*53ee8cc1Swenshuai.xi         u64CmdTemp|= ((MS_U64)u8AddrTemp<<16);
361*53ee8cc1Swenshuai.xi         u64CmdTemp|= ((MS_U64)u16BankTemp<<23);
362*53ee8cc1Swenshuai.xi         u64CmdTemp|= ((MS_U64)u16MaskTemp<<48);
363*53ee8cc1Swenshuai.xi 
364*53ee8cc1Swenshuai.xi         if(eWindow == MAIN_WINDOW)
365*53ee8cc1Swenshuai.xi         {
366*53ee8cc1Swenshuai.xi             MS_U32 u32MemShift_IPM;
367*53ee8cc1Swenshuai.xi 
368*53ee8cc1Swenshuai.xi             if((pstXC_DS_CmdCnt->u16CMDCNT_IPM % 2) == 0)
369*53ee8cc1Swenshuai.xi             {
370*53ee8cc1Swenshuai.xi                 u32MemShift_IPM = (pstXC_DS_CmdCnt->u16CMDCNT_IPM / 2) * BYTE_PER_WORD;
371*53ee8cc1Swenshuai.xi             }
372*53ee8cc1Swenshuai.xi             else
373*53ee8cc1Swenshuai.xi             {
374*53ee8cc1Swenshuai.xi                 u32MemShift_IPM = (pstXC_DS_CmdCnt->u16CMDCNT_IPM / 2) * BYTE_PER_WORD  + DS_CMD_LEN_64BITS;
375*53ee8cc1Swenshuai.xi             }
376*53ee8cc1Swenshuai.xi             //XC_PRINTF("[%s,%5d] [DS_IP(MVOP)]pstXC_DS_CmdCnt->u16CMDCNT_IPM:%d u32MemShift_IPM:%lx \n",__func__,__LINE__,pstXC_DS_CmdCnt->u16CMDCNT_IPM,(MS_U32)u32MemShift_IPM);
377*53ee8cc1Swenshuai.xi             //u32Addr = u32Addr + DS_CMD_LEN_64BITS * pstXC_DS_CmdCnt->u16CMDCNT_IPM;
378*53ee8cc1Swenshuai.xi             u32Addr = u32Addr + u32MemShift_IPM;
379*53ee8cc1Swenshuai.xi             pu64Data = (MS_U64*)MsOS_PA2KSEG1(u32Addr);//IPM
380*53ee8cc1Swenshuai.xi 
381*53ee8cc1Swenshuai.xi             if(pstXC_DS_CmdCnt->u16CMDCNT_IPM < u8MaxCmdCnt)
382*53ee8cc1Swenshuai.xi             {
383*53ee8cc1Swenshuai.xi                 *pu64Data = u64CmdTemp;
384*53ee8cc1Swenshuai.xi                 pstXC_DS_CmdCnt->u16CMDCNT_IPM++;
385*53ee8cc1Swenshuai.xi             }
386*53ee8cc1Swenshuai.xi             else
387*53ee8cc1Swenshuai.xi             {
388*53ee8cc1Swenshuai.xi                 printf("[%s,%5d] [DS] Command count overflow !!  u16CMDCNT_IPM:%d  Max command count: %d\n",__func__,__LINE__,pstXC_DS_CmdCnt->u16CMDCNT_IPM,DMS_DS_DEPTH * 2);
389*53ee8cc1Swenshuai.xi             }
390*53ee8cc1Swenshuai.xi         }
391*53ee8cc1Swenshuai.xi     }
392*53ee8cc1Swenshuai.xi     else
393*53ee8cc1Swenshuai.xi     {
394*53ee8cc1Swenshuai.xi         printf("[%s,%5d] [DS] Only can support XC/MVOP/GOP NOW !! \n",__func__,__LINE__);
395*53ee8cc1Swenshuai.xi     }
396*53ee8cc1Swenshuai.xi 
397*53ee8cc1Swenshuai.xi }
398*53ee8cc1Swenshuai.xi 
Hal_DMS_Add_NullCommand(void * pInstance,SCALER_WIN eWindow,DMS_ds_reg_ip_op_sel IPOP_Sel,DMS_DS_CMDCNT * pstXC_DS_CmdCnt)399*53ee8cc1Swenshuai.xi void Hal_DMS_Add_NullCommand(void* pInstance, SCALER_WIN eWindow, DMS_ds_reg_ip_op_sel IPOP_Sel, DMS_DS_CMDCNT *pstXC_DS_CmdCnt)
400*53ee8cc1Swenshuai.xi {
401*53ee8cc1Swenshuai.xi     DMS_RESOURCE_PRIVATE* pDMSResPri = NULL;
402*53ee8cc1Swenshuai.xi     UtopiaResourceGetPrivate(g_pDMSRes,(void**)(&pDMSResPri));
403*53ee8cc1Swenshuai.xi 
404*53ee8cc1Swenshuai.xi     MS_U16 u16MaxCmdCnt = DMS_DS_DEPTH * 2; // It has two 64bit commands per MIU bus width
405*53ee8cc1Swenshuai.xi     MS_U64 *pu64Data = NULL;
406*53ee8cc1Swenshuai.xi     MS_U16 i;
407*53ee8cc1Swenshuai.xi #if ALL_IP_COMMAND
408*53ee8cc1Swenshuai.xi     u16MaxCmdCnt *= 2;
409*53ee8cc1Swenshuai.xi #endif
410*53ee8cc1Swenshuai.xi 
411*53ee8cc1Swenshuai.xi     if(eWindow == MAIN_WINDOW)
412*53ee8cc1Swenshuai.xi     {
413*53ee8cc1Swenshuai.xi         if(IPOP_Sel == DS_IP)
414*53ee8cc1Swenshuai.xi         {
415*53ee8cc1Swenshuai.xi             for(i=pstXC_DS_CmdCnt->u16CMDCNT_IPM;i<u16MaxCmdCnt;i++)
416*53ee8cc1Swenshuai.xi             {
417*53ee8cc1Swenshuai.xi                 MS_PHY u32IndexBase= (pDMSResPri->stHalDMS.phyDSAddr +
418*53ee8cc1Swenshuai.xi                     (MS_U32)pDMSResPri->stHalDMS.u8DSIndex * u16MaxCmdCnt * BYTE_PER_WORD +
419*53ee8cc1Swenshuai.xi                     (i / 2) * BYTE_PER_WORD + (i % 2) * DS_CMD_LEN_64BITS);
420*53ee8cc1Swenshuai.xi                 pu64Data  = (MS_U64*)MsOS_PA2KSEG1(u32IndexBase);
421*53ee8cc1Swenshuai.xi                 *pu64Data = 0x00000009FFFF0000;
422*53ee8cc1Swenshuai.xi             }
423*53ee8cc1Swenshuai.xi         }
424*53ee8cc1Swenshuai.xi #if (ALL_IP_COMMAND == 0)
425*53ee8cc1Swenshuai.xi         else
426*53ee8cc1Swenshuai.xi         {
427*53ee8cc1Swenshuai.xi             for(i=pstXC_DS_CmdCnt->u16CMDCNT_OPM;i<u16MaxCmdCnt;i++)
428*53ee8cc1Swenshuai.xi             {
429*53ee8cc1Swenshuai.xi                 MS_PHY u32IndexBase= (pDMSResPri->stHalDMS.phyDSAddr + OP_BASE_OFFSET +
430*53ee8cc1Swenshuai.xi                     (MS_U32)pDMSResPri->stHalDMS.u8DSIndex * u16MaxCmdCnt * BYTE_PER_WORD +
431*53ee8cc1Swenshuai.xi                     (i / 2) * BYTE_PER_WORD + (i % 2) * DS_CMD_LEN_64BITS);
432*53ee8cc1Swenshuai.xi                 pu64Data  = (MS_U64*)MsOS_PA2KSEG1(u32IndexBase);
433*53ee8cc1Swenshuai.xi                 *pu64Data = 0x00000009FFFF0000;
434*53ee8cc1Swenshuai.xi             }
435*53ee8cc1Swenshuai.xi         }
436*53ee8cc1Swenshuai.xi #endif
437*53ee8cc1Swenshuai.xi     }
438*53ee8cc1Swenshuai.xi }
439*53ee8cc1Swenshuai.xi 
HAL_DMS_XC_DSSetWin(void * pInstance,MS_WINDOW_TYPE * stMVOPCropWindow,const XC_SETWIN_INFO * stXCSetWinInfo,MS_U32 u32FlowFlag)440*53ee8cc1Swenshuai.xi MS_BOOL HAL_DMS_XC_DSSetWin(void* pInstance, MS_WINDOW_TYPE* stMVOPCropWindow, const XC_SETWIN_INFO* stXCSetWinInfo, MS_U32 u32FlowFlag)
441*53ee8cc1Swenshuai.xi {
442*53ee8cc1Swenshuai.xi     DMS_RESOURCE_PRIVATE* pDMSResPri = NULL;
443*53ee8cc1Swenshuai.xi     UtopiaResourceGetPrivate(g_pDMSRes,(void**)(&pDMSResPri));
444*53ee8cc1Swenshuai.xi 
445*53ee8cc1Swenshuai.xi     MS_U32 u32HRatio = 0;
446*53ee8cc1Swenshuai.xi     MS_U32 u32VRatio = 0;
447*53ee8cc1Swenshuai.xi     //printf("[%s] Post: %d -> %d, %d -> %d, flow %d\n",__FUNCTION__,stXCSetWinInfo->u16HCusScalingSrc,stXCSetWinInfo->u16HCusScalingDst,
448*53ee8cc1Swenshuai.xi     //    stXCSetWinInfo->u16VCusScalingSrc,stXCSetWinInfo->u16VCusScalingDst,u32FlowFlag);
449*53ee8cc1Swenshuai.xi 
450*53ee8cc1Swenshuai.xi     if(stXCSetWinInfo->u16HCusScalingSrc != stXCSetWinInfo->u16HCusScalingDst)
451*53ee8cc1Swenshuai.xi     {
452*53ee8cc1Swenshuai.xi         u32HRatio = H_PostScalingRatio(stXCSetWinInfo->u16HCusScalingSrc, stXCSetWinInfo->u16HCusScalingDst);
453*53ee8cc1Swenshuai.xi         u32HRatio &= 0x0FFFFFF;
454*53ee8cc1Swenshuai.xi         u32HRatio |= 0x1000000;
455*53ee8cc1Swenshuai.xi     }
456*53ee8cc1Swenshuai.xi 
457*53ee8cc1Swenshuai.xi     if(stXCSetWinInfo->u16VCusScalingSrc != stXCSetWinInfo->u16VCusScalingDst)
458*53ee8cc1Swenshuai.xi     {
459*53ee8cc1Swenshuai.xi         u32VRatio = V_PostScalingRatio(stXCSetWinInfo->u16VCusScalingSrc, stXCSetWinInfo->u16VCusScalingDst);
460*53ee8cc1Swenshuai.xi         u32VRatio &= 0x00FFFFFF;
461*53ee8cc1Swenshuai.xi         u32VRatio |= 0x81000000;
462*53ee8cc1Swenshuai.xi     }
463*53ee8cc1Swenshuai.xi 
464*53ee8cc1Swenshuai.xi     pDMSResPri->stHalDMS.stDMS_DSSWDB.u32FlowFlag = u32FlowFlag;
465*53ee8cc1Swenshuai.xi     pDMSResPri->stHalDMS.stDMS_DSSWDB.u32HPostRatio = u32HRatio;
466*53ee8cc1Swenshuai.xi     pDMSResPri->stHalDMS.stDMS_DSSWDB.u32VPostRatio = u32VRatio;
467*53ee8cc1Swenshuai.xi 
468*53ee8cc1Swenshuai.xi     if(1)//u32FlowFlag == 1)
469*53ee8cc1Swenshuai.xi     {
470*53ee8cc1Swenshuai.xi         //from DIP need display window
471*53ee8cc1Swenshuai.xi         pDMSResPri->stHalDMS.stDMS_DSSWDB.u16H_Start = g_IPanel.HStart() + stXCSetWinInfo->stDispWin.x;
472*53ee8cc1Swenshuai.xi         pDMSResPri->stHalDMS.stDMS_DSSWDB.u16H_End   = pDMSResPri->stHalDMS.stDMS_DSSWDB.u16H_Start + stXCSetWinInfo->stDispWin.width - 1;
473*53ee8cc1Swenshuai.xi         pDMSResPri->stHalDMS.stDMS_DSSWDB.u16V_Start = stXCSetWinInfo->stDispWin.y;
474*53ee8cc1Swenshuai.xi         pDMSResPri->stHalDMS.stDMS_DSSWDB.u16V_End   = pDMSResPri->stHalDMS.stDMS_DSSWDB.u16V_Start + stXCSetWinInfo->stDispWin.height - 1;
475*53ee8cc1Swenshuai.xi     }
476*53ee8cc1Swenshuai.xi 
477*53ee8cc1Swenshuai.xi     pDMSResPri->stHalDMS.stDMS_DSSWDB.stMVOPCropWindow.x = stMVOPCropWindow->x;
478*53ee8cc1Swenshuai.xi     pDMSResPri->stHalDMS.stDMS_DSSWDB.stMVOPCropWindow.y = stMVOPCropWindow->y;
479*53ee8cc1Swenshuai.xi     pDMSResPri->stHalDMS.stDMS_DSSWDB.stMVOPCropWindow.width = stMVOPCropWindow->width;
480*53ee8cc1Swenshuai.xi     pDMSResPri->stHalDMS.stDMS_DSSWDB.stMVOPCropWindow.height = stMVOPCropWindow->height;
481*53ee8cc1Swenshuai.xi     //printf("[%s] MVOP: %d %d, %d %d\n",__FUNCTION__,gDMS_DSSWDB.stMVOPCropWindow.x,gDMS_DSSWDB.stMVOPCropWindow.y,gDMS_DSSWDB.stMVOPCropWindow.width,gDMS_DSSWDB.stMVOPCropWindow.height);
482*53ee8cc1Swenshuai.xi     //printf("[%s] Disp: %d %d, %d %d\n",__FUNCTION__,gDMS_DSSWDB.u16H_Start,gDMS_DSSWDB.u16H_End,gDMS_DSSWDB.u16V_Start,gDMS_DSSWDB.u16V_End);
483*53ee8cc1Swenshuai.xi     //printf("[%s] H:0x%x , V:0x%x\n",__FUNCTION__,gDMS_DSSWDB.u32HPostRatio,gDMS_DSSWDB.u32VPostRatio);
484*53ee8cc1Swenshuai.xi 
485*53ee8cc1Swenshuai.xi     return TRUE;
486*53ee8cc1Swenshuai.xi }
487*53ee8cc1Swenshuai.xi 
HAL_DMS_XC_DSSetMVOPPitch(void * pInstance,MS_U16 u16Pitch)488*53ee8cc1Swenshuai.xi MS_BOOL HAL_DMS_XC_DSSetMVOPPitch(void* pInstance, MS_U16 u16Pitch)
489*53ee8cc1Swenshuai.xi {
490*53ee8cc1Swenshuai.xi     DMS_RESOURCE_PRIVATE* pDMSResPri = NULL;
491*53ee8cc1Swenshuai.xi     UtopiaResourceGetPrivate(g_pDMSRes,(void**)(&pDMSResPri));
492*53ee8cc1Swenshuai.xi 
493*53ee8cc1Swenshuai.xi     pDMSResPri->stHalDMS.stDMS_DSSWDB.u16MVOP_Pitch = u16Pitch;
494*53ee8cc1Swenshuai.xi     printf("[%s] Pitch: %d\n",__FUNCTION__,pDMSResPri->stHalDMS.stDMS_DSSWDB.u16MVOP_Pitch);
495*53ee8cc1Swenshuai.xi     return TRUE;
496*53ee8cc1Swenshuai.xi }
497*53ee8cc1Swenshuai.xi 
HAL_DMS_XC_DSSetMVOPAddr(void * pInstance,MS_PHY phyLumaAddr,MS_PHY phyChromaAddr,MS_BOOL b422Pack)498*53ee8cc1Swenshuai.xi MS_BOOL HAL_DMS_XC_DSSetMVOPAddr(void* pInstance, MS_PHY phyLumaAddr, MS_PHY phyChromaAddr, MS_BOOL b422Pack)
499*53ee8cc1Swenshuai.xi {
500*53ee8cc1Swenshuai.xi     DMS_RESOURCE_PRIVATE* pDMSResPri = NULL;
501*53ee8cc1Swenshuai.xi     UtopiaResourceGetPrivate(g_pDMSRes,(void**)(&pDMSResPri));
502*53ee8cc1Swenshuai.xi 
503*53ee8cc1Swenshuai.xi     pDMSResPri->stHalDMS.stDMS_DSSWDB.bMVOP_422Pack = b422Pack;
504*53ee8cc1Swenshuai.xi     pDMSResPri->stHalDMS.stDMS_DSSWDB.phyMVOP_LumaAddr = phyLumaAddr;
505*53ee8cc1Swenshuai.xi     pDMSResPri->stHalDMS.stDMS_DSSWDB.phyMVOP_ChromaAddr = phyChromaAddr;
506*53ee8cc1Swenshuai.xi     return TRUE;
507*53ee8cc1Swenshuai.xi }
508*53ee8cc1Swenshuai.xi 
509*53ee8cc1Swenshuai.xi #define MI_FLOW_PATCH 1
510*53ee8cc1Swenshuai.xi extern MS_U16 gDMSMVOPForceLookVDEC;
HAL_DMS_XC_DSFire(void * pInstance)511*53ee8cc1Swenshuai.xi MS_BOOL HAL_DMS_XC_DSFire(void* pInstance)
512*53ee8cc1Swenshuai.xi {
513*53ee8cc1Swenshuai.xi     DMS_RESOURCE_PRIVATE* pDMSResPri = NULL;
514*53ee8cc1Swenshuai.xi     UtopiaResourceGetPrivate(g_pDMSRes,(void**)(&pDMSResPri));
515*53ee8cc1Swenshuai.xi 
516*53ee8cc1Swenshuai.xi #if (ALL_IP_COMMAND == 0)
517*53ee8cc1Swenshuai.xi     if(MApi_XC_R2BYTEMSK(0x0006,0x1000))
518*53ee8cc1Swenshuai.xi     {
519*53ee8cc1Swenshuai.xi         MApi_XC_W2BYTEMSK(0x0006,0,0x1000);
520*53ee8cc1Swenshuai.xi     }
521*53ee8cc1Swenshuai.xi #endif
522*53ee8cc1Swenshuai.xi 
523*53ee8cc1Swenshuai.xi #if MI_FLOW_PATCH
524*53ee8cc1Swenshuai.xi //This Patch for FBL W/R diff need to be 0
525*53ee8cc1Swenshuai.xi     if(MApi_XC_R2BYTEMSK(0x120E,0xF000))
526*53ee8cc1Swenshuai.xi     {
527*53ee8cc1Swenshuai.xi         MApi_XC_W2BYTEMSK(0x120E,0,0xF000);
528*53ee8cc1Swenshuai.xi     }
529*53ee8cc1Swenshuai.xi //This Patch for FBL W/R must disable
530*53ee8cc1Swenshuai.xi     if(MApi_XC_R2BYTEMSK(0x120E,0x0003) != 3)
531*53ee8cc1Swenshuai.xi     {
532*53ee8cc1Swenshuai.xi         MApi_XC_W2BYTEMSK(0x120E,0x0003,0x0003);
533*53ee8cc1Swenshuai.xi     }
534*53ee8cc1Swenshuai.xi //This Patch for FBL DataFormat can not set
535*53ee8cc1Swenshuai.xi     if(MApi_XC_R2BYTEMSK(0x1202,0x2F00))
536*53ee8cc1Swenshuai.xi     {
537*53ee8cc1Swenshuai.xi         MApi_XC_W2BYTEMSK(0x1202,0,0x2F00);
538*53ee8cc1Swenshuai.xi     }
539*53ee8cc1Swenshuai.xi //This Patch for FBL do not need miu write size protect
540*53ee8cc1Swenshuai.xi     if(MApi_XC_R2BYTEMSK(0x1230,0x8000))
541*53ee8cc1Swenshuai.xi     {
542*53ee8cc1Swenshuai.xi         MApi_XC_W2BYTEMSK(0x1230,0,0x8000);
543*53ee8cc1Swenshuai.xi     }
544*53ee8cc1Swenshuai.xi 
545*53ee8cc1Swenshuai.xi #endif
546*53ee8cc1Swenshuai.xi 
547*53ee8cc1Swenshuai.xi     DMS_DS_CMDCNT STXC_DS_CMDCNT;
548*53ee8cc1Swenshuai.xi     STXC_DS_CMDCNT.u16CMDCNT_IPM =0;
549*53ee8cc1Swenshuai.xi     STXC_DS_CMDCNT.u16CMDCNT_IPS =0;
550*53ee8cc1Swenshuai.xi     STXC_DS_CMDCNT.u16CMDCNT_OPM =0;
551*53ee8cc1Swenshuai.xi     STXC_DS_CMDCNT.u16CMDCNT_OPS =0;
552*53ee8cc1Swenshuai.xi     //printf("[%s] MVOP: %d %d, %d %d\n",__FUNCTION__,gDMS_DSSWDB.stMVOPCropWindow.x,gDMS_DSSWDB.stMVOPCropWindow.y,gDMS_DSSWDB.stMVOPCropWindow.width,gDMS_DSSWDB.stMVOPCropWindow.height);
553*53ee8cc1Swenshuai.xi     //printf("[%s] Disp: %d %d, %d %d\n",__FUNCTION__,gDMS_DSSWDB.u16H_Start,gDMS_DSSWDB.u16H_End,gDMS_DSSWDB.u16V_Start,gDMS_DSSWDB.u16V_End);
554*53ee8cc1Swenshuai.xi     //printf("[%s] Pitch: %d\n",__FUNCTION__,gDMS_DSSWDB.u16MVOP_Pitch);
555*53ee8cc1Swenshuai.xi     //printf("[%s] H:0x%x , V:0x%x\n",__FUNCTION__,gDMS_DSSWDB.u32HPostRatio,gDMS_DSSWDB.u32VPostRatio);
556*53ee8cc1Swenshuai.xi 
557*53ee8cc1Swenshuai.xi #if ALL_IP_COMMAND
558*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x1010, pDMSResPri->stHalDMS.stDMS_DSSWDB.u16H_Start, DS_IP, DMS_DS_XC, &STXC_DS_CMDCNT);
559*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x1012, pDMSResPri->stHalDMS.stDMS_DSSWDB.u16H_End, DS_IP, DMS_DS_XC, &STXC_DS_CMDCNT);
560*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x1014, pDMSResPri->stHalDMS.stDMS_DSSWDB.u16V_Start, DS_IP, DMS_DS_XC, &STXC_DS_CMDCNT);
561*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x1016, pDMSResPri->stHalDMS.stDMS_DSSWDB.u16V_End, DS_IP, DMS_DS_XC, &STXC_DS_CMDCNT);
562*53ee8cc1Swenshuai.xi 
563*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x230E, pDMSResPri->stHalDMS.stDMS_DSSWDB.u32HPostRatio & 0xFFFF          , DS_IP, DMS_DS_XC, &STXC_DS_CMDCNT);
564*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x2310, (pDMSResPri->stHalDMS.stDMS_DSSWDB.u32HPostRatio >> 16) & 0xFFFF  , DS_IP, DMS_DS_XC, &STXC_DS_CMDCNT);
565*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x2312, pDMSResPri->stHalDMS.stDMS_DSSWDB.u32VPostRatio & 0xFFFF          , DS_IP, DMS_DS_XC, &STXC_DS_CMDCNT);
566*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x2314, (pDMSResPri->stHalDMS.stDMS_DSSWDB.u32VPostRatio >> 16) & 0xFFFF  , DS_IP, DMS_DS_XC, &STXC_DS_CMDCNT);
567*53ee8cc1Swenshuai.xi 
568*53ee8cc1Swenshuai.xi     //Disable pre scaling for pre scaling be set out of DMS
569*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x0210, 0 , DS_IP, DMS_DS_XC, &STXC_DS_CMDCNT);
570*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x0212, 0 , DS_IP, DMS_DS_XC, &STXC_DS_CMDCNT);
571*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x0208, 0 , DS_IP, DMS_DS_XC, &STXC_DS_CMDCNT);
572*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x020A, 0 , DS_IP, DMS_DS_XC, &STXC_DS_CMDCNT);
573*53ee8cc1Swenshuai.xi 
574*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x202A, pDMSResPri->stHalDMS.stDMS_DSSWDB.stMVOPCropWindow.height & 0x0FFF  , DS_IP, DMS_DS_XC, &STXC_DS_CMDCNT);
575*53ee8cc1Swenshuai.xi 
576*53ee8cc1Swenshuai.xi #else
577*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x1010, pDMSResPri->stHalDMS.stDMS_DSSWDB.u16H_Start, DS_OP, DMS_DS_XC, &STXC_DS_CMDCNT);
578*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x1012, pDMSResPri->stHalDMS.stDMS_DSSWDB.u16H_End, DS_OP, DMS_DS_XC, &STXC_DS_CMDCNT);
579*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x1014, pDMSResPri->stHalDMS.stDMS_DSSWDB.u16V_Start, DS_OP, DMS_DS_XC, &STXC_DS_CMDCNT);
580*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x1016, pDMSResPri->stHalDMS.stDMS_DSSWDB.u16V_End, DS_OP, DMS_DS_XC, &STXC_DS_CMDCNT);
581*53ee8cc1Swenshuai.xi 
582*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x230E, pDMSResPri->stHalDMS.stDMS_DSSWDB.u32HPostRatio & 0xFFFF          , DS_OP, DMS_DS_XC, &STXC_DS_CMDCNT);
583*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x2310, (pDMSResPri->stHalDMS.stDMS_DSSWDB.u32HPostRatio >> 16) & 0xFFFF  , DS_OP, DMS_DS_XC, &STXC_DS_CMDCNT);
584*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x2312, pDMSResPri->stHalDMS.stDMS_DSSWDB.u32VPostRatio & 0xFFFF          , DS_OP, DMS_DS_XC, &STXC_DS_CMDCNT);
585*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x2314, (pDMSResPri->stHalDMS.stDMS_DSSWDB.u32VPostRatio >> 16) & 0xFFFF  , DS_OP, DMS_DS_XC, &STXC_DS_CMDCNT);
586*53ee8cc1Swenshuai.xi 
587*53ee8cc1Swenshuai.xi     //Disable pre scaling for pre scaling be set out of DMS
588*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x0210, 0 , DS_OP, DMS_DS_XC, &STXC_DS_CMDCNT);
589*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x0212, 0 , DS_OP, DMS_DS_XC, &STXC_DS_CMDCNT);
590*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x0208, 0 , DS_OP, DMS_DS_XC, &STXC_DS_CMDCNT);
591*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x020A, 0 , DS_OP, DMS_DS_XC, &STXC_DS_CMDCNT);
592*53ee8cc1Swenshuai.xi 
593*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x202A, pDMSResPri->stHalDMS.stDMS_DSSWDB.stMVOPCropWindow.height & 0x0FFF  , DS_OP, DMS_DS_XC, &STXC_DS_CMDCNT);
594*53ee8cc1Swenshuai.xi #if MI_FLOW_PATCH
595*53ee8cc1Swenshuai.xi //This Patch for keep ipm/opm fetch to max size
596*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x121E, 0x1000 , DS_OP, DMS_DS_XC, &STXC_DS_CMDCNT);
597*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x122E, 0x1000 , DS_OP, DMS_DS_XC, &STXC_DS_CMDCNT);
598*53ee8cc1Swenshuai.xi #endif
599*53ee8cc1Swenshuai.xi 
600*53ee8cc1Swenshuai.xi #endif
601*53ee8cc1Swenshuai.xi 
602*53ee8cc1Swenshuai.xi     MS_U16 u16MVOPForceWrite = MApi_XC_ReadByte(0x10144E);
603*53ee8cc1Swenshuai.xi     u16MVOPForceWrite |= 0x10;
604*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x101427, u16MVOPForceWrite    , DS_IP, DMS_DS_MVOP, &STXC_DS_CMDCNT);
605*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x101440, pDMSResPri->stHalDMS.stDMS_DSSWDB.stMVOPCropWindow.x  , DS_IP, DMS_DS_MVOP, &STXC_DS_CMDCNT);
606*53ee8cc1Swenshuai.xi     if(pDMSResPri->stHalDMS.stDMS_DSSWDB.stMVOPCropWindow.y == 0)
607*53ee8cc1Swenshuai.xi     {
608*53ee8cc1Swenshuai.xi         Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x101441, (pDMSResPri->stHalDMS.stDMS_DSSWDB.stMVOPCropWindow.y | 0xE000), DS_IP, DMS_DS_MVOP, &STXC_DS_CMDCNT);
609*53ee8cc1Swenshuai.xi     }
610*53ee8cc1Swenshuai.xi     else
611*53ee8cc1Swenshuai.xi     {
612*53ee8cc1Swenshuai.xi         Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x101441, (pDMSResPri->stHalDMS.stDMS_DSSWDB.stMVOPCropWindow.y | 0xA000), DS_IP, DMS_DS_MVOP, &STXC_DS_CMDCNT);
613*53ee8cc1Swenshuai.xi     }
614*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x101442, pDMSResPri->stHalDMS.stDMS_DSSWDB.stMVOPCropWindow.width    , DS_IP, DMS_DS_MVOP, &STXC_DS_CMDCNT);
615*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x101443, pDMSResPri->stHalDMS.stDMS_DSSWDB.stMVOPCropWindow.height   , DS_IP, DMS_DS_MVOP, &STXC_DS_CMDCNT);
616*53ee8cc1Swenshuai.xi 
617*53ee8cc1Swenshuai.xi     if(1)//gDMS_DSSWDB.u32FlowFlag == 1)
618*53ee8cc1Swenshuai.xi     {
619*53ee8cc1Swenshuai.xi         MS_PHY phyAddr = pDMSResPri->stHalDMS.stDMS_DSSWDB.phyMVOP_LumaAddr >> 3;
620*53ee8cc1Swenshuai.xi         Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x101421, phyAddr & 0xFFFF           , DS_IP, DMS_DS_MVOP, &STXC_DS_CMDCNT);
621*53ee8cc1Swenshuai.xi         Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x101422, (phyAddr >> 16) & 0x1FFF  , DS_IP, DMS_DS_MVOP, &STXC_DS_CMDCNT);
622*53ee8cc1Swenshuai.xi         if(pDMSResPri->stHalDMS.stDMS_DSSWDB.bMVOP_422Pack)
623*53ee8cc1Swenshuai.xi         {
624*53ee8cc1Swenshuai.xi             phyAddr = pDMSResPri->stHalDMS.stDMS_DSSWDB.phyMVOP_LumaAddr + 16;
625*53ee8cc1Swenshuai.xi         }
626*53ee8cc1Swenshuai.xi         else
627*53ee8cc1Swenshuai.xi         {
628*53ee8cc1Swenshuai.xi             phyAddr = pDMSResPri->stHalDMS.stDMS_DSSWDB.phyMVOP_ChromaAddr;
629*53ee8cc1Swenshuai.xi         }
630*53ee8cc1Swenshuai.xi         phyAddr = phyAddr >> 3;
631*53ee8cc1Swenshuai.xi         Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x101423, phyAddr & 0xFFFF           , DS_IP, DMS_DS_MVOP, &STXC_DS_CMDCNT);
632*53ee8cc1Swenshuai.xi         Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x101424, (phyAddr >> 16) & 0x1FFF  , DS_IP, DMS_DS_MVOP, &STXC_DS_CMDCNT);
633*53ee8cc1Swenshuai.xi     }
634*53ee8cc1Swenshuai.xi 
635*53ee8cc1Swenshuai.xi //Pitch & Tile
636*53ee8cc1Swenshuai.xi     MS_U8 u8MVOPCtrl0_H = MApi_XC_ReadByte(0x101441);
637*53ee8cc1Swenshuai.xi     MS_U8 u8MVOPCtrl0_L = MApi_XC_ReadByte(0x101440);
638*53ee8cc1Swenshuai.xi     MS_U8 u8MVOPPitch_L = MApi_XC_ReadByte(0x101430);
639*53ee8cc1Swenshuai.xi     u8MVOPPitch_L = (u8MVOPPitch_L & (0xFF - 0x03)) | ((pDMSResPri->stHalDMS.stDMS_DSSWDB.u16MVOP_Pitch >> 8) & 0x03);
640*53ee8cc1Swenshuai.xi     u8MVOPCtrl0_H = (pDMSResPri->stHalDMS.stDMS_DSSWDB.u16MVOP_Pitch & 0xFF);
641*53ee8cc1Swenshuai.xi     if(pDMSResPri->stHalDMS.stDMS_DSSWDB.u32FlowFlag == 1)
642*53ee8cc1Swenshuai.xi     {
643*53ee8cc1Swenshuai.xi         //DIP
644*53ee8cc1Swenshuai.xi         u8MVOPCtrl0_L = (u8MVOPCtrl0_L | 0xB0);
645*53ee8cc1Swenshuai.xi     }
646*53ee8cc1Swenshuai.xi     else if(pDMSResPri->stHalDMS.stDMS_DSSWDB.u32FlowFlag == 2)
647*53ee8cc1Swenshuai.xi     {
648*53ee8cc1Swenshuai.xi         //VDEC
649*53ee8cc1Swenshuai.xi         u8MVOPCtrl0_L = (u8MVOPCtrl0_L & (0xFF - 0xB0));
650*53ee8cc1Swenshuai.xi     }
651*53ee8cc1Swenshuai.xi 
652*53ee8cc1Swenshuai.xi     MS_U16 u16MVOPCtrl0 = u8MVOPCtrl0_H;
653*53ee8cc1Swenshuai.xi     u16MVOPCtrl0 = ((u16MVOPCtrl0 << 8) | u8MVOPCtrl0_L);
654*53ee8cc1Swenshuai.xi     if((gDMSMVOPForceLookVDEC == 1))
655*53ee8cc1Swenshuai.xi     {
656*53ee8cc1Swenshuai.xi         Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x101418, 0 , DS_IP, DMS_DS_MVOP, &STXC_DS_CMDCNT);
657*53ee8cc1Swenshuai.xi         Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x101420, 0xF006 , DS_IP, DMS_DS_MVOP, &STXC_DS_CMDCNT);
658*53ee8cc1Swenshuai.xi     }
659*53ee8cc1Swenshuai.xi     else
660*53ee8cc1Swenshuai.xi     {
661*53ee8cc1Swenshuai.xi         Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x101418, u8MVOPPitch_L , DS_IP, DMS_DS_MVOP, &STXC_DS_CMDCNT);
662*53ee8cc1Swenshuai.xi         Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x101420, u16MVOPCtrl0 , DS_IP, DMS_DS_MVOP, &STXC_DS_CMDCNT);
663*53ee8cc1Swenshuai.xi     }
664*53ee8cc1Swenshuai.xi 
665*53ee8cc1Swenshuai.xi     u16MVOPForceWrite &= ~0x10;
666*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x101427, u16MVOPForceWrite    , DS_IP, DMS_DS_MVOP, &STXC_DS_CMDCNT);
667*53ee8cc1Swenshuai.xi 
668*53ee8cc1Swenshuai.xi     MS_U32 ActiveSWClearEn = 0;
669*53ee8cc1Swenshuai.xi     ActiveSWClearEn = MApi_XC_R2BYTE(0x1F2E);
670*53ee8cc1Swenshuai.xi     ActiveSWClearEn |= 0x0010;//u32SW_Reset_IPM;
671*53ee8cc1Swenshuai.xi     Hal_DMS_WriteSWDSCommand(pInstance, MAIN_WINDOW, 0x1F2E, ActiveSWClearEn  , DS_IP, DMS_DS_XC, &STXC_DS_CMDCNT);
672*53ee8cc1Swenshuai.xi 
673*53ee8cc1Swenshuai.xi     Hal_DMS_Add_NullCommand(pInstance, MAIN_WINDOW, DS_IP,&STXC_DS_CMDCNT);
674*53ee8cc1Swenshuai.xi     Hal_DMS_Add_NullCommand(pInstance, MAIN_WINDOW, DS_OP,&STXC_DS_CMDCNT);
675*53ee8cc1Swenshuai.xi 
676*53ee8cc1Swenshuai.xi #if ALL_IP_COMMAND
677*53ee8cc1Swenshuai.xi     if(STXC_DS_CMDCNT.u16CMDCNT_IPM > DMS_DS_DEPTH*4)
678*53ee8cc1Swenshuai.xi #else
679*53ee8cc1Swenshuai.xi     if(STXC_DS_CMDCNT.u16CMDCNT_IPM > DMS_DS_DEPTH*2)
680*53ee8cc1Swenshuai.xi #endif
681*53ee8cc1Swenshuai.xi     {
682*53ee8cc1Swenshuai.xi         printf("\033[1;31m[%s][%d] error, IPM DS Command conut %d > Max_size %d\033[0m\n",__FUNCTION__,__LINE__,STXC_DS_CMDCNT.u16CMDCNT_IPM,DMS_DS_DEPTH*2);
683*53ee8cc1Swenshuai.xi     }
684*53ee8cc1Swenshuai.xi     if(STXC_DS_CMDCNT.u16CMDCNT_OPM > DMS_DS_DEPTH*2)
685*53ee8cc1Swenshuai.xi     {
686*53ee8cc1Swenshuai.xi         printf("\033[1;31m[%s][%d] error, OPM DS Command conut %d > Max_size %d\033[0m\n",__FUNCTION__,__LINE__,STXC_DS_CMDCNT.u16CMDCNT_OPM,DMS_DS_DEPTH*2);
687*53ee8cc1Swenshuai.xi     }
688*53ee8cc1Swenshuai.xi 
689*53ee8cc1Swenshuai.xi     MApi_XC_Set_DSForceIndex(TRUE,pDMSResPri->stHalDMS.u8DSIndex,MAIN_WINDOW);
690*53ee8cc1Swenshuai.xi     if(pDMSResPri->stHalDMS.u8DSIndex == 0)
691*53ee8cc1Swenshuai.xi     {
692*53ee8cc1Swenshuai.xi         pDMSResPri->stHalDMS.u8DSIndex = 1;
693*53ee8cc1Swenshuai.xi     }
694*53ee8cc1Swenshuai.xi     else
695*53ee8cc1Swenshuai.xi     {
696*53ee8cc1Swenshuai.xi         pDMSResPri->stHalDMS.u8DSIndex = 0;
697*53ee8cc1Swenshuai.xi     }
698*53ee8cc1Swenshuai.xi     return TRUE;
699*53ee8cc1Swenshuai.xi }
700*53ee8cc1Swenshuai.xi 
HAL_DMS_XC_GetCaps(void * pInstance,EN_DMS_CAPABILITY * peCapability)701*53ee8cc1Swenshuai.xi MS_BOOL HAL_DMS_XC_GetCaps(void* pInstance, EN_DMS_CAPABILITY *peCapability)
702*53ee8cc1Swenshuai.xi {
703*53ee8cc1Swenshuai.xi     *peCapability |= E_DMS_CAPABILITY_MULTI_WINDOW;
704*53ee8cc1Swenshuai.xi     return TRUE;
705*53ee8cc1Swenshuai.xi }
706*53ee8cc1Swenshuai.xi 
707*53ee8cc1Swenshuai.xi #if(DMS_DONT_USE_CMA == 1)
708*53ee8cc1Swenshuai.xi #ifdef MSOS_TYPE_LINUX_KERNEL
709*53ee8cc1Swenshuai.xi #include "drvCMAPool_v2.h"
710*53ee8cc1Swenshuai.xi #else
711*53ee8cc1Swenshuai.xi #include "drvCMAPool.h"
712*53ee8cc1Swenshuai.xi #endif
713*53ee8cc1Swenshuai.xi #include "msos/linux/mdrv_cma_pool_st.h"
714*53ee8cc1Swenshuai.xi #endif
715*53ee8cc1Swenshuai.xi 
716*53ee8cc1Swenshuai.xi #define DMS_CMA_4MB 0x0400000
717*53ee8cc1Swenshuai.xi #define DMS_CMA_8MB 0x0800000
718*53ee8cc1Swenshuai.xi #define DMS_CMA_16MB 0x1000000
719*53ee8cc1Swenshuai.xi #define DMS_CMA_24MB 0x1800000
720*53ee8cc1Swenshuai.xi #define DMS_CMA_32MB 0x2000000
721*53ee8cc1Swenshuai.xi #define DMS_CMA_48MB 0x3000000
722*53ee8cc1Swenshuai.xi 
723*53ee8cc1Swenshuai.xi #if(DMS_DONT_USE_CMA == 1)
HAL_DMS_Release_CMA(void * pInstance,EN_DMS_MEMORY_TYPE enMemType,MS_U32 u32CMAHeapID)724*53ee8cc1Swenshuai.xi MS_BOOL HAL_DMS_Release_CMA(void* pInstance, EN_DMS_MEMORY_TYPE enMemType, MS_U32 u32CMAHeapID)
725*53ee8cc1Swenshuai.xi {
726*53ee8cc1Swenshuai.xi     return FALSE;
727*53ee8cc1Swenshuai.xi }
728*53ee8cc1Swenshuai.xi 
HAL_DMS_Setup_CMA(void * pInstance,EN_DMS_MEMORY_TYPE enMemType,MS_U32 u32CMAHeapID)729*53ee8cc1Swenshuai.xi MS_BOOL HAL_DMS_Setup_CMA(void* pInstance, EN_DMS_MEMORY_TYPE enMemType, MS_U32 u32CMAHeapID)
730*53ee8cc1Swenshuai.xi {
731*53ee8cc1Swenshuai.xi     MS_U32 u32GetCMABufferSize = 0;
732*53ee8cc1Swenshuai.xi     switch(enMemType)
733*53ee8cc1Swenshuai.xi     {
734*53ee8cc1Swenshuai.xi         case E_DMS_MEMORY_TYPE_GOP_DISPLAY:
735*53ee8cc1Swenshuai.xi         {
736*53ee8cc1Swenshuai.xi #if (DMS_DIP_Support_HVSP == 0)
737*53ee8cc1Swenshuai.xi             u32GetCMABufferSize = DMS_CMA_48MB;
738*53ee8cc1Swenshuai.xi #else
739*53ee8cc1Swenshuai.xi             u32GetCMABufferSize = DMS_CMA_32MB;
740*53ee8cc1Swenshuai.xi #endif
741*53ee8cc1Swenshuai.xi             break;
742*53ee8cc1Swenshuai.xi         }
743*53ee8cc1Swenshuai.xi         case E_DMS_MEMORY_TYPE_FREEZE:
744*53ee8cc1Swenshuai.xi         {
745*53ee8cc1Swenshuai.xi             u32GetCMABufferSize = DMS_CMA_4MB;
746*53ee8cc1Swenshuai.xi             break;
747*53ee8cc1Swenshuai.xi         }
748*53ee8cc1Swenshuai.xi         case E_DMS_MEMORY_TYPE_MVOP_DISPLAY:
749*53ee8cc1Swenshuai.xi         {
750*53ee8cc1Swenshuai.xi             u32GetCMABufferSize = DMS_CMA_24MB;
751*53ee8cc1Swenshuai.xi             break;
752*53ee8cc1Swenshuai.xi         }
753*53ee8cc1Swenshuai.xi         default:
754*53ee8cc1Swenshuai.xi         {
755*53ee8cc1Swenshuai.xi             DMS_PRINTF("\033[1;31m[%s][%d] unuse mem type %d set CMA\033[0m\n",__FUNCTION__,__LINE__,enMemType);
756*53ee8cc1Swenshuai.xi             break;
757*53ee8cc1Swenshuai.xi         }
758*53ee8cc1Swenshuai.xi     }
759*53ee8cc1Swenshuai.xi     if(u32GetCMABufferSize == 0)
760*53ee8cc1Swenshuai.xi     {
761*53ee8cc1Swenshuai.xi         DMS_PRINTF("\033[1;31m[%s][%d] CMA buffer size = 0\033[0m\n",__FUNCTION__,__LINE__);
762*53ee8cc1Swenshuai.xi         return FALSE;
763*53ee8cc1Swenshuai.xi     }
764*53ee8cc1Swenshuai.xi 
765*53ee8cc1Swenshuai.xi     struct CMA_Pool_Alloc_Param CMA_Pool_GetMem;
766*53ee8cc1Swenshuai.xi     CMA_Pool_GetMem.pool_handle_id = u32CMAHeapID;
767*53ee8cc1Swenshuai.xi     CMA_Pool_GetMem.offset_in_pool = 0;
768*53ee8cc1Swenshuai.xi     CMA_Pool_GetMem.flags = CMA_FLAG_VIRT_ADDR;
769*53ee8cc1Swenshuai.xi     CMA_Pool_GetMem.length = u32GetCMABufferSize;
770*53ee8cc1Swenshuai.xi 
771*53ee8cc1Swenshuai.xi     if (MApi_CMA_Pool_GetMem(&CMA_Pool_GetMem) == FALSE)
772*53ee8cc1Swenshuai.xi     {
773*53ee8cc1Swenshuai.xi         DMS_PRINTF("\033[1;31m Function = %s, Line = %d, MApi_CMA_Pool_GetMem() fail!!! (Type %d, HeapID %d, Size 0x%x)\033[m\n", __PRETTY_FUNCTION__, __LINE__,
774*53ee8cc1Swenshuai.xi             enMemType,u32CMAHeapID,u32GetCMABufferSize);
775*53ee8cc1Swenshuai.xi         return FALSE;
776*53ee8cc1Swenshuai.xi     }
777*53ee8cc1Swenshuai.xi 
778*53ee8cc1Swenshuai.xi     return TRUE;
779*53ee8cc1Swenshuai.xi }
780*53ee8cc1Swenshuai.xi #endif
781