int hdmi_dst_display_path_config(bool enable)
{
HDMI_FUNC();
if (enable)
{
//FIXME: now nothing can be seen on TV if output UYVY from WDMA0
unsigned int hdmiSourceAddr = hdmi_mva_r;// + p->hdmi_width * p->hdmi_height * hdmi_bpp * hdmi_buffer_read_id;
struct disp_path_config_struct config = {0};
// Config RDMA->DPI1
config.srcWidth = 1280;
config.srcHeight = 720;
config.srcModule = DISP_MODULE_RDMA1;
config.inFormat = RDMA_INPUT_FORMAT_ARGB;
config.outFormat = RDMA_OUTPUT_FORMAT_ARGB;
config.addr = hdmiSourceAddr;
config.pitch = config.srcWidth * 4;
config.dstModule = DISP_MODULE_DPI0;
//if(-1 == dp_mutex_dst)
// dp_mutex_dst = disp_lock_mutex();
dp_mutex_dst = 2;
disp_dump_reg(DISP_MODULE_RDMA0);
disp_dump_reg(DISP_MODULE_RDMA1);
disp_dump_reg(DISP_MODULE_CONFIG);
HDMI_LOG("Get mutex ID %d for RDMA1>DPI1\n", dp_mutex_dst);
disp_path_get_mutex_(dp_mutex_dst);
disp_path_config_(&config, dp_mutex_dst);
disp_path_release_mutex_(dp_mutex_dst);
disp_dump_reg(DISP_MODULE_CONFIG);
disp_dump_reg(DISP_MODULE_RDMA0);
disp_dump_reg(DISP_MODULE_RDMA1);
}
else
{
if (-1 != dp_mutex_dst)
{
//FIXME: release mutex timeout
HDMI_LOG("Stop RDMA1>DPI1\n");
disp_path_get_mutex_(dp_mutex_dst);
DISP_REG_SET_FIELD(1 << dp_mutex_src , DISP_REG_CONFIG_MUTEX_INTEN, 1);
RDMAStop(1);
RDMAReset(1);
disp_path_release_mutex_(dp_mutex_dst);
//disp_unlock_mutex(dp_mutex_dst);
dp_mutex_dst = -1;
}
}
return 0;
}
int ddp_mem_test(void)
{
int result = 0;
struct disp_path_config_struct config;
unsigned int* pSrc;
unsigned char* pSrcPa;
unsigned int* pDst;
unsigned char* pDstPa;
pSrc= dma_alloc_coherent(NULL, DDP_TEST_WIDTH*DDP_TEST_HEIGHT*DDP_TEST_BPP, (dma_addr_t *)&pSrcPa, GFP_KERNEL);
if(pSrc==0 || pSrcPa==0)
{
printk("dma_alloc_coherent error! dma memory not available.\n");
return 0;
}
else
{
printk("[ddp] pSrc=0x%x, pSrcPa=0x%x \n", (unsigned int)pSrc, (unsigned int)pSrcPa);
}
memcpy((void*)pSrc, data_rgb888_64x64, DDP_TEST_WIDTH*DDP_TEST_HEIGHT*DDP_TEST_BPP);
pDst= dma_alloc_coherent(NULL, DDP_TEST_WIDTH*DDP_TEST_HEIGHT*DDP_TEST_BPP, (dma_addr_t *)&pDstPa, GFP_KERNEL);
if(pDst==0 || pDstPa==0)
{
printk("dma_alloc_coherent error! dma memory not available.\n");
return 0;
}
else
{
printk("[ddp] pDst=0x%x, pDstPa=0x%x \n",(unsigned int) pDst, (unsigned int)pDstPa);
}
memset((void*)pDst, 0, DDP_TEST_WIDTH*DDP_TEST_HEIGHT*DDP_TEST_BPP);
// config port to physical
{
M4U_PORT_STRUCT sPort;
sPort.ePortID = M4U_PORT_LCD_W;
sPort.Virtuality = 0;
sPort.Security = 0;
sPort.Distance = 1;
sPort.Direction = 0;
m4u_config_port(&sPort);
}
config.srcModule = DISP_MODULE_OVL;
config.addr = (unsigned int)pSrcPa;
config.inFormat = eRGB888;
config.pitch = DDP_TEST_WIDTH;
config.srcROI.x = 0;
config.srcROI.y = 0;
config.srcROI.width = DDP_TEST_WIDTH;
config.srcROI.height = DDP_TEST_HEIGHT;
config.srcWidth = DDP_TEST_WIDTH;
config.srcHeight = DDP_TEST_HEIGHT;
config.dstModule = DISP_MODULE_WDMA0;
config.outFormat = eRGB888;
config.dstAddr = (unsigned int)pDstPa;
config.dstWidth = DDP_TEST_WIDTH;
config.dstHeight = DDP_TEST_HEIGHT;
config.dstPitch = DDP_TEST_WIDTH;
/*
disp_power_on(DISP_MODULE_ROT);
disp_power_on(DISP_MODULE_SCL);
disp_power_on(DISP_MODULE_WDMA0);
*/
disp_path_get_mutex_(DDP_MUTEX_FOR_ROT_SCL_WDMA);
disp_path_config_(&config, DDP_MUTEX_FOR_ROT_SCL_WDMA);
printk("*after ddp test config start: -------------------\n");
disp_dump_reg(DISP_MODULE_OVL);
disp_dump_reg(DISP_MODULE_WDMA0);
disp_dump_reg(DISP_MODULE_CONFIG);
printk("*after ddp test config end: ---------------------\n");
disp_path_release_mutex_(DDP_MUTEX_FOR_ROT_SCL_WDMA);
if(*(volatile unsigned int*)DISP_REG_CONFIG_MUTEX1 != 0)
{
*(volatile unsigned int*)DISP_REG_CONFIG_MUTEX1 = 0;
}
printk("ddp_mem_test wdma wait done... \n");
WDMAWait(0);
printk("ddp_mem_test wdma done! \n");
if(0) //compare source
{
unsigned int diff_cnt = 0;
unsigned int t=0;
unsigned int size = DDP_TEST_WIDTH*DDP_TEST_HEIGHT*DDP_TEST_BPP;
for(t=0;t<size;t++)
{
if( *((unsigned char*)pSrc+t) != *((unsigned char*)data_rgb888_64x64+t) )
{
diff_cnt++;
printk("t=%d, diff_cnt=%d, dst=0x%x, gold=0x%x \n",
t,
diff_cnt,
*((unsigned char*)pSrc+t),
*((unsigned char*)data_rgb888_64x64+t) );
}
}
if(diff_cnt == 0)
printk("ddp_mem_test src compare result: success \n");
else
{
printk("ddp_mem_test src compare result: fail \n");
printk("detail, %d, %d, %%%d \n", diff_cnt, size, diff_cnt*100/size);
result = -1;
}
}
if(1) //compare dst
{
unsigned int diff_cnt = 0;
unsigned int t=0;
unsigned int size = DDP_TEST_WIDTH*DDP_TEST_HEIGHT*DDP_TEST_BPP;
for(t=0;t<size;t++)
{
if( *((unsigned char*)pDst+t) != *((unsigned char*)data_rgb888_64x64_golden+t) )
{
diff_cnt++;
printk("t=%d, diff_cnt=%d, dst=0x%x, gold=0x%x \n",
t,
diff_cnt,
*((unsigned char*)pDst+t),
*((unsigned char*)data_rgb888_64x64_golden+t) );
}
}
if(diff_cnt == 0)
printk("ddp_mem_test result: success \n");
else
{
printk("ddp_mem_test result: fail \n");
printk("detail, %d, %d, %%%d \n", diff_cnt, size, diff_cnt*100/size);
result = -1;
}
}
// print out dst buffer to save as golden
if(0)
{
unsigned int t=0;
unsigned int size = DDP_TEST_WIDTH*DDP_TEST_HEIGHT*DDP_TEST_BPP;
for(t=0;t<size;t++)
{
printk("0x%x, ", *((unsigned char*)pDst+t));
if((t+1)%12==0)
{
printk("\n%05d: ", (t+1)/12);
}
}
}
/*
disp_power_off(DISP_MODULE_ROT);
disp_power_off(DISP_MODULE_SCL);
disp_power_off(DISP_MODULE_WDMA0);
*/
//dealloc memory
dma_free_coherent(NULL, DDP_TEST_WIDTH*DDP_TEST_HEIGHT*DDP_TEST_BPP, pSrc, (dma_addr_t)&pSrcPa);
dma_free_coherent(NULL, DDP_TEST_WIDTH*DDP_TEST_HEIGHT*DDP_TEST_BPP, pDst, (dma_addr_t)&pDstPa);
return result;
}
static void process_dbg_opt(const char *opt)
{
char *buf = dbg_buf + strlen(dbg_buf);
if (0 == strncmp(opt, "regr:", 5))
{
char *p = (char *)opt + 5;
unsigned int addr = (unsigned int) simple_strtoul(p, &p, 16);
if (addr)
{
unsigned int regVal = DISP_REG_GET(addr);
DDP_DRV_INFO("regr: 0x%08X = 0x%08X\n", addr, regVal);
sprintf(buf, "regr: 0x%08X = 0x%08X\n", addr, regVal);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "regw:", 5))
{
char *p = (char *)opt + 5;
unsigned int addr = (unsigned int) simple_strtoul(p, &p, 16);
unsigned int val = (unsigned int) simple_strtoul(p + 1, &p, 16);
if (addr)
{
unsigned int regVal;
DISP_REG_SET(addr, val);
regVal = DISP_REG_GET(addr);
DDP_DRV_DBG("regw: 0x%08X, 0x%08X = 0x%08X\n", addr, val, regVal);
sprintf(buf, "regw: 0x%08X, 0x%08X = 0x%08X\n", addr, val, regVal);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "ddp_drv_dbg_log:", 16))
{
char *p = (char *)opt + 16;
unsigned int enable = (unsigned int) simple_strtoul(p, &p, 10);
if (enable)
ddp_drv_dbg_log = 1;
else
ddp_drv_dbg_log = 0;
sprintf(buf, "ddp_drv_dbg_log: %d\n", ddp_drv_dbg_log);
}
else if (0 == strncmp(opt, "ddp_drv_irq_log:", 16))
{
char *p = (char *)opt + 16;
unsigned int enable = (unsigned int) simple_strtoul(p, &p, 10);
if (enable)
ddp_drv_irq_log = 1;
else
ddp_drv_irq_log = 0;
sprintf(buf, "ddp_drv_irq_log: %d\n", ddp_drv_irq_log);
}
else if (0 == strncmp(opt, "backlight:", 10))
{
char *p = (char *)opt + 10;
unsigned int level = (unsigned int) simple_strtoul(p, &p, 10);
if (level)
{
disp_bls_set_backlight(level);
sprintf(buf, "backlight: %d\n", level);
} else {
goto Error;
}
}
else if (0 == strncmp(opt, "dump_reg:", 9))
{
char *p = (char *)opt + 9;
unsigned int module = (unsigned int) simple_strtoul(p, &p, 10);
DDP_DRV_INFO("process_dbg_opt, module=%d \n", module);
if (module<DISP_MODULE_MAX)
{
disp_dump_reg(module);
sprintf(buf, "dump_reg: %d\n", module);
} else {
DDP_DRV_INFO("process_dbg_opt2, module=%d \n", module);
goto Error;
}
}
else if (0 == strncmp(opt, "dump_aal:", 9))
{
char *p = (char *)opt + 9;
unsigned int arg = (unsigned int) simple_strtoul(p, &p, 10);
if (arg == 0)
{
int i;
unsigned int hist[LUMA_HIST_BIN];
disp_get_hist(hist);
for (i = 0; i < LUMA_HIST_BIN; i++)
{
DDP_DRV_DBG("LUMA_HIST_%02d: %d\n", i, hist[i]);
sprintf(dbg_buf + strlen(dbg_buf), "LUMA_HIST_%2d: %d\n", i, hist[i]);
}
}
else if (arg == 1)
{
int i;
DISP_AAL_PARAM param;
GetUpdateMutex();
memcpy(¶m, get_aal_config(), sizeof(DISP_AAL_PARAM));
ReleaseUpdateMutex();
DDP_DRV_DBG("pwmDuty: %lu\n", param.pwmDuty);
sprintf(dbg_buf + strlen(dbg_buf), "pwmDuty: %lu\n", param.pwmDuty);
for (i = 0; i < LUMA_CURVE_POINT; i++)
{
DDP_DRV_DBG("lumaCurve[%02d]: %lu\n", i, param.lumaCurve[i]);
sprintf(dbg_buf + strlen(dbg_buf), "lumaCurve[%02d]: %lu\n", i, param.lumaCurve[i]);
}
}
}
else if (0 == strncmp(opt, "debug:", 6))
{
char *p = (char *)opt + 6;
unsigned int enable = (unsigned int) simple_strtoul(p, &p, 10);
if(enable==1)
{
printk("[DDP] debug=1, trigger AEE\n");
aee_kernel_exception("DDP-TEST-ASSERT", "[DDP] DDP-TEST-ASSERT");
}
else if(enable==2)
{
ddp_mem_test();
}
else if(enable==3)
{
ddp_mem_test2();
}
}
else if (0 == strncmp(opt, "mmp", 3))
{
init_ddp_mmp_events();
}
else if (0 == strncmp(opt, "dpfd_ut1:", 9))
{
#if 0
char *p = (char *)opt + 9;
unsigned int channel = (unsigned int) simple_strtoul(p, &p, 10);
//ddpk_testfunc_1(channel);
#endif
}
else if (0 == strncmp(opt, "dpfd_ut2:", 9))
{
#if 0
char *p = (char *)opt + 9;
unsigned int channel = (unsigned int) simple_strtoul(p, &p, 10);
//ddpk_testfunc_2(channel);
#endif
}
else if (0 == strncmp(opt, "dpfd:log", 8))
{
}
else if (0 == strncmp(opt, "pqon", 4))
{
pq_debug_flag=0;
sprintf(buf, "Turn on PQ %d\n", pq_debug_flag);
}
else if (0 == strncmp(opt, "pqoff", 5))
{
pq_debug_flag=1;
sprintf(buf, "Turn off PQ %d\n", pq_debug_flag);
}
else if (0 == strncmp(opt, "pqdemo", 6))
{
pq_debug_flag=2;
sprintf(buf, "Turn on PQ (demo) %d\n", pq_debug_flag);
}
else if (0 == strncmp(opt, "pqstop", 6))
{
pq_debug_flag=3;
sprintf(buf, "Stop mutex update %d\n", pq_debug_flag);
}
else if (0 == strncmp(opt, "aalon", 5))
{
aal_debug_flag=0;
sprintf(buf, "resume aal update %d\n", aal_debug_flag);
}
else if (0 == strncmp(opt, "aaloff", 6))
{
aal_debug_flag=1;
sprintf(buf, "suspend aal update %d\n", aal_debug_flag);
}
else if (0 == strncmp(opt, "color_win:", 10))
{
char *p = (char *)opt + 10;
unsigned int sat_upper, sat_lower, hue_upper, hue_lower;
sat_upper = (unsigned int) simple_strtoul(p, &p, 10);
p++;
sat_lower = (unsigned int) simple_strtoul(p, &p, 10);
p++;
hue_upper = (unsigned int) simple_strtoul(p, &p, 10);
p++;
hue_lower = (unsigned int) simple_strtoul(p, &p, 10);
DDP_DRV_INFO("Set color_win: %u, %u, %u, %u\n", sat_upper, sat_lower, hue_upper, hue_lower);
disp_pq_set_window(sat_upper, sat_lower, hue_upper, hue_lower);
}
else if (0 == strncmp(opt, "dpx", 3))
{
ddp_debug_flag = ddp_debug_flag ^ 1;
DDP_DRV_INFO("ddp_debug_flag: %d\n", ddp_debug_flag);
}
else if (0 == strncmp(opt, "ovl_reg:", 8))
{
char *p = (char *)opt + 8;
unsigned int offset = (unsigned int) simple_strtoul(p, &p, 16);
unsigned int value = (unsigned int) simple_strtoul(p + 1, &p, 16);
disp_path_get_mutex_(gMutexID);
DISP_REG_SET(DISP_OVL_BASE+offset, value);
disp_path_release_mutex_(gMutexID);
DDP_DRV_INFO("ovl_reg: 0x%08X = 0x%08X\n", DISP_OVL_BASE+offset, value);
}
else if (0 == strncmp(opt, "rdma_reg:", 9))
{
char *p = (char *)opt + 9;
unsigned int offset = (unsigned int) simple_strtoul(p, &p, 16);
unsigned int value = (unsigned int) simple_strtoul(p + 1, &p, 16);
disp_path_get_mutex_(gMutexID);
DISP_REG_SET(DISP_RDMA_BASE+offset, value);
disp_path_release_mutex_(gMutexID);
DDP_DRV_INFO("rdma_reg: 0x%08X = 0x%08X\n", DISP_RDMA_BASE+offset, value);
}
else if (0 == strncmp(opt, "bls_reg:", 8))
{
char *p = (char *)opt + 8;
unsigned int offset = (unsigned int) simple_strtoul(p, &p, 16);
unsigned int value = (unsigned int) simple_strtoul(p + 1, &p, 16);
disp_path_get_mutex_(gMutexID);
DISP_REG_SET(DISP_BLS_BASE+offset, value);
disp_path_release_mutex_(gMutexID);
DDP_DRV_INFO("bls_reg: 0x%08X = 0x%08X\n", DISP_BLS_BASE+offset, value);
}
else if (0 == strncmp(opt, "pq_reg:", 7))
{
char *p = (char *)opt + 7;
unsigned int offset = (unsigned int) simple_strtoul(p, &p, 16);
unsigned int value = (unsigned int) simple_strtoul(p + 1, &p, 16);
disp_path_get_mutex_(gMutexID);
DISP_REG_SET(DISP_PQ_BASE+offset, value);
disp_path_release_mutex_(gMutexID);
DDP_DRV_INFO("pq_reg: 0x%08X = 0x%08X\n", DISP_PQ_BASE+offset, value);
}
else
{
goto Error;
}
return;
Error:
DDP_DRV_ERR("parse command error!\n%s\n\n%s", opt, STR_HELP);
}
