void mt_disp_init(void *lcdbase)
{
// TODO: Fixit!!!!!
//workaround for video mode
//if(lcm_params->type==LCM_TYPE_DSI && lcm_params->dsi.mode!=CMD_MODE)
// return;
unsigned int lcm_fake_width = 0;
unsigned int lcm_fake_height = 0;
void *boot_mode_addr = 0;
fb_size = ALIGN_TO(CFG_DISPLAY_WIDTH, MTK_FB_ALIGNMENT) * ALIGN_TO(CFG_DISPLAY_HEIGHT, MTK_FB_ALIGNMENT) * 32 / 8;
boot_mode_addr = (void *)((UINT32)lcdbase + fb_size);
logo_db_addr = (void *)((UINT32)lcdbase - 4 * 1024 * 1024);
// fb_addr = (void *)((UINT32)lcdbase + fb_size);
fb_addr = lcdbase;
fb_offset_logo = 3;
///for debug prupose
disp_log_enable(1);
dbi_log_enable(1);
mt_disp_parse_dfo_setting();
if((0 == mt_disp_get_dfo_setting("LCM_FAKE_WIDTH", &lcm_fake_width)) && (0 == mt_disp_get_dfo_setting("LCM_FAKE_HEIGHT", &lcm_fake_height)))
{
if(DISP_STATUS_OK != DISP_Change_LCM_Resolution(lcm_fake_width, lcm_fake_height))
{
dprintf(INFO,"[DISP_DFO]WARNING!!! Change LCM Resolution FAILED!!!\n");
}
}
DISP_CHECK_RET(DISP_Init((UINT32)lcdbase, (UINT32)lcdbase, FALSE));
memset((void*)lcdbase, 0x0, DISP_GetVRamSize());
/* transparent front buffer for fb_console display */
#if 1
LCD_CHECK_RET(LCD_LayerEnable(FB_LAYER, TRUE));
LCD_CHECK_RET(LCD_LayerSetAddress(FB_LAYER, (UINT32)boot_mode_addr));
LCD_CHECK_RET(LCD_LayerSetFormat(FB_LAYER, LCD_LAYER_FORMAT_RGB565));
LCD_CHECK_RET(LCD_LayerSetPitch(FB_LAYER, CFG_DISPLAY_WIDTH*2/*ALIGN_TO(CFG_DISPLAY_WIDTH,MTK_FB_ALIGNMENT)*2*/));
LCD_CHECK_RET(LCD_LayerSetOffset(FB_LAYER, 0, 0));
LCD_CHECK_RET(LCD_LayerSetSize(FB_LAYER, CFG_DISPLAY_WIDTH, CFG_DISPLAY_HEIGHT));
LCD_CHECK_RET(LCD_LayerSetSourceColorKey(FB_LAYER, TRUE, 0xff000000));
#endif
/* background buffer for uboot logo display */
LCD_CHECK_RET(LCD_LayerEnable(FB_LAYER - 1, TRUE));
LCD_CHECK_RET(LCD_LayerSetAddress(FB_LAYER - 1, (UINT32)fb_addr));
LCD_CHECK_RET(LCD_LayerSetFormat(FB_LAYER - 1, LCD_LAYER_FORMAT_RGB565));
LCD_CHECK_RET(LCD_LayerSetOffset(FB_LAYER - 1, 0, 0));
LCD_CHECK_RET(LCD_LayerSetSize(FB_LAYER - 1, CFG_DISPLAY_WIDTH, CFG_DISPLAY_HEIGHT));
LCD_CHECK_RET(LCD_LayerSetPitch(FB_LAYER - 1, ALIGN_TO(CFG_DISPLAY_WIDTH, MTK_FB_ALIGNMENT)*2));
#if 0
if(0 == strncmp(MTK_LCM_PHYSICAL_ROTATION, "180", 3))
{
LCD_CHECK_RET(LCD_LayerSetRotation(FB_LAYER, LCD_LAYER_ROTATE_180));
LCD_CHECK_RET(LCD_LayerSetRotation(FB_LAYER - 1, LCD_LAYER_ROTATE_180));
}
#endif
}
void mt_disp_init(void *lcdbase)
{
UINT32 boot_mode_addr = 0;
fb_size = ALIGN_TO(CFG_DISPLAY_WIDTH, MTK_FB_ALIGNMENT) * ALIGN_TO(CFG_DISPLAY_HEIGHT, MTK_FB_ALIGNMENT) * CFG_DISPLAY_BPP / 8;
boot_mode_addr = (UINT32)((UINT32)lcdbase + fb_size);
logo_db_addr = (void *)((UINT32)lcdbase - 4 * 1024 * 1024);
// fb_addr = (void *)((UINT32)lcdbase + fb_size);
fb_addr = lcdbase;
fb_offset_logo = 3;
#if 0
///for debug prupose
disp_log_enable(1);
dbi_log_enable(1);
#endif
DISP_CHECK_RET(DISP_Init((UINT32)lcdbase, (UINT32)lcdbase, FALSE));
memset((void*)lcdbase, 0x0, DISP_GetVRamSize());
/* transparent front buffer for fb_console display */
#if 1
LCD_CHECK_RET(LCD_LayerEnable(FB_LAYER, TRUE));
LCD_CHECK_RET(LCD_LayerSetAddress(FB_LAYER, (UINT32)boot_mode_addr));
LCD_CHECK_RET(LCD_LayerSetFormat(FB_LAYER, LCD_LAYER_FORMAT_RGB565));
LCD_CHECK_RET(LCD_LayerSetPitch(FB_LAYER, CFG_DISPLAY_WIDTH*2));
LCD_CHECK_RET(LCD_LayerSetOffset(FB_LAYER, 0, 0));
LCD_CHECK_RET(LCD_LayerSetSize(FB_LAYER, CFG_DISPLAY_WIDTH, CFG_DISPLAY_HEIGHT));
LCD_CHECK_RET(LCD_LayerSetSourceColorKey(FB_LAYER, TRUE, 0xff000000));
#endif
/* background buffer for uboot logo display */
LCD_CHECK_RET(LCD_LayerEnable(FB_LAYER - 1, TRUE));
LCD_CHECK_RET(LCD_LayerSetAddress(FB_LAYER - 1, (UINT32)fb_addr));
LCD_CHECK_RET(LCD_LayerSetFormat(FB_LAYER - 1, LCD_LAYER_FORMAT_RGB565));
LCD_CHECK_RET(LCD_LayerSetOffset(FB_LAYER - 1, 0, 0));
LCD_CHECK_RET(LCD_LayerSetSize(FB_LAYER - 1, CFG_DISPLAY_WIDTH, CFG_DISPLAY_HEIGHT));
LCD_CHECK_RET(LCD_LayerSetPitch(FB_LAYER - 1, ALIGN_TO(CFG_DISPLAY_WIDTH, MTK_FB_ALIGNMENT) * 2));
if(0 == strncmp(MTK_LCM_PHYSICAL_ROTATION, "180", 3))
{
LCD_CHECK_RET(LCD_LayerSetRotation(FB_LAYER, LCD_LAYER_ROTATE_180));
LCD_CHECK_RET(LCD_LayerSetRotation(FB_LAYER - 1, LCD_LAYER_ROTATE_180));
}
}
/*
* ======== WCD_Init ========
* Purpose:
* Module initialization is done by SERVICES Init.
*/
bool WCD_Init(void)
{
bool fInit = true;
bool fDRV, fDEV, fCOD, fSERVICES, fCHNL, fMSG, fIO;
bool fMGR, fPROC, fNODE, fDISP, fNTFY, fSTRM, fRMM;
#ifdef DEBUG
/* runtime check of Device IOCtl array. */
u32 i;
int cmdtable = ARRAY_SIZE(WCD_cmdTable);
for (i = 1; i < cmdtable; i++)
DBC_Assert(WCD_cmdTable[i - 1].dwIndex == i);
#endif
if (WCD_cRefs == 0) {
/* initialize all SERVICES modules */
fSERVICES = SERVICES_Init();
/* initialize debugging module */
DBC_Assert(!WCD_debugMask.flags);
GT_create(&WCD_debugMask, "CD"); /* CD for class driver */
/* initialize class driver and other modules */
fDRV = DRV_Init();
fMGR = MGR_Init();
fPROC = PROC_Init();
fNODE = NODE_Init();
fDISP = DISP_Init();
fNTFY = NTFY_Init();
fSTRM = STRM_Init();
fRMM = RMM_init();
fCHNL = CHNL_Init();
fMSG = MSG_Init();
fIO = IO_Init();
fDEV = DEV_Init();
fCOD = COD_Init();
fInit = fSERVICES && fDRV && fDEV && fCHNL && fCOD &&
fMSG && fIO;
fInit = fInit && fMGR && fPROC && fRMM;
if (!fInit) {
if (fSERVICES)
SERVICES_Exit();
if (fDRV)
DRV_Exit();
if (fMGR)
MGR_Exit();
if (fSTRM)
STRM_Exit();
if (fPROC)
PROC_Exit();
if (fNODE)
NODE_Exit();
if (fDISP)
DISP_Exit();
if (fNTFY)
NTFY_Exit();
if (fCHNL)
CHNL_Exit();
if (fMSG)
MSG_Exit();
if (fIO)
IO_Exit();
if (fDEV)
DEV_Exit();
if (fCOD)
COD_Exit();
if (fRMM)
RMM_exit();
}
}
if (fInit)
WCD_cRefs++;
GT_1trace(WCD_debugMask, GT_5CLASS,
"Entered WCD_Init, ref count: 0x%x\n", WCD_cRefs);
return fInit;
}
