static DAL_STATUS Show_LowMemory(void)
{
UINT32 update_width, update_height;
MFC_CONTEXT *ctxt = (MFC_CONTEXT *)mfc_handle;
if(!dal_shown){//only need show lowmemory assert
update_width = ctxt->font_width * strlen(low_memory_msg);
update_height = ctxt->font_height;
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DAL", "update size:%d,%d",update_width, update_height);
DAL_CHECK_LCD_RET(LCD_LayerSetOffset(ASSERT_LAYER, DAL_WIDTH - update_width,0));
DAL_CHECK_LCD_RET(LCD_LayerSetWindowOffset(ASSERT_LAYER, DAL_WIDTH - update_width,0));
DAL_CHECK_LCD_RET(LCD_LayerSetSize(ASSERT_LAYER,
update_width,update_height));
DAL_CHECK_LCD_RET(LCD_LayerEnable(ASSERT_LAYER, TRUE));
}
/*
if(!dal_lowMemory_shown)
DAL_CHECK_DISP_RET(DISP_UpdateScreen(0, 0,
DAL_WIDTH,
DAL_HEIGHT));
*/
return DAL_STATUS_OK;
}
static irqreturn_t _DPI_InterruptHandler(int irq, void *dev_id)
{
static int counter = 0;
DPI_REG_INTERRUPT status = DPI_REG->INT_STATUS;
// if (status.FIFO_EMPTY) ++ counter;
if(status.VSYNC)
{
if(dpiIntCallback)
dpiIntCallback(DISP_DPI_VSYNC_INT);
#ifndef BUILD_UBOOT
if(atomic_read(&wait_dpi_vsync)){
if(-1 != hrtimer_try_to_cancel(&hrtimer_vsync_dpi)){
atomic_set(&wait_dpi_vsync, 0);
atomic_set(&dpi_vsync, 1);
wake_up_interruptible(&_vsync_wait_queue_dpi);
hrtimer_start(&hrtimer_vsync_dpi, ktime_set(0, VSYNC_US_TO_NS(vsync_timer_dpi)), HRTIMER_MODE_REL);
}
}
#endif
}
if (status.VSYNC && counter) {
DISP_LOG_PRINT(ANDROID_LOG_ERROR, "DPI", "[Error] DPI FIFO is empty, "
"received %d times interrupt !!!\n", counter);
counter = 0;
}
if (status.FIFO_EMPTY)
{
DSI_handle_esd_recovery();
}
_DPI_LogRefreshRate(status);
OUTREG32(&DPI_REG->INT_STATUS, 0);
return IRQ_HANDLED;
}
static irqreturn_t _DPI_InterruptHandler(int irq, void *dev_id)
{
static int counter = 0;
DPI_REG_INTERRUPT status = DPI_REG->INT_STATUS;
// if (status.FIFO_EMPTY) ++ counter;
if(status.VSYNC)
{
dpi_vsync_irq_count++;
if(dpi_vsync_irq_count > 120)
{
printk("dpi vsync\n");
dpi_vsync_irq_count = 0;
}
if(dpiIntCallback)
dpiIntCallback(DISP_DPI_VSYNC_INT);
#ifndef BUILD_UBOOT
if(wait_dpi_vsync){
if(-1 != hrtimer_try_to_cancel(&hrtimer_vsync_dpi)){
dpi_vsync = true;
// hrtimer_try_to_cancel(&hrtimer_vsync_dpi);
wake_up_interruptible(&_vsync_wait_queue_dpi);
}
}
#endif
}
if (status.VSYNC && counter) {
DISP_LOG_PRINT(ANDROID_LOG_ERROR, "DPI", "[Error] DPI FIFO is empty, "
"received %d times interrupt !!!\n", counter);
counter = 0;
}
_DPI_LogRefreshRate(status);
OUTREG32(&DPI_REG->INT_STATUS, 0);
return IRQ_HANDLED;
}
DPI_STATUS DPI_Init(BOOL isDpiPoweredOn)
{
//DPI_REG_CNTL cntl;
//DPI_REG_EMBSYNC_SETTING embsync;
if (isDpiPoweredOn) {
_BackupDPIRegisters();
} else {
_ResetBackupedDPIRegisterValues();
}
DPI_PowerOn();
OUTREG32(DPI_BASE+ 0x64, 0x400);//
OUTREG32(DPI_BASE+ 0x6C, 0x400);//
OUTREG32(DPI_BASE+ 0x74, 0x400);//
OUTREG32(DPI_BASE+ 0x8C, 0x0FFF0000);//
OUTREG32(DPI_BASE+ 0x90, 0x0FFF0000);//
MASKREG32(DISPSYS_BASE + 0x60, 0x1, 0x1);
#if ENABLE_DPI_INTERRUPT
if (request_irq(MT6589_DPI_IRQ_ID,
_DPI_InterruptHandler, IRQF_TRIGGER_LOW, "mtkdpi", NULL) < 0)
{
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DPI", "[ERROR] fail to request DPI irq\n");
return DPI_STATUS_ERROR;
}
{
DPI_REG_INTERRUPT enInt = DPI_REG->INT_ENABLE;
enInt.VSYNC = 1;
OUTREG32(&DPI_REG->INT_ENABLE, AS_UINT32(&enInt));
}
#endif
LCD_W2M_NeedLimiteSpeed(TRUE);
return DPI_STATUS_OK;
}
DPI_STATUS DPI_PowerOff()
{
int ret = 0;
if (s_isDpiPowerOn)
{
#if 1
_BackupDPIRegisters();
//disable_pll(LVDSPLL, "dpi0");
///disable_mux(MT_MUX_DPI0, "DPI");
ret += disable_clock(MT_CG_DISP1_DPI_DIGITAL_LANE, "DPI");
ret += disable_clock(MT_CG_DISP1_DPI_ENGINE, "DPI");
ret += disable_clock(MT_CG_DISP0_RDMA1, "DDP");
////disable_pll(TVDPLL, "hdmi_dpi");
if(ret >0)
{
DISP_LOG_PRINT(ANDROID_LOG_ERROR, "DPI", "power manager API return FALSE\n");
}
#endif
s_isDpiPowerOn = FALSE;
}
return DPI_STATUS_OK;
}
DAL_STATUS DAL_Printf(const char *fmt, ...)
{
va_list args;
uint i;
DAL_STATUS ret = DAL_STATUS_OK;
printk("%s", __func__);
//printk("[MTKFB_DAL] DAL_Printf mfc_handle=0x%08X, fmt=0x%08X\n", mfc_handle, fmt);
if (NULL == mfc_handle)
return DAL_STATUS_NOT_READY;
if (NULL == fmt)
return DAL_STATUS_INVALID_ARGUMENT;
MMProfileLogEx(ddp_mmp_get_events()->dal_printf, MMProfileFlagStart, 0, 0);
DAL_LOCK();
if(isAEEEnabled==0)
{
printk("[DDP] isAEEEnabled from 0 to 1, ASSERT_LAYER=%d, dal_fb_pa %lx\n",
ASSERT_LAYER, dal_fb_pa);
isAEEEnabled = 1;
DAL_Dynamic_Change_FB_Layer(isAEEEnabled); // default_ui_ layer coniig to changed_ui_layer
DAL_CHECK_MFC_RET(MFC_Open(&mfc_handle, dal_fb_addr,
DAL_WIDTH, DAL_HEIGHT, DAL_BPP,
DAL_FG_COLOR, DAL_BG_COLOR));
//DAL_Clean();
primary_disp_input_config input;
memset((void*)&input, 0, sizeof(primary_disp_input_config));
input.addr = (unsigned long)dal_fb_pa;
input.layer = primary_display_get_option("ASSERT_LAYER");
input.layer_en = 1;
input.src_x = 0;
input.src_y = 0;
input.src_w = DAL_WIDTH;
input.src_h = DAL_HEIGHT;
input.dst_x = 0;
input.dst_y = 0;
input.dst_w = DAL_WIDTH;
input.dst_h = DAL_HEIGHT;
input.alpha = 0x80;
input.aen = 1;
input.buff_idx = -1;
input.src_pitch = DAL_WIDTH * DAL_BPP;
input.isDirty = 1;
input.fmt = DAL_FORMAT;
ret = primary_display_config_input(&input);
}
va_start (args, fmt);
i = vsprintf(dal_print_buffer, fmt, args);
BUG_ON(i>=ARRAY_SIZE(dal_print_buffer));
va_end (args);
DAL_CHECK_MFC_RET(MFC_Print(mfc_handle, dal_print_buffer));
flush_cache_all();
/*
if (LCD_STATE_POWER_OFF == LCD_GetState()) {
ret = DAL_STATUS_LCD_IN_SUSPEND;
dal_enable_when_resume = TRUE;
goto End;
}
*/
#if 0
if(is_early_suspended){
up(&sem_early_suspend);
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DAL", "DAL_Printf in power off\n");
goto End;
}
#endif
if (!dal_shown) {
dal_shown = TRUE;
}
ret = primary_display_trigger(0, NULL, 0);
End:
DAL_UNLOCK();
MMProfileLogEx(ddp_mmp_get_events()->dal_printf, MMProfileFlagEnd, 0, 0);
return ret;
}
DAL_STATUS DAL_Clean(void)
{
const UINT32 BG_COLOR = MAKE_TWO_RGB565_COLOR(DAL_BG_COLOR, DAL_BG_COLOR);
DAL_STATUS ret = DAL_STATUS_OK;
static int dal_clean_cnt = 0;
MFC_CONTEXT *ctxt = (MFC_CONTEXT *)mfc_handle;
printk("[MTKFB_DAL] DAL_Clean\n");
if (NULL == mfc_handle)
return DAL_STATUS_NOT_READY;
// if (LCD_STATE_POWER_OFF == LCD_GetState())
// return DAL_STATUS_LCD_IN_SUSPEND;
MMProfileLogEx(ddp_mmp_get_events()->dal_clean, MMProfileFlagStart, 0, 0);
DAL_LOCK();
DAL_CHECK_MFC_RET(MFC_ResetCursor(mfc_handle));
ctxt->screen_color=0;
DAL_SetScreenColor(DAL_COLOR_RED);
/*
if (LCD_STATE_POWER_OFF == LCD_GetState()) {
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DAL", "dal_clean in power off\n");
dal_disable_when_resume = TRUE;
ret = DAL_STATUS_LCD_IN_SUSPEND;
goto End;
}
*/
//xuecheng, for debug
#if 0
if(is_early_suspended){
up(&sem_early_suspend);
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DAL", "dal_clean in power off\n");
goto End;
}
#endif
//TODO: if dal_shown=false, and 3D enabled, mtkfb may disable UI layer, please modify 3D driver
if(isAEEEnabled==1)
{
primary_disp_input_config input;
memset((void*)&input, 0, sizeof(primary_disp_input_config));
input.addr = (unsigned long)dal_fb_pa;
input.layer = primary_display_get_option("ASSERT_LAYER");
input.layer_en = 0;
input.src_x = 0;
input.src_y = 0;
input.src_w = DAL_WIDTH;
input.src_h = DAL_HEIGHT;
input.dst_x = 0;
input.dst_y = 0;
input.dst_w = DAL_WIDTH;
input.dst_h = DAL_HEIGHT;
input.alpha = 0x80;
input.aen = 1;
input.buff_idx = -1;
input.src_pitch = DAL_WIDTH * DAL_BPP;
input.isDirty = 1;
input.fmt = DAL_FORMAT;
ret = primary_display_config_input(&input);
// DAL disable, switch UI layer to default layer 3
printk("[DDP]* isAEEEnabled from 1 to 0, %d \n", dal_clean_cnt++);
isAEEEnabled = 0;
DAL_Dynamic_Change_FB_Layer(isAEEEnabled); // restore UI layer to DEFAULT_UI_LAYER
}
dal_shown = FALSE;
dal_disable_when_resume = FALSE;
primary_display_trigger(0, NULL, 0);
End:
DAL_UNLOCK();
MMProfileLogEx(ddp_mmp_get_events()->dal_clean, MMProfileFlagEnd, 0, 0);
return ret;
}
static void process_dbg_opt(const char *opt)
{
if (0 == strncmp(opt, "hdmion", 6))
{
hdmi_force_init();
}
else if (0 == strncmp(opt, "fps:", 4))
{
if (0 == strncmp(opt + 4, "on", 2)) {
dbg_opt.en_fps_log = 1;
} else if (0 == strncmp(opt + 4, "off", 3)) {
dbg_opt.en_fps_log = 0;
} else {
goto Error;
}
reset_fps_logger();
}
else if (0 == strncmp(opt, "tl:", 3))
{
if (0 == strncmp(opt + 3, "on", 2)) {
dbg_opt.en_touch_latency_log = 1;
} else if (0 == strncmp(opt + 3, "off", 3)) {
dbg_opt.en_touch_latency_log = 0;
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "black", 5))
{
mtkfb_clear_lcm();
}
else if (0 == strncmp(opt, "suspend", 4))
{
DISP_PanelEnable(FALSE);
DISP_PowerEnable(FALSE);
}
else if (0 == strncmp(opt, "resume", 4))
{
DISP_PowerEnable(TRUE);
DISP_PanelEnable(TRUE);
}
else if (0 == strncmp(opt, "lcm:", 4))
{
if (0 == strncmp(opt + 4, "on", 2)) {
DISP_PanelEnable(TRUE);
} else if (0 == strncmp(opt + 4, "off", 3)) {
DISP_PanelEnable(FALSE);
}
else if (0 == strncmp(opt + 4, "init", 4)) {
if (NULL != lcm_drv && NULL != lcm_drv->init) {
lcm_drv->init();
}
}else {
goto Error;
}
}
else if (0 == strncmp(opt, "cabc:", 5))
{
if (0 == strncmp(opt + 5, "ui", 2)) {
mtkfb_set_backlight_mode(1);
}else if (0 == strncmp(opt + 5, "mov", 3)) {
mtkfb_set_backlight_mode(3);
}else if (0 == strncmp(opt + 5, "still", 5)) {
mtkfb_set_backlight_mode(2);
}else {
goto Error;
}
}
else if (0 == strncmp(opt, "lcd:", 4))
{
if (0 == strncmp(opt + 4, "on", 2)) {
DISP_PowerEnable(TRUE);
} else if (0 == strncmp(opt + 4, "off", 3)) {
DISP_PowerEnable(FALSE);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "dbi:", 4))
{
if (0 == strncmp(opt + 4, "on", 2)) {
LCD_PowerOn();
} else if (0 == strncmp(opt + 4, "off", 3)) {
LCD_PowerOff();
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "dpi:", 4))
{
if (0 == strncmp(opt + 4, "on", 2)) {
DPI_PowerOn();
} else if (0 == strncmp(opt + 4, "off", 3)) {
DPI_PowerOff();
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "dsi:", 4))
{
if (0 == strncmp(opt + 4, "on", 2)) {
DSI_PowerOn();
} else if (0 == strncmp(opt + 4, "off", 3)) {
DSI_PowerOff();
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "te:", 3))
{
if (0 == strncmp(opt + 3, "on", 2)) {
LCD_TE_Enable(TRUE);
DSI_TE_Enable(TRUE);
} else if (0 == strncmp(opt + 3, "off", 3)) {
LCD_TE_Enable(FALSE);
DSI_TE_Enable(FALSE);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "vsynclog:", 9))
{
if (0 == strncmp(opt + 9, "on", 2))
{
EnableVSyncLog = 1;
} else if (0 == strncmp(opt + 9, "off", 3))
{
EnableVSyncLog = 0;
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "layer", 5))
{
dump_lcd_layer_info();
}
else if (0 == strncmp(opt, "reg:", 4))
{
if (0 == strncmp(opt + 4, "lcd", 3)) {
LCD_DumpRegisters();
}else if (0 == strncmp(opt + 4, "dpi1", 4)) {
DPI1_DumpRegisters();
}else if (0 == strncmp(opt + 4, "dpi", 3)) {
DPI_DumpRegisters();
} else if (0 == strncmp(opt + 4, "dsi", 3)) {
DSI_DumpRegisters();
#if defined(MTK_TVOUT_SUPPORT)
} else if (0 == strncmp(opt + 4, "tvc", 3)) {
TVC_DumpRegisters();
} else if (0 == strncmp(opt + 4, "tve", 3)) {
TVE_DumpRegisters();
} else if (0 == strncmp(opt + 4, "tvr", 3)) {
TVR_DumpRegisters();
#endif
} else {
goto Error;
}
}
#if defined(MTK_TVOUT_SUPPORT)
else if (0 == strncmp(opt, "tv:", 3))
{
if (0 == strncmp(opt + 3, "on", 2)) {
TVOUT_TvCablePlugIn();
} else if (0 == strncmp(opt +3, "off", 3)) {
TVOUT_TvCablePlugOut();
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "tvforce:", 8))
{
if (0 == strncmp(opt + 8, "on", 2)) {
TVOUT_TvCablePlugIn_Directly();
} else if (0 == strncmp(opt +8, "off", 3)) {
TVOUT_TvCablePlugOut_Directly();
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "tvsys:", 6))
{
if (0 == strncmp(opt + 6, "ntsc", 4)) {
TVOUT_SetTvSystem(TVOUT_SYSTEM_NTSC);
} else if (0 == strncmp(opt + 6, "pal", 3)) {
TVOUT_SetTvSystem(TVOUT_SYSTEM_PAL);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "tvrot:", 6))
{
if (0 == strncmp(opt + 6, "on", 2)) {
TVOUT_SetOrientation(TVOUT_ROT_270);
} else if (0 == strncmp(opt + 6, "off", 3)) {
TVOUT_SetOrientation(TVOUT_ROT_0);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "tvcb:", 5))
{
if (0 == strncmp(opt + 5, "on", 2)) {
TVOUT_EnableColorBar(TRUE);
} else if (0 == strncmp(opt + 5, "off", 3)) {
TVOUT_EnableColorBar(FALSE);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "tvvm:", 5))
{
if (0 == strncmp(opt + 5, "on", 2)) {
TVOUT_DisableVideoMode(false);
} else if (0 == strncmp(opt + 5, "off", 3)) {
TVOUT_DisableVideoMode(true);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "tvlog:", 6))
{
if (0 == strncmp(opt + 6, "on", 2)) {
TVOUT_EnableLog(true);
} else if (0 == strncmp(opt + 6, "off", 3)) {
TVOUT_EnableLog(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "tvtime:", 7))
{
if (0 == strncmp(opt + 7, "on", 2)) {
TVOUT_EnableTimeProfiling(true);
} else if (0 == strncmp(opt + 7, "off", 3)) {
TVOUT_EnableTimeProfiling(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "tvcap:", 6))
{
if (0 == strncmp(opt + 6, "on", 2)) {
capture_tv_buffer = true;
} else if (0 == strncmp(opt + 6, "off", 3)) {
capture_tv_buffer = false;
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "tvcam:", 6))
{
if (0 == strncmp(opt + 6, "on", 2)) {
TVOUT_ForceClose();
} else if (0 == strncmp(opt + 6, "off", 3)) {
TVOUT_RestoreOpen();
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "tvuser:"******"on", 2)) {
TVOUT_TurnOn(true);
} else if (0 == strncmp(opt + 7, "off", 3)) {
TVOUT_TurnOn(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "tvcoffset:", 10))
{
char *p = (char *)opt + 10;
unsigned long offset = simple_strtoul(p, &p, 10);
TVC_SetCheckLineOffset(offset);
}
#endif
else if (0 == strncmp(opt, "regw:", 5))
{
char *p = (char *)opt + 5;
unsigned long addr = simple_strtoul(p, &p, 16);
unsigned long val = simple_strtoul(p + 1, &p, 16);
if (addr) {
OUTREG32(addr, val);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "regr:", 5))
{
char *p = (char *)opt + 5;
unsigned int addr = (unsigned int) simple_strtoul(p, &p, 16);
if (addr) {
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DBG", "Read register 0x%08x: 0x%08x\n", addr, INREG32(addr));
} else {
goto Error;
}
}
else if(0 == strncmp(opt, "bkl:", 4))
{
char *p = (char *)opt + 4;
unsigned int level = (unsigned int) simple_strtoul(p, &p, 10);
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DBG", "process_dbg_opt(), set backlight level = %d\n", level);
DISP_SetBacklight(level);
}
else if(0 == strncmp(opt, "dither:", 7))
{
unsigned lrs, lgs, lbs, dbr, dbg, dbb;
char *p = (char *)opt + 7;
lrs = (unsigned int) simple_strtoul(p, &p, 16);
p++;
lgs = (unsigned int) simple_strtoul(p, &p, 16);
p++;
lbs = (unsigned int) simple_strtoul(p, &p, 16);
p++;
dbr = (unsigned int) simple_strtoul(p, &p, 16);
p++;
dbg = (unsigned int) simple_strtoul(p, &p, 16);
p++;
dbb = (unsigned int) simple_strtoul(p, &p, 16);
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DBG", "process_dbg_opt(), %d %d %d %d %d %d\n", lrs, lgs, lbs, dbr, dbg, dbb);
#if 0 //defined(CONFIG_ARCH_MT6573)
LCD_WaitForNotBusy();
LCD_ConfigDither(lrs, lgs, lbs, dbr, dbg, dbb);
LCD_StartTransfer(true);
#endif
}
else if (0 == strncmp(opt, "mtkfblog:", 9))
{
if (0 == strncmp(opt + 9, "on", 2)) {
mtkfb_log_enable(true);
} else if (0 == strncmp(opt + 9, "off", 3)) {
mtkfb_log_enable(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "displog:", 8))
{
if (0 == strncmp(opt + 8, "on", 2)) {
disp_log_enable(true);
} else if (0 == strncmp(opt + 8, "off", 3)) {
disp_log_enable(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "lcdlog:", 7))
{
if (0 == strncmp(opt + 7, "on", 2)) {
dbi_log_enable(true);
} else if (0 == strncmp(opt + 7, "off", 3)) {
dbi_log_enable(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "dsilog:", 7))
{
if (0 == strncmp(opt + 7, "on", 2)) {
DSI_Enable_Log(true);
} else if (0 == strncmp(opt + 7, "off", 3)) {
DSI_Enable_Log(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "glitchlog:", 10))
{
if (0 == strncmp(opt + 10, "on", 2)) {
Glitch_Enable_Log(true);
} else if (0 == strncmp(opt + 10, "off", 3)) {
Glitch_Enable_Log(false);
} else {
goto Error;
}
}
else if(0 == strncmp(opt, "glitch_times:", 13))
{
char *p = (char *)opt + 13;
unsigned int level = (unsigned int) simple_strtoul(p, &p, 10);
Glitch_times(level);
}
else if (0 == strncmp(opt, "mtkfb_vsynclog:", 15))
{
if (0 == strncmp(opt + 15, "on", 2)) {
mtkfb_vsync_log_enable(true);
} else if (0 == strncmp(opt + 15, "off", 3)) {
mtkfb_vsync_log_enable(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "dpilog:", 7))
{
if (0 == strncmp(opt + 7, "on", 2)) {
//dpi_log_enable(true);
} else if (0 == strncmp(opt + 7, "off", 3)) {
//dpi_log_enable(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "log:", 4))
{
if (0 == strncmp(opt + 4, "on", 2)) {
mtkfb_log_enable(true);
disp_log_enable(true);
dbi_log_enable(true);
//dpi_log_enable(true);
} else if (0 == strncmp(opt + 4, "off", 3)) {
mtkfb_log_enable(false);
disp_log_enable(false);
dbi_log_enable(false);
//dpi_log_enable(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "update", 6))
{
DISP_UpdateScreen(0, 0, DISP_GetScreenWidth(), DISP_GetScreenHeight());
}
else if (0 == strncmp(opt, "pan_disp", 8))
{
mtkfb_pan_disp_test();
}
else if (0 == strncmp(opt, "sem_cnt", 7))
{
mtkfb_show_sem_cnt();
LCD_GetVsyncCnt();
}
else if (0 == strncmp(opt, "hang:", 5))
{
if (0 == strncmp(opt + 5, "on", 2)) {
mtkfb_hang_test(true);
} else if (0 == strncmp(opt + 5, "off", 3)) {
mtkfb_hang_test(false);
} else{
goto Error;
}
}
#if defined(MTK_M4U_SUPPORT)
else if (0 == strncmp(opt, "m4u:", 4))
{
if (0 == strncmp(opt + 4, "on", 2)) {
mtkfb_m4u_switch(true);
} else if (0 == strncmp(opt + 4, "off", 3)) {
mtkfb_m4u_switch(false);
} else if (0 == strncmp(opt + 4, "dump", 4)) {
mtkfb_m4u_dump();
} else{
goto Error;
}
}
#endif
else if (0 == strncmp(opt, "cpfbonly:", 9))
{
if (0 == strncmp(opt + 9, "on", 2))
{
mtkfb_capture_fb_only(true);
}
else if (0 == strncmp(opt + 9, "off", 3))
{
mtkfb_capture_fb_only(false);
}
}
else if (0 == strncmp(opt, "esd:", 4))
{
if (0 == strncmp(opt + 4, "on", 2))
{
esd_recovery_pause(FALSE);
}
else if (0 == strncmp(opt + 4, "off", 3))
{
esd_recovery_pause(TRUE);
}
}
else if (0 == strncmp(opt, "HQA:", 4))
{
if (0 == strncmp(opt + 4, "NormalToFactory", 15))
{
mtkfb_switch_normal_to_factory();
}
else if (0 == strncmp(opt + 4, "FactoryToNormal", 15))
{
mtkfb_switch_factory_to_normal();
}
}
else if (0 == strncmp(opt, "mmp", 3))
{
init_mtkfb_mmp_events();
}
else if (0 == strncmp(opt, "dump_layer:", 11))
{
if (0 == strncmp(opt + 11, "on", 2))
{
char *p = (char *)opt + 14;
gCaptureLayerDownX = simple_strtoul(p, &p, 10);
gCaptureLayerDownY = simple_strtoul(p+1, &p, 10);
gCaptureLayerEnable = 1;
}
else if (0 == strncmp(opt + 11, "off", 3))
{
gCaptureLayerEnable = 0;
}
}
else if (0 == strncmp(opt, "dump_ovl:", 9))
{
if (0 == strncmp(opt + 9, "on", 2))
{
char *p = (char *)opt + 12;
gCaptureOvlDownX = simple_strtoul(p, &p, 10);
gCaptureOvlDownY = simple_strtoul(p+1, &p, 10);
gCaptureOvlThreadEnable = 1;
wake_up_process(captureovl_task);
}
else if (0 == strncmp(opt + 9, "off", 3))
{
gCaptureOvlThreadEnable = 0;
}
}
else if (0 == strncmp(opt, "dump_fb:", 8))
{
if (0 == strncmp(opt + 8, "on", 2))
{
char *p = (char *)opt + 11;
gCaptureFBDownX = simple_strtoul(p, &p, 10);
gCaptureFBDownY = simple_strtoul(p+1, &p, 10);
gCaptureFBPeriod = simple_strtoul(p+1, &p, 10);
gCaptureFBEnable = 1;
wake_up_interruptible(&gCaptureFBWQ);
}
else if (0 == strncmp(opt + 8, "off", 3))
{
gCaptureFBEnable = 0;
}
}
else
{
goto Error;
}
return;
Error:
DISP_LOG_PRINT(ANDROID_LOG_INFO, "ERROR", "parse command error!\n\n%s", STR_HELP);
}
static ssize_t layer_debug_read(struct file *file,
char __user *ubuf, size_t count, loff_t *ppos)
{
#ifndef MT65XX_NEW_DISP
int ret;
MTKFB_LAYER_DBG_OPTIONS *dbgopt = (MTKFB_LAYER_DBG_OPTIONS *)file->private_data;
UINT32 aligned_buffer;
if(dbgopt->working_buf == 0)
{
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DBG", "No working buffer is available \n");
return 0;
}
///if LCD layer is enabled
if(!LCD_IsLayerEnable(dbgopt->layer_index))
{
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DBG", "The layer %d is not enabled \n", dbgopt->layer_index);
return 0;
}
aligned_buffer = (dbgopt->working_buf + 32) & 0xFFFFFFC0;
if(*ppos == 0)
{
extern struct semaphore sem_flipping;
extern struct semaphore sem_early_suspend;
extern struct semaphore sem_update_screen;
extern BOOL is_early_suspended;
ret = down_interruptible(&sem_flipping);
ret = down_interruptible(&sem_early_suspend);
if (is_early_suspended) {
up(&sem_early_suspend);
up(&sem_flipping);
return 0;
}
ret = down_interruptible(&sem_update_screen);
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DBG", "This is layer %d capturing \n", dbgopt->layer_index);
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DBG", "This layer width:%d , height:%d\n", LCD_REG->LAYER[dbgopt->layer_index].SIZE.WIDTH, LCD_REG->LAYER[dbgopt->layer_index].SIZE.HEIGHT);
if(lcm_params->type == LCM_TYPE_DSI && lcm_params->dsi.mode == CMD_MODE)
{
DSI_CHECK_RET(DSI_WaitForNotBusy());
LCD_CHECK_RET(LCD_EnableDCtoDsi(FALSE));
}
LCD_Capture_Layerbuffer(dbgopt->layer_index,aligned_buffer,16);
if(lcm_params->type == LCM_TYPE_DSI && lcm_params->dsi.mode == CMD_MODE)
{
LCD_CHECK_RET(LCD_EnableDCtoDsi(TRUE));
}
up(&sem_update_screen);
up(&sem_early_suspend);
up(&sem_flipping);
}
return simple_read_from_buffer(ubuf, count, ppos, (void *)aligned_buffer, DISP_GetScreenWidth()*DISP_GetScreenHeight()*2);
#else
return 0;
#endif
}
DPI_STATUS DPI_Capture_Framebuffer(unsigned int pvbuf, unsigned int bpp)
{
#if 0
unsigned int i = 0;
unsigned char *fbv;
unsigned int fbsize = 0;
unsigned int dpi_fb_bpp = 0;
unsigned int w,h;
BOOL dpi_needPowerOff = FALSE;
if(!s_isDpiPowerOn){
DPI_PowerOn();
dpi_needPowerOff = TRUE;
LCD_WaitForNotBusy();
LCD_WaitDPIIndication(FALSE);
LCD_FBReset();
LCD_StartTransfer(TRUE);
LCD_WaitDPIIndication(TRUE);
}
if(pvbuf == 0 || bpp == 0)
{
DISP_LOG_PRINT(ANDROID_LOG_ERROR, "DPI", "DPI_Capture_Framebuffer, ERROR, parameters wrong: pvbuf=0x%08x, bpp=%d\n", pvbuf, bpp);
return DPI_STATUS_OK;
}
if(DPI_FBGetFormat() == DPI_FB_FORMAT_RGB565)
{
dpi_fb_bpp = 16;
}
else if(DPI_FBGetFormat() == DPI_FB_FORMAT_RGB888)
{
dpi_fb_bpp = 24;
}
else
{
DISP_LOG_PRINT(ANDROID_LOG_ERROR, "DPI", "DPI_Capture_Framebuffer, ERROR, dpi_fb_bpp is wrong: %d\n", dpi_fb_bpp);
return DPI_STATUS_OK;
}
w = DISP_GetScreenWidth();
h = DISP_GetScreenHeight();
fbsize = w*h*dpi_fb_bpp/8;
if(dpi_needPowerOff)
fbv = (unsigned char*)ioremap_cached((unsigned int)DPI_REG->FB[0].ADDR, fbsize);
else
fbv = (unsigned char*)ioremap_cached((unsigned int)DPI_REG->FB[DPI_GetCurrentFB()].ADDR, fbsize);
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DPI", "current fb count is %d\n", DPI_GetCurrentFB());
if(bpp == 32 && dpi_fb_bpp == 24)
{
if(0 == strncmp(MTK_LCM_PHYSICAL_ROTATION, "180", 3)){
unsigned int pix_count = w * h - 1;
for(i = 0;i < w*h; i++)
{
*(unsigned int*)(pvbuf+ (pix_count - i) * 4) = 0xff000000|fbv[i*3]|(fbv[i*3+1]<<8)|(fbv[i*3+2]<<16);
}
}
else{
for(i = 0;i < w*h; i++)
{
*(unsigned int*)(pvbuf+i*4) = 0xff000000|fbv[i*3]|(fbv[i*3+1]<<8)|(fbv[i*3+2]<<16);
}
}
}
else if(bpp == 32 && dpi_fb_bpp == 16)
{
unsigned int t;
unsigned short* fbvt = (unsigned short*)fbv;
if(0 == strncmp(MTK_LCM_PHYSICAL_ROTATION, "180", 3)){
unsigned int pix_count = w * h - 1;
for(i = 0;i < w*h; i++)
{
t = fbvt[i];
*(unsigned int*)(pvbuf+ (pix_count - i) * 4) = 0xff000000|((t&0x001F)<<3)|((t&0x07E0)<<5)|((t&0xF800)<<8);
}
}
else{
for(i = 0;i < w*h; i++)
{
t = fbvt[i];
*(unsigned int*)(pvbuf+i*4) = 0xff000000|((t&0x001F)<<3)|((t&0x07E0)<<5)|((t&0xF800)<<8);
}
}
}
else if(bpp == 16 && dpi_fb_bpp == 16)
{
if(0 == strncmp(MTK_LCM_PHYSICAL_ROTATION, "180", 3)){
unsigned int pix_count = w * h - 1;
unsigned short* fbvt = (unsigned short*)fbv;
for(i = 0;i < w*h; i++)
{
*(unsigned short*)(pvbuf+ (pix_count - i) * 2) = fbvt[i];
}
}
else
memcpy((void*)pvbuf, (void*)fbv, fbsize);
}
else if(bpp == 16 && dpi_fb_bpp == 24)
{
if(0 == strncmp(MTK_LCM_PHYSICAL_ROTATION, "180", 3)){
unsigned int pix_count = w * h - 1;
for(i = 0;i < w*h; i++)
{
*(unsigned short*)(pvbuf+ (pix_count - i) * 2) = ((fbv[i*3+0]&0xF8)>>3)|
((fbv[i*3+1]&0xFC)<<3)|
((fbv[i*3+2]&0xF8)<<8);
}
}
else{
for(i = 0;i < w*h; i++)
static void process_dbg_opt(const char *opt)
{
if (0 == strncmp(opt, "hdmion", 6))
{
// hdmi_force_init();
}
else if (0 == strncmp(opt, "fps:", 4))
{
if (0 == strncmp(opt + 4, "on", 2)) {
dbg_opt.en_fps_log = 1;
} else if (0 == strncmp(opt + 4, "off", 3)) {
dbg_opt.en_fps_log = 0;
} else {
goto Error;
}
reset_fps_logger();
}
else if (0 == strncmp(opt, "tl:", 3))
{
if (0 == strncmp(opt + 3, "on", 2)) {
dbg_opt.en_touch_latency_log = 1;
} else if (0 == strncmp(opt + 3, "off", 3)) {
dbg_opt.en_touch_latency_log = 0;
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "black", 5))
{
mtkfb_clear_lcm();
}
else if (0 == strncmp(opt, "suspend", 4))
{
DISP_PanelEnable(FALSE);
DISP_PowerEnable(FALSE);
}
else if (0 == strncmp(opt, "resume", 4))
{
DISP_PowerEnable(TRUE);
DISP_PanelEnable(TRUE);
}
else if (0 == strncmp(opt, "lcm:", 4))
{
if (0 == strncmp(opt + 4, "on", 2)) {
DISP_PanelEnable(TRUE);
} else if (0 == strncmp(opt + 4, "off", 3)) {
DISP_PanelEnable(FALSE);
}
else if (0 == strncmp(opt + 4, "init", 4)) {
if (NULL != lcm_drv && NULL != lcm_drv->init) {
lcm_drv->init();
}
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "cabc:", 5))
{
if (0 == strncmp(opt + 5, "ui", 2)) {
mtkfb_set_backlight_mode(1);
} else if (0 == strncmp(opt + 5, "mov", 3)) {
mtkfb_set_backlight_mode(3);
} else if (0 == strncmp(opt + 5, "still", 5)) {
mtkfb_set_backlight_mode(2);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "lcd:", 4))
{
if (0 == strncmp(opt + 4, "on", 2)) {
DISP_PowerEnable(TRUE);
} else if (0 == strncmp(opt + 4, "off", 3)) {
DISP_PowerEnable(FALSE);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "vsynclog:", 9))
{
if (0 == strncmp(opt + 9, "on", 2))
{
EnableVSyncLog = 1;
} else if (0 == strncmp(opt + 9, "off", 3))
{
EnableVSyncLog = 0;
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "layer", 5))
{
dump_layer_info();
}
else if (0 == strncmp(opt, "fm_test:", 8))
{
unsigned int ret = 0;
char *p = (char *)opt + 8;
unsigned int level = (unsigned int) simple_strtoul(p, &p, 10);
color = level;
ret = mtkfb_fm_auto_test();
printk("ret = %d, 0x%x\n", ret,color);
}
else if (0 == strncmp(opt, "regw:", 5))
{
char *p = (char *)opt + 5;
unsigned long addr = simple_strtoul(p, &p, 16);
unsigned long val = simple_strtoul(p + 1, &p, 16);
if (addr) {
OUTREG32(addr, val);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "regr:", 5))
{
char *p = (char *)opt + 5;
unsigned int addr = (unsigned int) simple_strtoul(p, &p, 16);
if (addr) {
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DBG", "Read register 0x%08x: 0x%08x\n", addr, INREG32(addr));
} else {
goto Error;
}
}
else if(0 == strncmp(opt, "bkl:", 4))
{
char *p = (char *)opt + 4;
unsigned int level = (unsigned int) simple_strtoul(p, &p, 10);
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DBG", "process_dbg_opt(), set backlight level = %d\n", level);
DISP_SetBacklight(level);
}
else if(0 == strncmp(opt, "dither:", 7))
{
unsigned lrs, lgs, lbs, dbr, dbg, dbb;
char *p = (char *)opt + 7;
lrs = (unsigned int) simple_strtoul(p, &p, 16);
p++;
lgs = (unsigned int) simple_strtoul(p, &p, 16);
p++;
lbs = (unsigned int) simple_strtoul(p, &p, 16);
p++;
dbr = (unsigned int) simple_strtoul(p, &p, 16);
p++;
dbg = (unsigned int) simple_strtoul(p, &p, 16);
p++;
dbb = (unsigned int) simple_strtoul(p, &p, 16);
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DBG", "process_dbg_opt(), %d %d %d %d %d %d\n", lrs, lgs, lbs, dbr, dbg, dbb);
}
else if (0 == strncmp(opt, "mtkfblog:", 9))
{
if (0 == strncmp(opt + 9, "on", 2)) {
mtkfb_log_enable(true);
} else if (0 == strncmp(opt + 9, "off", 3)) {
mtkfb_log_enable(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "displog:", 8))
{
if (0 == strncmp(opt + 8, "on", 2)) {
disp_log_enable(true);
} else if (0 == strncmp(opt + 8, "off", 3)) {
disp_log_enable(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "mtkfb_vsynclog:", 15))
{
if (0 == strncmp(opt + 15, "on", 2)) {
mtkfb_vsync_log_enable(true);
} else if (0 == strncmp(opt + 15, "off", 3)) {
mtkfb_vsync_log_enable(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "log:", 4))
{
if (0 == strncmp(opt + 4, "on", 2)) {
mtkfb_log_enable(true);
disp_log_enable(true);
} else if (0 == strncmp(opt + 4, "off", 3)) {
mtkfb_log_enable(false);
disp_log_enable(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "update", 6))
{
DISP_UpdateScreen(0, 0, DISP_GetScreenWidth(), DISP_GetScreenHeight());
}
else if (0 == strncmp(opt, "pan_disp", 8))
{
mtkfb_pan_disp_test();
}
else if (0 == strncmp(opt, "sem_cnt", 7))
{
mtkfb_show_sem_cnt();
}
else if (0 == strncmp(opt, "hang:", 5))
{
if (0 == strncmp(opt + 5, "on", 2)) {
mtkfb_hang_test(true);
} else if (0 == strncmp(opt + 5, "off", 3)) {
mtkfb_hang_test(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "cpfbonly:", 9))
{
if (0 == strncmp(opt + 9, "on", 2))
{
mtkfb_capture_fb_only(true);
}
else if (0 == strncmp(opt + 9, "off", 3))
{
mtkfb_capture_fb_only(false);
}
}
else if (0 == strncmp(opt, "esd:", 4))
{
if (0 == strncmp(opt + 4, "on", 2))
{
esd_recovery_pause(FALSE);
}
else if (0 == strncmp(opt + 4, "off", 3))
{
esd_recovery_pause(TRUE);
}
}
else if (0 == strncmp(opt, "HQA:", 4))
{
if (0 == strncmp(opt + 4, "NormalToFactory", 15))
{
mtkfb_switch_normal_to_factory();
}
else if (0 == strncmp(opt + 4, "FactoryToNormal", 15))
{
mtkfb_switch_factory_to_normal();
}
}
else if (0 == strncmp(opt, "mmp", 3))
{
init_mtkfb_mmp_events();
}
else if (0 == strncmp(opt, "dump_layer:", 11))
{
if (0 == strncmp(opt + 11, "on", 2))
{
char *p = (char *)opt + 14;
gCaptureLayerDownX = simple_strtoul(p, &p, 10);
gCaptureLayerDownY = simple_strtoul(p+1, &p, 10);
gCaptureLayerEnable = 1;
gCaptureLayerRawData = 0;
}
else if (0 == strncmp(opt + 11, "raw", 3))
{
gCaptureLayerDownX = 1;
gCaptureLayerDownY = 1;
gCaptureLayerEnable = 1;
gCaptureLayerRawData = 1;
}
else if (0 == strncmp(opt + 11, "off", 3))
{
gCaptureLayerEnable = 0;
gCaptureLayerRawData = 0;
}
}
else if (0 == strncmp(opt, "dump_ovl:", 9))
{
if (0 == strncmp(opt + 9, "on", 2))
{
char *p = (char *)opt + 12;
gCaptureOvlDownX = simple_strtoul(p, &p, 10);
gCaptureOvlDownY = simple_strtoul(p+1, &p, 10);
gCaptureOvlEnable = 1;
gCaptureOvlRawData = 0;
}
else if (0 == strncmp(opt + 9, "raw", 3))
{
gCaptureOvlDownX = 1;
gCaptureOvlDownY = 1;
gCaptureOvlEnable = 1;
gCaptureOvlRawData = 1;
}
else if (0 == strncmp(opt + 9, "off", 3))
{
gCaptureOvlEnable = 0;
gCaptureOvlRawData = 0;
}
}
else if (0 == strncmp(opt, "dump_fb:", 8))
{
if (0 == strncmp(opt + 8, "on", 2))
{
char *p = (char *)opt + 11;
gCaptureFBDownX = simple_strtoul(p, &p, 10);
gCaptureFBDownY = simple_strtoul(p+1, &p, 10);
gCaptureFBEnable = 1;
gCaptureFBRawData = 0;
}
else if (0 == strncmp(opt + 8, "raw", 3))
{
gCaptureFBDownX = 1;
gCaptureFBDownY = 1;
gCaptureFBEnable = 1;
gCaptureFBRawData = 1;
}
else if (0 == strncmp(opt + 8, "off", 3))
{
gCaptureFBEnable = 0;
gCaptureFBRawData = 0;
}
}
else if (0 == strncmp(opt, "decouple:", 9))
{
if (0 == strncmp(opt + 9, "on", 2))
{
struct fb_overlay_mode mode;
mode.mode = DISP_DECOUPLE_MODE;
DISP_SwitchDisplayMode(&mode);
}
else if (0 == strncmp(opt + 9, "off", 3))
{
struct fb_overlay_mode mode;
mode.mode = DISP_DIRECT_LINK_MODE;
DISP_SwitchDisplayMode(&mode);
}
}
else
{
if (disphal_process_dbg_opt(opt))
goto Error;
}
return;
Error:
DISP_LOG_PRINT(ANDROID_LOG_INFO, "ERROR", "parse command error!\n\n%s", STR_HELP);
}
static irqreturn_t _DPI_InterruptHandler(int irq, void *dev_id)
{
static int counter = 0;
DPI_REG_INTERRUPT status = DPI_REG->INT_STATUS;
// if (status.FIFO_EMPTY) ++ counter;
if(status.VSYNC)
{
if(dpiIntCallback)
dpiIntCallback(DISP_DPI_VSYNC_INT);
#ifndef BUILD_UBOOT
if(atomic_read(&wait_dpi_vsync)){
if(-1 != hrtimer_try_to_cancel(&hrtimer_vsync_dpi)){
atomic_set(&wait_dpi_vsync, 0);
atomic_set(&dpi_vsync, 1);
wake_up_interruptible(&_vsync_wait_queue_dpi);
hrtimer_start(&hrtimer_vsync_dpi, ktime_set(0, VSYNC_US_TO_NS(vsync_timer_dpi)), HRTIMER_MODE_REL);
}
}
#endif
}
if (status.VSYNC && counter) {
DISP_LOG_PRINT(ANDROID_LOG_ERROR, "DPI", "[Error] DPI FIFO is empty, "
"received %d times interrupt !!!\n", counter);
counter = 0;
}
if (status.FIFO_EMPTY)
{
int need_reset = 0;
unsigned long long temp = sched_clock();
unsigned int debug_while_loop_cnt = 0;
volatile unsigned int dsi_state = INREG32(DSI_BASE+0x154);
if((dsi_state & 0x1ff) == 0x80)
{
auto_sync_reset_count++;
if(auto_sync_reset_count == 10)
{
auto_sync_reset_count = 0;
need_reset = 2;
}
}
else
{
auto_sync_reset_count = 0;
}
//printk("gmce,0x%08x, %d\n",(INREG32(DSI_BASE+0x154))&0x1ff, (unsigned int)(temp - last_fifo_empty_stamp));
if(_fifo_empty_monitor_insert((unsigned int)(temp - last_fifo_empty_stamp)))
{
need_reset = 1;
}
last_fifo_empty_stamp = temp;
if(need_reset)
{
unsigned int mode, suspend;
mode = DSI_GetMode();
suspend = DISP_GetSuspendMode();
if ((mode != CMD_MODE) && !suspend)
{
DPI_DisableClk();
#if 0
while(1)
{
debug_while_loop_cnt++;
dsi_state = INREG32(DSI_BASE+0x154);
if((dsi_state &0x1ff) == 0x100) break;
if(debug_while_loop_cnt > 0x1000000)
{
printk("FATAL Error!! dsi in vact when dpi fifo empty, and can't into vfp until 0x100000 loops!!\n");
}
}
#endif
DSI_clk_HS_mode(0);
DSI_SetMode(CMD_MODE);
DSI_Reset();
DSI_SetMode(SYNC_PULSE_VDO_MODE);
DSI_clk_HS_mode(1);
DPI_EnableClk();
DSI_EnableClk();
}
printk("[DSI/DPI]reset[%d] mode[%d], suspend[%d]\n", need_reset, mode, suspend);
need_reset = 0;
}
}
_DPI_LogRefreshRate(status);
OUTREG32(&DPI_REG->INT_STATUS, 0);
return IRQ_HANDLED;
}
static void process_dbg_opt(const char *opt)
{
if (0 == strncmp(opt, "stop_trigger_loop", 17))
{
_cmdq_stop_trigger_loop();
return;
}
else if (0 == strncmp(opt, "start_trigger_loop", 18))
{
_cmdq_start_trigger_loop();
return;
}
else if (0 == strncmp(opt, "cmdqregw:", 9))
{
char *p = (char *)opt + 9;
unsigned int addr = simple_strtoul(p, &p, 16);
unsigned int val = simple_strtoul(p + 1, &p, 16);
if (addr) {
primary_display_cmdq_set_reg(addr, val);
} else {
return;
}
}
else if (0 == strncmp(opt, "idle_switch_DC", 14))
{
if (0 == strncmp(opt + 14, "on", 2))
{
enable_screen_idle_switch_decouple();
printk("enable screen_idle_switch_decouple\n");
}
else if (0 == strncmp(opt + 14, "off", 3))
{
disable_screen_idle_switch_decouple();
printk("disable screen_idle_switch_decouple\n");
}
}
else if (0 == strncmp(opt, "shortpath", 9))
{
char *p = (char *)opt + 10;
int s = simple_strtoul(p, &p, 10);
DISPMSG("will %s use shorter decouple path\n", s?"":"not");
disp_helper_set_option(DISP_HELPER_OPTION_TWO_PIPE_INTERFACE_PATH, s);
}
else if (0 == strncmp(opt, "helper", 6))
{
char *p = (char *)opt + 7;
int option = simple_strtoul(p, &p, 10);
int value = simple_strtoul(p + 1, &p, 10);
DISPMSG("will set option %d to %d\n", option, value);
disp_helper_set_option(option, value);
}
else if (0 == strncmp(opt, "dc565", 5))
{
char *p = (char *)opt + 6;
int s = simple_strtoul(p, &p, 10);
DISPMSG("will %s use RGB565 decouple path\n", s?"":"not");
disp_helper_set_option(DISP_HELPER_OPTION_DECOUPLE_MODE_USE_RGB565, s);
}
else if (0 == strncmp(opt, "switch_mode:", 12))
{
int session_id = MAKE_DISP_SESSION(DISP_SESSION_PRIMARY,0);
char *p = (char *)opt + 12;
unsigned long sess_mode = simple_strtoul(p, &p, 10);
primary_display_switch_mode(sess_mode, session_id, 1);
}
else if (0 == strncmp(opt, "dsipattern", 10))
{
char *p = (char *)opt + 11;
unsigned int pattern = (unsigned int) simple_strtoul(p, &p, 16);
if (pattern)
{
DSI_BIST_Pattern_Test(DISP_MODULE_DSI0,NULL,true,pattern);
DISPMSG("enable dsi pattern: 0x%08x\n", pattern);
}
else
{
primary_display_manual_lock();
DSI_BIST_Pattern_Test(DISP_MODULE_DSI0,NULL,false,0);
primary_display_manual_unlock();
return;
}
}
else if (0 == strncmp(opt, "rdma_color:", 11))
{
printk("zeng: rdma_color\n");
if (0 == strncmp(opt + 11, "on", 2))
{
printk("zeng:rdma_color on\n");
char *p = (char *)opt + 14;
unsigned int red = simple_strtoul(p, &p, 10);
unsigned int green = simple_strtoul(p + 1, &p, 10);
unsigned int blue = simple_strtoul(p + 1, &p, 10);
rdma_color_matrix matrix = {0};
rdma_color_pre pre = {0};
rdma_color_post post = {255, 0, 0};
post.ADD0 = red;
post.ADD1 = green;
post.ADD2 = blue;
rdma_set_color_matrix(DISP_MODULE_RDMA0, &matrix, &pre, &post);
rdma_enable_color_transform(DISP_MODULE_RDMA0);
}
else if (0 == strncmp(opt + 11, "off", 3))
{
printk("zeng:rdma_color off\n");
rdma_disable_color_transform(DISP_MODULE_RDMA0);
}
}
else if (0 == strncmp(opt, "diagnose", 8))
{
primary_display_diagnose();
return;
}
else if (0 == strncmp(opt, "_efuse_test", 11))
{
primary_display_check_test();
}
else if (0 == strncmp(opt, "dprec_reset", 11))
{
dprec_logger_reset_all();
return;
}
else if (0 == strncmp(opt, "suspend", 4))
{
primary_display_suspend();
return;
}
else if (0 == strncmp(opt, "ata",3))
{
mtkfb_fm_auto_test();
return;
}
else if (0 == strncmp(opt, "resume", 4))
{
primary_display_resume();
}
else if (0 == strncmp(opt, "dalprintf", 9))
{
DAL_Printf("display aee layer test\n");
}
else if (0 == strncmp(opt, "dalclean", 8))
{
DAL_Clean();
}
else if(0 == strncmp(opt, "lfr_setting:",12))
{
char *p = (char *)opt + 12;
unsigned int enable = (unsigned int) simple_strtoul(p, &p, 12);
unsigned int mode = (unsigned int)simple_strtoul(p+1, &p, 12);
LCM_PARAMS lcm_param;
//unsigned int mode=3;
unsigned int type=0;
unsigned int skip_num = 1;
printk("--------------enable/disable lfr--------------\n");
if (enable)
{
printk("lfr enable %d mode =%d\n",enable,mode);
enable=1;
DSI_Set_LFR(DISP_MODULE_DSI0, NULL,mode,type,enable,skip_num);
}else{
printk("lfr disable %d mode=%d\n",enable,mode);
enable=0;
DSI_Set_LFR(DISP_MODULE_DSI0, NULL,mode,type,enable,skip_num);
}
}
else if(0 == strncmp(opt, "vsync_switch:",13))
{
char *p = (char *)opt + 13;
unsigned int method = 0;
method =(unsigned int) simple_strtoul(p, &p, 13);
primary_display_vsync_switch(method);
}
else if (0 == strncmp(opt, "DP", 2))
{
char *p = (char *)opt + 3;
unsigned int pattern = (unsigned int) simple_strtoul(p, &p, 16);
g_display_debug_pattern_index = pattern;
return;
}
else if(0==strncmp(opt,"dsi0_clk:",9))
{
char*p=(char*)opt+9;
UINT32 clk=simple_strtoul(p, &p, 10);
// DSI_ChangeClk(DISP_MODULE_DSI0,clk);
}
else if (0 == strncmp(opt, "diagnose", 8))
{
primary_display_diagnose();
return;
}
else if (0 == strncmp(opt, "switch:", 7))
{
char*p=(char*)opt+7;
UINT32 mode=simple_strtoul(p, &p, 10);
primary_display_switch_dst_mode(mode%2);
return;
}
else if (0 == strncmp(opt, "regw:", 5))
{
char *p = (char *)opt + 5;
unsigned long addr = simple_strtoul(p, &p, 16);
unsigned long val = simple_strtoul(p + 1, &p, 16);
if (addr) {
OUTREG32(addr, val);
} else {
return;
}
}
else if (0 == strncmp(opt, "regr:", 5))
{
char *p = (char *)opt + 5;
unsigned long addr = (unsigned int) simple_strtoul(p, &p, 16);
if (addr) {
printk("Read register 0x%lx: 0x%08x\n", addr, INREG32(addr));
} else {
return;
}
}
else if (0 == strncmp(opt, "cmmva_dprec", 11))
{
dprec_handle_option(0x7);
}
else if (0 == strncmp(opt, "cmmpa_dprec", 11))
{
dprec_handle_option(0x3);
}
else if (0 == strncmp(opt, "dprec", 5))
{
char *p = (char *)opt + 6;
unsigned int option = (unsigned int) simple_strtoul(p, &p, 16);
dprec_handle_option(option);
}
else if (0 == strncmp(opt, "cmdq", 4))
{
char *p = (char *)opt + 5;
unsigned int option = (unsigned int) simple_strtoul(p, &p, 16);
if(option)
primary_display_switch_cmdq_cpu(CMDQ_ENABLE);
else
primary_display_switch_cmdq_cpu(CMDQ_DISABLE);
}
else if (0 == strncmp(opt, "maxlayer", 8))
{
char *p = (char *)opt + 9;
unsigned int maxlayer = (unsigned int) simple_strtoul(p, &p, 10);
if(maxlayer)
primary_display_set_max_layer(maxlayer);
else
DISPERR("can't set max layer to 0\n");
}
else if (0 == strncmp(opt, "primary_reset", 13))
{
primary_display_reset();
}
else if(0 == strncmp(opt, "esd_check", 9))
{
char *p = (char *)opt + 10;
unsigned int enable = (unsigned int) simple_strtoul(p, &p, 10);
primary_display_esd_check_enable(enable);
}
else if(0 == strncmp(opt, "esd_recovery", 12))
{
primary_display_esd_recovery();
}
else if(0 == strncmp(opt, "lcm0_reset", 10))
{
#if 1
DISP_CPU_REG_SET(DISPSYS_CONFIG_BASE+0x150, 1);
msleep(10);
DISP_CPU_REG_SET(DISPSYS_CONFIG_BASE+0x150, 0);
msleep(10);
DISP_CPU_REG_SET(DISPSYS_CONFIG_BASE+0x150, 1);
#else
#if 0
mt_set_gpio_mode(GPIO106|0x80000000, GPIO_MODE_00);
mt_set_gpio_dir(GPIO106|0x80000000, GPIO_DIR_OUT);
mt_set_gpio_out(GPIO106|0x80000000, GPIO_OUT_ONE);
msleep(10);
mt_set_gpio_out(GPIO106|0x80000000, GPIO_OUT_ZERO);
msleep(10);
mt_set_gpio_out(GPIO106|0x80000000, GPIO_OUT_ONE);
#endif
#endif
}
else if(0 == strncmp(opt, "lcm0_reset0", 11))
{
DISP_CPU_REG_SET(DDP_REG_BASE_MMSYS_CONFIG+0x150,0);
}
else if(0 == strncmp(opt, "lcm0_reset1", 11))
{
DISP_CPU_REG_SET(DDP_REG_BASE_MMSYS_CONFIG+0x150,1);
}
else if (0 == strncmp(opt, "cg", 2))
{
char *p = (char *)opt + 2;
unsigned int enable = (unsigned int) simple_strtoul(p, &p, 10);
primary_display_enable_path_cg(enable);
}
else if (0 == strncmp(opt, "ovl2mem:", 8))
{
if (0 == strncmp(opt + 8, "on", 2))
switch_ovl1_to_mem(true);
else
switch_ovl1_to_mem(false);
}
else if (0 == strncmp(opt, "dump_layer:", 11))
{
if (0 == strncmp(opt + 11, "on", 2))
{
char *p = (char *)opt + 14;
gCapturePriLayerDownX = simple_strtoul(p, &p, 10);
gCapturePriLayerDownY = simple_strtoul(p+1, &p, 10);
gCapturePriLayerNum= simple_strtoul(p+1, &p, 10);
gCapturePriLayerEnable = 1;
gCaptureWdmaLayerEnable = 1;
if(gCapturePriLayerDownX==0)
gCapturePriLayerDownX = 20;
if(gCapturePriLayerDownY==0)
gCapturePriLayerDownY = 20;
printk("dump_layer En %d DownX %d DownY %d,Num %d",gCapturePriLayerEnable,gCapturePriLayerDownX,gCapturePriLayerDownY,gCapturePriLayerNum);
}
else if (0 == strncmp(opt + 11, "off", 3))
{
gCapturePriLayerEnable = 0;
gCaptureWdmaLayerEnable = 0;
gCapturePriLayerNum = OVL_LAYER_NUM;
printk("dump_layer En %d\n",gCapturePriLayerEnable);
}
}
#ifdef MTK_TODO
#error
if (0 == strncmp(opt, "hdmion", 6))
{
// hdmi_force_init();
}
else if (0 == strncmp(opt, "fps:", 4))
{
if (0 == strncmp(opt + 4, "on", 2)) {
dbg_opt.en_fps_log = 1;
} else if (0 == strncmp(opt + 4, "off", 3)) {
dbg_opt.en_fps_log = 0;
} else {
goto Error;
}
reset_fps_logger();
}
else if (0 == strncmp(opt, "tl:", 3))
{
if (0 == strncmp(opt + 3, "on", 2)) {
dbg_opt.en_touch_latency_log = 1;
} else if (0 == strncmp(opt + 3, "off", 3)) {
dbg_opt.en_touch_latency_log = 0;
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "black", 5))
{
mtkfb_clear_lcm();
}
else if (0 == strncmp(opt, "suspend", 4))
{
DISP_PanelEnable(FALSE);
DISP_PowerEnable(FALSE);
}
else if (0 == strncmp(opt, "resume", 4))
{
DISP_PowerEnable(TRUE);
DISP_PanelEnable(TRUE);
}
else if (0 == strncmp(opt, "lcm:", 4))
{
if (0 == strncmp(opt + 4, "on", 2)) {
DISP_PanelEnable(TRUE);
} else if (0 == strncmp(opt + 4, "off", 3)) {
DISP_PanelEnable(FALSE);
}
else if (0 == strncmp(opt + 4, "init", 4)) {
if (NULL != lcm_drv && NULL != lcm_drv->init) {
lcm_drv->init();
}
}else {
goto Error;
}
}
else if (0 == strncmp(opt, "cabc:", 5))
{
if (0 == strncmp(opt + 5, "ui", 2)) {
mtkfb_set_backlight_mode(1);
}else if (0 == strncmp(opt + 5, "mov", 3)) {
mtkfb_set_backlight_mode(3);
}else if (0 == strncmp(opt + 5, "still", 5)) {
mtkfb_set_backlight_mode(2);
}else {
goto Error;
}
}
else if (0 == strncmp(opt, "lcd:", 4))
{
if (0 == strncmp(opt + 4, "on", 2)) {
DISP_PowerEnable(TRUE);
} else if (0 == strncmp(opt + 4, "off", 3)) {
DISP_PowerEnable(FALSE);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "vsynclog:", 9))
{
if (0 == strncmp(opt + 9, "on", 2))
{
EnableVSyncLog = 1;
} else if (0 == strncmp(opt + 9, "off", 3))
{
EnableVSyncLog = 0;
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "layer", 5))
{
dump_layer_info();
}
else if (0 == strncmp(opt, "regw:", 5))
{
char *p = (char *)opt + 5;
unsigned long addr = simple_strtoul(p, &p, 16);
unsigned long val = simple_strtoul(p + 1, &p, 16);
if (addr) {
OUTREG32(addr, val);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "regr:", 5))
{
char *p = (char *)opt + 5;
unsigned int addr = (unsigned int) simple_strtoul(p, &p, 16);
if (addr) {
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DBG", "Read register 0x%08x: 0x%08x\n", addr, INREG32(addr));
} else {
goto Error;
}
}
else if(0 == strncmp(opt, "bkl:", 4))
{
char *p = (char *)opt + 4;
unsigned int level = (unsigned int) simple_strtoul(p, &p, 10);
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DBG", "process_dbg_opt(), set backlight level = %d\n", level);
DISP_SetBacklight(level);
}
else if(0 == strncmp(opt, "dither:", 7))
{
unsigned lrs, lgs, lbs, dbr, dbg, dbb;
char *p = (char *)opt + 7;
lrs = (unsigned int) simple_strtoul(p, &p, 16);
p++;
lgs = (unsigned int) simple_strtoul(p, &p, 16);
p++;
lbs = (unsigned int) simple_strtoul(p, &p, 16);
p++;
dbr = (unsigned int) simple_strtoul(p, &p, 16);
p++;
dbg = (unsigned int) simple_strtoul(p, &p, 16);
p++;
dbb = (unsigned int) simple_strtoul(p, &p, 16);
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DBG", "process_dbg_opt(), %d %d %d %d %d %d\n", lrs, lgs, lbs, dbr, dbg, dbb);
}
else if (0 == strncmp(opt, "mtkfblog:", 9))
{
if (0 == strncmp(opt + 9, "on", 2)) {
mtkfb_log_enable(true);
} else if (0 == strncmp(opt + 9, "off", 3)) {
mtkfb_log_enable(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "displog:", 8))
{
if (0 == strncmp(opt + 8, "on", 2)) {
disp_log_enable(true);
} else if (0 == strncmp(opt + 8, "off", 3)) {
disp_log_enable(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "mtkfb_vsynclog:", 15))
{
if (0 == strncmp(opt + 15, "on", 2)) {
mtkfb_vsync_log_enable(true);
} else if (0 == strncmp(opt + 15, "off", 3)) {
mtkfb_vsync_log_enable(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "log:", 4))
{
if (0 == strncmp(opt + 4, "on", 2)) {
mtkfb_log_enable(true);
disp_log_enable(true);
} else if (0 == strncmp(opt + 4, "off", 3)) {
mtkfb_log_enable(false);
disp_log_enable(false);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "update", 6))
{
DISP_UpdateScreen(0, 0, DISP_GetScreenWidth(), DISP_GetScreenHeight());
}
else if (0 == strncmp(opt, "pan_disp", 8))
{
mtkfb_pan_disp_test();
}
else if (0 == strncmp(opt, "sem_cnt", 7))
{
mtkfb_show_sem_cnt();
}
else if (0 == strncmp(opt, "hang:", 5))
{
if (0 == strncmp(opt + 5, "on", 2)) {
mtkfb_hang_test(true);
} else if (0 == strncmp(opt + 5, "off", 3)) {
mtkfb_hang_test(false);
} else{
goto Error;
}
}
else if (0 == strncmp(opt, "cpfbonly:", 9))
{
if (0 == strncmp(opt + 9, "on", 2))
{
mtkfb_capture_fb_only(true);
}
else if (0 == strncmp(opt + 9, "off", 3))
{
mtkfb_capture_fb_only(false);
}
}
else if (0 == strncmp(opt, "esd:", 4))
{
if (0 == strncmp(opt + 4, "on", 2))
{
esd_recovery_pause(FALSE);
}
else if (0 == strncmp(opt + 4, "off", 3))
{
esd_recovery_pause(TRUE);
}
}
else if (0 == strncmp(opt, "HQA:", 4))
{
if (0 == strncmp(opt + 4, "NormalToFactory", 15))
{
mtkfb_switch_normal_to_factory();
}
else if (0 == strncmp(opt + 4, "FactoryToNormal", 15))
{
mtkfb_switch_factory_to_normal();
}
}
else if (0 == strncmp(opt, "mmp", 3))
{
init_mtkfb_mmp_events();
}
else if (0 == strncmp(opt, "dump_ovl:", 9))
{
if (0 == strncmp(opt + 9, "on", 2))
{
char *p = (char *)opt + 12;
gCaptureOvlDownX = simple_strtoul(p, &p, 10);
gCaptureOvlDownY = simple_strtoul(p+1, &p, 10);
gCaptureOvlThreadEnable = 1;
wake_up_process(captureovl_task);
}
else if (0 == strncmp(opt + 9, "off", 3))
{
gCaptureOvlThreadEnable = 0;
}
}
else if (0 == strncmp(opt, "dump_fb:", 8))
{
if (0 == strncmp(opt + 8, "on", 2))
{
char *p = (char *)opt + 11;
gCaptureFBDownX = simple_strtoul(p, &p, 10);
gCaptureFBDownY = simple_strtoul(p+1, &p, 10);
gCaptureFBPeriod = simple_strtoul(p+1, &p, 10);
gCaptureFBEnable = 1;
wake_up_interruptible(&gCaptureFBWQ);
}
else if (0 == strncmp(opt + 8, "off", 3))
{
gCaptureFBEnable = 0;
}
}
else
{
if (disphal_process_dbg_opt(opt))
goto Error;
}
return;
Error:
DISP_LOG_PRINT(ANDROID_LOG_INFO, "ERROR", "parse command error!\n\n%s", STR_HELP);
#endif
}
void switch_ovl1_to_mem(bool on)
{
enable_ovl1_to_mem = on;
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DBG", "switch_ovl1_to_mem %d\n", enable_ovl1_to_mem);
}
DAL_STATUS DAL_Clean(void)
{
const UINT32 BG_COLOR = MAKE_TWO_RGB565_COLOR(DAL_BG_COLOR, DAL_BG_COLOR);
DAL_STATUS ret = DAL_STATUS_OK;
UINT32 i, *ptr;
static int dal_clean_cnt = 0;
printk("[MTKFB_DAL] DAL_Clean\n");
if (NULL == mfc_handle)
return DAL_STATUS_NOT_READY;
// if (LCD_STATE_POWER_OFF == LCD_GetState())
// return DAL_STATUS_LCD_IN_SUSPEND;
DAL_LOCK();
DAL_CHECK_MFC_RET(MFC_ResetCursor(mfc_handle));
ptr = (UINT32 *)dal_fb_addr;
for(i = 0; i < DAL_GetLayerSize() / sizeof(UINT32); ++ i) {
*ptr ++ = BG_COLOR;
}
/*
if (LCD_STATE_POWER_OFF == LCD_GetState()) {
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DAL", "dal_clean in power off\n");
dal_disable_when_resume = TRUE;
ret = DAL_STATUS_LCD_IN_SUSPEND;
goto End;
}
*/
if (down_interruptible(&sem_early_suspend)) {
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DAL", "can't get semaphore in DAL_Clean()\n");
goto End;
}
//xuecheng, for debug
#if 0
if(is_early_suspended){
up(&sem_early_suspend);
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DAL", "dal_clean in power off\n");
goto End;
}
#endif
up(&sem_early_suspend);
mutex_lock(&OverlaySettingMutex);
//TODO: if dal_shown=false, and 3D enabled, mtkfb may disable UI layer, please modify 3D driver
if(isAEEEnabled==1)
{
DAL_CHECK_LCD_RET(LCD_LayerEnable(ASSERT_LAYER, FALSE));
// DAL disable, switch UI layer to default layer 3
printk("[DDP]* isAEEEnabled from 1 to 0, %d \n", dal_clean_cnt++);
isAEEEnabled = 0;
DAL_CHECK_LCD_RET(LCD_Dynamic_Change_FB_Layer(isAEEEnabled)); // restore UI layer to DEFAULT_UI_LAYER
}
dal_shown = FALSE;
#ifdef DAL_LOWMEMORY_ASSERT
if (dal_lowMemory_shown) {//only need show lowmemory assert
UINT32 LOWMEMORY_FG_COLOR = MAKE_TWO_RGB565_COLOR(DAL_LOWMEMORY_FG_COLOR, DAL_LOWMEMORY_FG_COLOR);
UINT32 LOWMEMORY_BG_COLOR = MAKE_TWO_RGB565_COLOR(DAL_LOWMEMORY_BG_COLOR, DAL_LOWMEMORY_BG_COLOR);
DAL_CHECK_MFC_RET(MFC_LowMemory_Printf(mfc_handle, low_memory_msg, LOWMEMORY_FG_COLOR, LOWMEMORY_BG_COLOR));
Show_LowMemory();
}
dal_enable_when_resume_lowmemory = FALSE;
dal_disable_when_resume_lowmemory = FALSE;
#endif
dal_disable_when_resume = FALSE;
atomic_set(&OverlaySettingDirtyFlag, 1);
atomic_set(&OverlaySettingApplied, 0);
mutex_unlock(&OverlaySettingMutex);
DAL_CHECK_DISP_RET(DISP_UpdateScreen(0, 0,
DAL_WIDTH,
DAL_HEIGHT));
End:
DAL_UNLOCK();
return ret;
}
DAL_STATUS DAL_Printf(const char *fmt, ...)
{
va_list args;
uint i;
DAL_STATUS ret = DAL_STATUS_OK;
//printk("[MTKFB_DAL] DAL_Printf mfc_handle=0x%08X, fmt=0x%08X\n", mfc_handle, fmt);
if (NULL == mfc_handle)
return DAL_STATUS_NOT_READY;
if (NULL == fmt)
return DAL_STATUS_INVALID_ARGUMENT;
DAL_LOCK();
va_start (args, fmt);
i = vsprintf(dal_print_buffer, fmt, args);
BUG_ON(i>=ARRAY_SIZE(dal_print_buffer));
va_end (args);
DAL_CHECK_MFC_RET(MFC_Print(mfc_handle, dal_print_buffer));
flush_cache_all();
/*
if (LCD_STATE_POWER_OFF == LCD_GetState()) {
ret = DAL_STATUS_LCD_IN_SUSPEND;
dal_enable_when_resume = TRUE;
goto End;
}
*/
if (down_interruptible(&sem_early_suspend)) {
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DAL", "can't get semaphore in DAL_Printf()\n");
goto End;
}
#if 0
if(is_early_suspended){
up(&sem_early_suspend);
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DAL", "DAL_Printf in power off\n");
goto End;
}
#endif
up(&sem_early_suspend);
mutex_lock(&OverlaySettingMutex);
if (!dal_shown) {
dal_shown = TRUE;
}
//DAL enable, switch ui layer from default 3 to 2
if(isAEEEnabled==0)
{
printk("[DDP] isAEEEnabled from 0 to 1, ASSERT_LAYER=%d, dal_fb_pa %x\n",
ASSERT_LAYER, dal_fb_pa);
isAEEEnabled = 1;
DAL_CHECK_LCD_RET(LCD_Dynamic_Change_FB_Layer(isAEEEnabled)); // default_ui_ layer coniig to changed_ui_layer
DAL_CHECK_MFC_RET(MFC_Open(&mfc_handle, dal_fb_addr,
DAL_WIDTH, DAL_HEIGHT, DAL_BPP,
DAL_FG_COLOR, DAL_BG_COLOR));
//DAL_Clean();
DAL_CHECK_LCD_RET(LCD_LayerSetAddress(ASSERT_LAYER, dal_fb_pa));
DAL_CHECK_LCD_RET(LCD_LayerSetAlphaBlending(ASSERT_LAYER, TRUE, 0x80));
DAL_CHECK_LCD_RET(LCD_LayerSetPitch(ASSERT_LAYER, DAL_WIDTH * DAL_BPP));
cached_layer_config[ASSERT_LAYER].fmt= DAL_FORMAT;
cached_layer_config[ASSERT_LAYER].src_x = 0;
cached_layer_config[ASSERT_LAYER].src_y = 0;
cached_layer_config[ASSERT_LAYER].src_w = DAL_WIDTH;
cached_layer_config[ASSERT_LAYER].src_h = DAL_HEIGHT;
cached_layer_config[ASSERT_LAYER].dst_x = 0;
cached_layer_config[ASSERT_LAYER].dst_y = 0;
cached_layer_config[ASSERT_LAYER].dst_w = DAL_WIDTH;
cached_layer_config[ASSERT_LAYER].dst_h = DAL_HEIGHT;
DAL_CHECK_LCD_RET(LCD_LayerEnable(ASSERT_LAYER, TRUE));
printk("after AEE config LCD layer 3: \n");
LCD_Dump_Layer_Info();
}
atomic_set(&OverlaySettingDirtyFlag, 1);
atomic_set(&OverlaySettingApplied, 0);
mutex_unlock(&OverlaySettingMutex);
DAL_CHECK_DISP_RET(DISP_UpdateScreen(0, 0,
DAL_WIDTH,
DAL_HEIGHT));
End:
DAL_UNLOCK();
return ret;
}
DPI_STATUS DPI1_Init(BOOL isDpiPoweredOn)
{
//DPI1_REG_CNTL cntl;
//DPI1_REG_EMBSYNC_SETTING embsync;
if (isDpiPoweredOn) {
_BackupDPIRegisters();
} else {
_ResetBackupedDPIRegisterValues();
}
DPI1_PowerOn();
#if 0
OUTREG32(DPI1_BASE+ 0x64, 0x400);//
OUTREG32(DPI1_BASE+ 0x6C, 0x400);//
OUTREG32(DPI1_BASE+ 0x74, 0x400);//
OUTREG32(DPI1_BASE+ 0x8C, 0x0FFF0000);//
OUTREG32(DPI1_BASE+ 0x90, 0x0FFF0000);//
MASKREG32(DISPSYS_BASE + 0x60, 0x1, 0x1); // [1]: DPI0_I2X_EN
// 0: DPI0 IO is single edge mode
//1: DPI0 IO is dual edge mode
#endif
MASKREG32(DISPSYS_BASE + 0x60, 0xb03, 0xb03);
//OUTREG32(DPI1_BASE+ 0x10, 0x000001A0);//DPI_CON
//OUTREG32(DPI1_BASE+ 0x14, 0x00000101);//DPI_CLKCON
//OUTREG32(DPI1_BASE+ 0x18, 0x02d00500);//DPI_SIZE 720x1280
//OUTREG32(DPI1_BASE+ 0x1c, 0x00000028);//DPI_TGEN_HWIDTH 40
//OUTREG32(DPI1_BASE+ 0x20, 0x01b800dc);//DPI_TGEN_HPORCH BACK:220 FRONT:440
//OUTREG32(DPI1_BASE+ 0x24, 0x00000005);//DPI_TGEN_VWIDTH_LODD 5
//OUTREG32(DPI1_BASE+ 0x28, 0x00050014);//DPI_TGEN_VPORCH_LODD BACK:20 FRONT:5
//OUTREG32(DPI1_BASE+ 0x44, 0x00001e00);//DPI_ESAV_VTIM_L WIDTH:30 lines
//DPI1_ESAVVTimingControlLeft(0, 0x1E, 0, 0);
//OUTREG32(DPI1_BASE+ 0x64, 0x1ead1f53);//DPI_MATRIX_COEFF_SET0
//OUTREG32(DPI1_BASE+ 0x68, 0x01320200);//DPI_MATRIX_COEFF_SET1
//OUTREG32(DPI1_BASE+ 0x6c, 0x00750259);//DPI_MATRIX_COEFF_SET2
//OUTREG32(DPI1_BASE+ 0x70, 0x1e530200);//DPI_MATRIX_COEFF_SET3
//OUTREG32(DPI1_BASE+ 0x74, 0x00001fa0);//DPI_MATRIX_COEFF_SET4
//DPI1_MatrixCoef(0x1F53, 0x1EAD, 0x0200, 0x0132, 0x0259, 0x0075, 0x0200, 0x1E53, 0x1FA0);
//OUTREG32(DPI1_BASE+ 0x78, 0x00000000);//DPI_MATRIX_PREADD_SET0
//OUTREG32(DPI1_BASE+ 0x7c, 0x00000000);//DPI_MATRIX_PREADD_SET1
//DPI1_MatrixPreOffset(0, 0, 0);
//OUTREG32(DPI1_BASE+ 0x80, 0x00000800);//DPI_MATRIX_POSTADD_SET0
//OUTREG32(DPI1_BASE+ 0x84, 0x00000800);//DPI_MATRIX_POSTADD_SET1
//DPI1_MatrixPostOffset(0x0800, 0, 0x0800);
//OUTREG32(DPI1_BASE+ 0x88, 0x00000000);//DPI_CLPF_SETTING
//DPI1_CLPFSetting(0, FALSE);
//OUTREG32(DPI1_BASE+ 0x8c, 0x0f000100);//DPI_Y_LIMIT 256 - 3840
//OUTREG32(DPI1_BASE+ 0x90, 0x0f000100);//DPI_C_LIMIT 256 - 3840
//DPI1_SetChannelLimit(0x0100, 0x0F00, 0x0100, 0x0F00);
//OUTREG32(DPI1_BASE+ 0x9c, 0x00000007);//DPI_EMBSYNC_SETTING
//DPI1_EmbeddedSyncSetting(TRUE, TRUE, TRUE, FALSE, FALSE, FALSE, FALSE);
//OUTREG32(DPI1_BASE+ 0xa8, 0x00000600);//DPI_OUTPUT_SETTING OUT_YC_MAP
//DPI1_OutputSetting(DPI_OUTPUT_BIT_NUM_8BITS, FALSE, DPI_OUTPUT_CHANNEL_SWAP_RGB, DPI_OUTPUT_YC_MAP_CY);
//OUTREG32(DPI1_BASE+ 0xb4, 0x11223341);//DPI_PATTERN
//DPI1_EnableColorBar();
//OUTREG32(DPI1_BASE + 0x0, 0x00000001);//
//DPI1_EnableClk();
#if 0
cntl = DPI1_REG->CNTL;
cntl.EMBSYNC_EN = 1;
OUTREG32(&DPI1_REG->CNTL, AS_UINT32(&cntl));
embsync = DPI1_REG->EMBSYNC_SETTING;
embsync.ESAV_CODE_MAN = 0;
embsync.EMBVSYNC_G_Y = 1;
embsync.EMBVSYNC_R_CR= 1;
embsync.EMBVSYNC_B_CB= 1;
OUTREG32(&DPI1_REG->EMBSYNC_SETTING, AS_UINT32(&embsync));
#endif
#if ENABLE_DPI1_INTERRUPT
if (request_irq(MT6589_DPI_IRQ_ID,
_DPI1_InterruptHandler, IRQF_TRIGGER_LOW, "mtkdpi", NULL) < 0)
{
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DPI1", "[ERROR] fail to request DPI irq\n");
return DPI_STATUS_ERROR;
}
{
DPI_REG_INTERRUPT enInt = DPI1_REG->INT_ENABLE;
enInt.VSYNC = 1;
OUTREG32(&DPI1_REG->INT_ENABLE, AS_UINT32(&enInt));
}
#endif
LCD_W2M_NeedLimiteSpeed(TRUE);
return DPI_STATUS_OK;
}
void DSI_set_cmdq_V2(unsigned cmd, unsigned char count, unsigned char *para_list, unsigned char force_update)
{
UINT32 i, layer, layer_state, lane_num;
UINT32 goto_addr, mask_para, set_para;
UINT32 fbPhysAddr, fbVirAddr;
DSI_T0_INS t0;
DSI_T1_INS t1;
DSI_T2_INS t2;
_WaitForEngineNotBusy();
if (count > 59)
{
UINT32 pixel = count/3 + ((count%3) ? 1 : 0);
LCD_REG_LAYER fb_layer_info;
LCD_REG_DSI_DC dsi_info;
// backup layer state.
layer_state = AS_UINT32(&LCD_REG->WROI_CONTROL) & 0xFC000000;
// backup FB layer info.
memcpy((void *)&fb_layer_info, (void *)&LCD_REG->LAYER[FB_LAYER], sizeof(LCD_REG_LAYER));
// backup LCD-DSI I/F configuration.
dsi_info = LCD_REG->DS_DSI_CON;
// backup lane number.
lane_num = DSI_REG->DSI_TXRX_CTRL.LANE_NUM;
// HW limitation.
// LP type-1 command can't go with 2 lanes. So we must switch to lane mode.
DSI_REG->DSI_TXRX_CTRL.LANE_NUM = 1;
DSI_PHY_REG->MIPITX_CON1.RG_DSI_CK_SEL = 0;
// Modify LCD-DSI configuration
LCD_REG->DS_DSI_CON.DC_DSI = TRUE;
// Let LSB of RGB(BGR in buffer) first.
LCD_REG->DS_DSI_CON.RGB_SWAP = LCD_DSI_IF_FMT_COLOR_ORDER_BGR;
// Let parameters be in unit of byte.
LCD_REG->DS_DSI_CON.CLR_FMT = LCD_DSI_IF_FORMAT_RGB888;
// HW limitation
// It makes package numbers > 1.
LCD_REG->DS_DSI_CON.PACKET_SIZE = 30;
// Start of Enable only one layer (FB layer) to push data to DSI
LCD_CHECK_RET(LCD_LayerEnable(LCD_LAYER_ALL, FALSE));
LCD_CHECK_RET(LCD_LayerEnable(FB_LAYER, TRUE));
LCD_CHECK_RET(LCD_SetRoiWindow(0, 0, pixel, 1));
LCD_CHECK_RET(LCD_SetBackgroundColor(0));
// operates on FB layer
{
extern void disp_get_fb_address(UINT32 *fbVirAddr, UINT32 *fbPhysAddr);
disp_get_fb_address(&fbVirAddr ,&fbPhysAddr);
// copy parameters to FB layer buffer.
memcpy((void *)fbVirAddr, (void *)para_list, count);
LCD_REG->LAYER[FB_LAYER].ADDRESS = fbPhysAddr;
}
LCD_CHECK_RET(LCD_LayerSetFormat(FB_LAYER, LCD_LAYER_FORMAT_RGB888));
LCD_CHECK_RET(LCD_LayerSetPitch(FB_LAYER, pixel*3));
LCD_CHECK_RET(LCD_LayerSetOffset(FB_LAYER, 0, 0));
LCD_CHECK_RET(LCD_LayerSetSize(FB_LAYER, pixel, 1));
// End of Enable only one layer (FB layer) to push data to DSI
t1.CONFG = 1;
t1.Data_ID = DSI_DCS_LONG_PACKET_ID;
t1.mem_start0 = (cmd&0xFF);
t1.mem_start1 = (cmd>>8);
OUTREG32(&DSI_CMDQ_REG->data0[0], AS_UINT32(&t1));
OUTREG32(&DSI_REG->DSI_CMDQ_SIZE, 1);
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DSI", "[DISP] - kernel - DSI_set_cmdq_V2. command(0x%x) parameter count = %d > 59, pixel = %d \n", cmd, count, pixel);
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DSI", "[DISP] - kernel - command queue only support 16 x 4 bytes. Header used 4 byte. DCS used 1 byte. If parameter > 59 byte, work around by Type-1 command. \n");
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DSI", "para_list[%d] = {", count);
for (i = 0; i < count; i++)
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DSI", "0x%02x, ", para_list[i]);
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DSI", "} \n");
LCD_M4U_On(0);
if(force_update)
{
LCD_CHECK_RET(LCD_StartTransfer(FALSE));
DSI_EnableClk();
}
_WaitForEngineNotBusy();
LCD_M4U_On(1);
// restore FB layer info.
memcpy((void *)&LCD_REG->LAYER[FB_LAYER], (void *)&fb_layer_info, sizeof(LCD_REG_LAYER));
// restore LCD-DSI I/F configuration.
LCD_REG->DS_DSI_CON = dsi_info;
// restore lane number.
DSI_REG->DSI_TXRX_CTRL.LANE_NUM = lane_num;
DSI_PHY_REG->MIPITX_CON1.RG_DSI_CK_SEL = (lane_num - 1);
// restore layer state.
for(layer=LCD_LAYER_0; layer<LCD_LAYER_NUM; layer++)
{
if(layer_state&(0x80000000>>layer))
LCD_CHECK_RET(LCD_LayerEnable(layer, TRUE));
else
LCD_CHECK_RET(LCD_LayerEnable(layer, FALSE));
}
DPI_STATUS DPI_Set_DrivingCurrent(LCM_PARAMS *lcm_params)
{
DISP_LOG_PRINT(ANDROID_LOG_WARN, "DPI", "DPI_Set_DrivingCurrent not implement for 6575");
return DPI_STATUS_OK;
}
