mtk-lk/platform/mt6580/primary_display.c

/* Copyright Statement:
*
* This software/firmware and related documentation ("MediaTek Software") are
* protected under relevant copyright laws. The information contained herein
* is confidential and proprietary to MediaTek Inc. and/or its licensors.
* Without the prior written permission of MediaTek inc. and/or its licensors,
* any reproduction, modification, use or disclosure of MediaTek Software,
* and information contained herein, in whole or in part, shall be strictly prohibited.
*/
/* MediaTek Inc. (C) 2015. All rights reserved.
*
* BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
* THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
* RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER ON
* AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL WARRANTIES,
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED WARRANTIES OF
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR NONINFRINGEMENT.
* NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH RESPECT TO THE
* SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY, INCORPORATED IN, OR
* SUPPLIED WITH THE MEDIATEK SOFTWARE, AND RECEIVER AGREES TO LOOK ONLY TO SUCH
* THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO. RECEIVER EXPRESSLY ACKNOWLEDGES
* THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES
* CONTAINED IN MEDIATEK SOFTWARE. MEDIATEK SHALL ALSO NOT BE RESPONSIBLE FOR ANY MEDIATEK
* SOFTWARE RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
* STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S ENTIRE AND
* CUMULATIVE LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE RELEASED HEREUNDER WILL BE,
* AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE MEDIATEK SOFTWARE AT ISSUE,
* OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE CHARGE PAID BY RECEIVER TO
* MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
*/

#include <video_fb.h>
#include <target/board.h>
#include <env.h>
#include "lcm_drv.h"
#include <string.h>
#include <stdlib.h>
#include <platform/mt_gpt.h>
#include <platform/disp_drv_platform.h>
#include <platform/disp_drv_log.h>
#include <platform/boot_mode.h>
#include <platform/primary_display.h>
#include <platform/disp_lcm.h>

#define DDP_LK_BOOT
#ifndef HZ
#define HZ 100
#endif

int primary_display_use_cmdq = CMDQ_DISABLE;
int primary_display_use_m4u = 1;
DISP_PRIMARY_PATH_MODE primary_display_mode = DIRECT_LINK_MODE;

typedef struct {
	int         state;
	int         need_trigger_overlay;
	DISP_PRIMARY_PATH_MODE  mode;
	unsigned int        last_vsync_tick;
	disp_lcm_handle     *plcm;
	cmdqRecHandle       cmdq_handle_config;
	cmdqRecHandle       cmdq_handle_trigger;
	disp_path_handle    dpmgr_handle;
	disp_path_handle    ovl2mem_path_handle;
} display_primary_path_context;

#define pgc _get_context()

static display_primary_path_context* _get_context(void)
{
	static int is_context_inited = 0;
	static display_primary_path_context g_context;
	if (!is_context_inited) {
		memset((void*)&g_context, 0, sizeof(display_primary_path_context));
		is_context_inited = 1;
	}

	return &g_context;
}

static DISP_MODULE_ENUM _get_dst_module_by_lcm(disp_lcm_handle *plcm)
{
	if (plcm == NULL) {
		DISPERR("plcm is null\n");
		return DISP_MODULE_UNKNOWN;
	}

	if (plcm->params->type == LCM_TYPE_DSI) {
		if (plcm->lcm_if_id == LCM_INTERFACE_DSI0) {
			return DISP_MODULE_DSI0;
		} else if (plcm->lcm_if_id == LCM_INTERFACE_DSI1) {
			return DISP_MODULE_DSI1;
		} else if (plcm->lcm_if_id == LCM_INTERFACE_DSI_DUAL) {
			return DISP_MODULE_DSIDUAL;
		} else {
			return DISP_MODULE_DSI0;
		}
	} else if (plcm->params->type == LCM_TYPE_DPI) {
		return DISP_MODULE_DPI;
	} else {
		DISPERR("can't find primary path dst module\n");
		return DISP_MODULE_UNKNOWN;
	}
}

extern int ddp_dsi_set_lcm_utils(DISP_MODULE_ENUM module, LCM_DRIVER *lcm_drv);

static int _build_path_direct_link(void)
{
	int ret = 0;

	DISP_MODULE_ENUM dst_module = 0;
	DISPFUNC();
	pgc->mode = DIRECT_LINK_MODE;

	pgc->dpmgr_handle = dpmgr_create_path(DDP_SCENARIO_PRIMARY_DISP, NULL);
	if (pgc->dpmgr_handle) {
		DISPCHECK("dpmgr create path SUCCESS(0x%08x)\n", pgc->dpmgr_handle);
	} else {
		DISPCHECK("dpmgr create path FAIL\n");
		return -1;
	}

	dst_module = _get_dst_module_by_lcm(pgc->plcm);
	dpmgr_path_set_dst_module(pgc->dpmgr_handle, dst_module);
	DISPCHECK("dpmgr set dst module FINISHED(%s)\n", ddp_get_module_name(dst_module));
	dpmgr_set_lcm_utils(pgc->dpmgr_handle, pgc->plcm->drv);

	return ret;
}

static int _convert_disp_input_to_rdma(RDMA_CONFIG_STRUCT *dst, disp_input_config* src)
{
	if (src && dst) {
		dst->inputFormat = src->fmt;
		dst->address = src->addr;
		dst->width = src->src_w;
		dst->height = src->src_h;
		dst->pitch = src->src_pitch;
		return 0;
	} else {
		DISPERR("src(0x%08x) or dst(0x%08x) is null\n", src, dst);
		return -1;
	}
}

static int _convert_disp_input_to_ovl(OVL_CONFIG_STRUCT *dst, disp_input_config* src)
{
	if (src && dst) {
		dst->layer = src->layer;
		dst->layer_en = src->layer_en;
		dst->fmt = src->fmt;
		dst->addr = src->addr;
		dst->vaddr = src->vaddr;
		dst->src_x = src->src_x;
		dst->src_y = src->src_y;
		dst->src_w = src->src_w;
		dst->src_h = src->src_h;
		dst->src_pitch = src->src_pitch;
		dst->dst_x = src->dst_x;
		dst->dst_y = src->dst_y;
		dst->dst_w = src->dst_w;
		dst->dst_h = src->dst_h;
		dst->keyEn = src->keyEn;
		dst->key = src->key;
		dst->aen = src->aen;
		dst->alpha = src->alpha;
		dst->isDirty = src->isDirty;
		dst->buff_idx = src->buff_idx;
		dst->identity = src->identity;
		dst->connected_type = src->connected_type;
		dst->security = src->security;
		return 0;
	} else {
		DISPERR("src(0x%08x) or dst(0x%08x) is null\n", src, dst);
		return -1;
	}
}


int primary_display_is_lcm_connected(void)
{
	return pgc->plcm->is_connected;
}

const char* primary_display_get_lcm_name(void)
{
	return disp_lcm_get_name(pgc->plcm);
}

void _dump_lcm_info_by_video_printf(void)
{
	int i = 0;
	LCM_DRIVER *l = NULL;
	LCM_PARAMS *p = NULL;

	disp_lcm_handle *plcm = pgc->plcm;
	if (plcm == NULL) {
		DISPERR("plcm is null\n");
		return;
	}

	l = plcm->drv;
	p = plcm->params;
	if (l && p) {
		video_printf("[LCM] name: %s\n", l->name);
		video_printf("[LCM] resolution: %d x %d\n", p->width, p->height);
		video_printf("[LCM] physical size: %d x %d\n", p->physical_width, p->physical_height);
		video_printf("[LCM] physical size: %d x %d\n", p->physical_width, p->physical_height);

		switch (p->lcm_if) {
			case LCM_INTERFACE_DSI0:
				video_printf("[LCM] interface: DSI0\n");
				break;
			case LCM_INTERFACE_DSI1:
				video_printf("[LCM] interface: DSI1\n");
				break;
			default:
				video_printf("[LCM] interface: unknown\n");
				break;
		}

		switch (p->type) {
			case LCM_TYPE_DSI:
				video_printf("[LCM] Type: DSI\n");
				break;
			default:
				video_printf("[LCM] TYPE: unknown\n");
				break;
		}

		if (p->type == LCM_TYPE_DSI) {
			switch (p->dsi.mode) {
				case CMD_MODE:
					video_printf("[LCM] DSI Mode: CMD_MODE\n");
					break;
				case SYNC_PULSE_VDO_MODE:
					video_printf("[LCM] DSI Mode: SYNC_PULSE_VDO_MODE\n");
					break;
				case SYNC_EVENT_VDO_MODE:
					video_printf("[LCM] DSI Mode: SYNC_EVENT_VDO_MODE\n");
					break;
				case BURST_VDO_MODE:
					video_printf("[LCM] DSI Mode: BURST_VDO_MODE\n");
					break;
				default:
					video_printf("[LCM] DSI Mode: Unknown\n");
					break;
			}
		}

		if (p->type == LCM_TYPE_DSI) {
			video_printf("[LCM] LANE_NUM: %d,data_format: %d,vertical_sync_active: %d\n",p->dsi.LANE_NUM,p->dsi.data_format);
			video_printf("[LCM] vact: %d, vbp: %d, vfp: %d, vact_line: %d, hact: %d, hbp: %d, hfp: %d, hblank: %d, hblank: %d\n",p->dsi.vertical_sync_active, p->dsi.vertical_backporch,p->dsi.vertical_frontporch,p->dsi.vertical_active_line,p->dsi.horizontal_sync_active,p->dsi.horizontal_backporch,p->dsi.horizontal_frontporch,p->dsi.horizontal_blanking_pixel);
			video_printf("[LCM] pll_select: %d, pll_div1: %d, pll_div2: %d, fbk_div: %d,fbk_sel: %d, rg_bir: %d\n",p->dsi.pll_select,p->dsi.pll_div1,p->dsi.pll_div2,p->dsi.fbk_div,p->dsi.fbk_sel,p->dsi.rg_bir);
			video_printf("[LCM] rg_bic: %d, rg_bp: %d,	PLL_CLOCK: %d, dsi_clock: %d, ssc_range: %d,	ssc_disable: %d, compatibility_for_nvk: %d, cont_clock: %d\n", p->dsi.rg_bic,   p->dsi.rg_bp,p->dsi.PLL_CLOCK,p->dsi.dsi_clock,p->dsi.ssc_range,p->dsi.ssc_disable,p->dsi.compatibility_for_nvk,p->dsi.cont_clock);
			video_printf("[LCM] lcm_ext_te_enable: %d, noncont_clock: %d, noncont_clock_period: %d\n", p->dsi.lcm_ext_te_enable,p->dsi.noncont_clock,p->dsi.noncont_clock_period);
		}
	}

	return;
}

typedef struct _disp_dfo_item {
	char name[32];
	int  value;
} disp_dfo_item_t;

static disp_dfo_item_t disp_dfo_setting[] = {
	{"LCM_FAKE_WIDTH",  0},
	{"LCM_FAKE_HEIGHT", 0},
	{"DISP_DEBUG_SWITCH",   0}
};

unsigned int mt_disp_parse_dfo_setting(void)
{
	unsigned int i, j = 0, k = 0;
	char tmp[11];
	char *buffer = NULL;
	char *ptr = NULL;

	buffer = (char *)get_env("DFO");
	DISPMSG("env buffer = %s\n", buffer);

	if (buffer != NULL) {
		for (i = 0; i< (sizeof(disp_dfo_setting)/sizeof(disp_dfo_item_t)); i++) {
			memset((void*)tmp, 0, sizeof(tmp)/sizeof(tmp[0]));
			ptr = strstr(buffer, disp_dfo_setting[i].name);
			k = strlen(tmp);

			if (ptr == NULL) continue;

			DISPMSG("disp_dfo_setting[%d].name = [%s], name_lenght = %d\n", i, ptr, k);

			do { k--; } while (((*ptr) != '\0') && ((*ptr++) != ',') && (k >= 0));

			do {
				tmp[j++] = *ptr++;
				k--;
			} while (((*ptr) != '\0') && (*ptr != ',') && (j < sizeof(tmp)/sizeof(tmp[0])) && (k >= 0));

			disp_dfo_setting[i].value = atoi((const char*)tmp);

			DISPMSG("disp_dfo_setting[%d].name = [%s|%d]\n", i, tmp, disp_dfo_setting[i].value);
		}
	} else {
		DISPMSG("env buffer = NULL\n");
	}

	return 0;
}

int mt_disp_get_dfo_setting(const char *string, unsigned int *value)
{
	char *disp_name;
	int  disp_value;
	unsigned int i = 0;

	if (string == NULL)
		return -1;

	for (i=0; i<(sizeof(disp_dfo_setting)/sizeof(disp_dfo_item_t)); i++) {
		disp_name = disp_dfo_setting[i].name;
		disp_value = disp_dfo_setting[i].value;
		if (!strcmp(disp_name, string)) {
			*value = disp_value;
			DISPMSG("%s = [DEC]%d [HEX]0x%08x\n", disp_name, disp_value, disp_value);
			return 0;
		}
	}

	return 0;
}



int primary_display_change_lcm_resolution(unsigned int width, unsigned int height)
{
	if (pgc->plcm) {
		DISPMSG("LCM Resolution will be changed, original: %dx%d, now: %dx%d\n", pgc->plcm->params->width, pgc->plcm->params->height, width, height);
		// align with 4 is the minimal check, to ensure we can boot up into kernel, and could modify dfo setting again using meta tool
		// otherwise we will have a panic in lk(root cause unknown).
		if (width >pgc->plcm->params->width || height > pgc->plcm->params->height || width == 0 || height == 0 || width %4 || height %2) {
			DISPERR("Invalid resolution: %dx%d\n", width, height);
			return -1;
		}

		if (primary_display_is_video_mode()) {
			DISPERR("Warning!!!Video Mode can't support multiple resolution!\n");
			return -1;
		}

		pgc->plcm->params->width = width;
		pgc->plcm->params->height = height;

		return 0;
	} else {
		return -1;
	}
}

int primary_display_init(char *lcm_name)
{
	DISP_STATUS ret = DISP_STATUS_OK;
	DISP_MODULE_ENUM dst_module = 0;
	unsigned int lcm_fake_width = 0;
	unsigned int lcm_fake_height = 0;
	LCM_PARAMS *lcm_param = NULL;
	LCM_INTERFACE_ID lcm_id = LCM_INTERFACE_NOTDEFINED;

	DISPFUNC();
	dpmgr_init();
	if (pgc->plcm == NULL)
		pgc->plcm = disp_lcm_probe( lcm_name, LCM_INTERFACE_NOTDEFINED);
	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 (0 != primary_display_change_lcm_resolution(lcm_fake_width, lcm_fake_height)) {
			DISPERR("[DISP_DFO]WARNING!!! Change LCM Resolution FAILED!!!\n");
		}
	}

	if (pgc->plcm == NULL) {
		DISPCHECK("disp_lcm_probe returns null\n");
		ret = DISP_STATUS_ERROR;
		goto done;
	} else {
		DISPCHECK("disp_lcm_probe SUCCESS\n");
	}

	lcm_param = disp_lcm_get_params(pgc->plcm);

	if (lcm_param == NULL) {
		DISPERR("get lcm params FAILED\n");
		ret = DISP_STATUS_ERROR;
		goto done;
	}
	if (primary_display_mode == DIRECT_LINK_MODE) {
		_build_path_direct_link();
		DISPCHECK("primary display is DIRECT LINK MODE\n");
	} else {
		DISPCHECK("primary display mode is WRONG\n");
	}

	dpmgr_path_set_video_mode(pgc->dpmgr_handle, primary_display_is_video_mode());

	dpmgr_path_init(pgc->dpmgr_handle, CMDQ_DISABLE);

#ifdef MACH_FPGA
	dpmgr_path_reset(pgc->dpmgr_handle, CMDQ_DISABLE);
#endif

	disp_ddp_path_config data_config;
	memset((void*)&data_config, 0, sizeof(disp_ddp_path_config));

	memcpy(&(data_config.dsi_config), &(lcm_param->dsi), sizeof(LCM_DSI_PARAMS));

	data_config.dst_w = lcm_param->width;
	data_config.dst_h = lcm_param->height;
	if (lcm_param->type == LCM_TYPE_DSI) {
		if (lcm_param->dsi.data_format.format == LCM_DSI_FORMAT_RGB888)
			data_config.lcm_bpp = 24;
		else if (lcm_param->dsi.data_format.format == LCM_DSI_FORMAT_RGB565)
			data_config.lcm_bpp = 16;
		else if (lcm_param->dsi.data_format.format == LCM_DSI_FORMAT_RGB666)
			data_config.lcm_bpp = 18;
	} else if (lcm_param->type == LCM_TYPE_DPI) {
		if ( lcm_param->dpi.format == LCM_DPI_FORMAT_RGB888)
			data_config.lcm_bpp = 24;
		else if ( lcm_param->dpi.format == LCM_DPI_FORMAT_RGB565)
			data_config.lcm_bpp = 16;
		if ( lcm_param->dpi.format == LCM_DPI_FORMAT_RGB666)
			data_config.lcm_bpp = 18;
	}
	data_config.dst_dirty = 1;
#ifdef MACH_FPGA
	data_config.ovl_dirty = 1;
#endif

	ret = dpmgr_path_config(pgc->dpmgr_handle, &data_config, CMDQ_DISABLE);
	ret = disp_lcm_init(pgc->plcm);
	if (primary_display_is_video_mode()) {
		dpmgr_map_event_to_irq(pgc->dpmgr_handle, DISP_PATH_EVENT_IF_VSYNC, DDP_IRQ_RDMA0_DONE);
	}
	dpmgr_enable_event(pgc->dpmgr_handle, DISP_PATH_EVENT_IF_VSYNC);
	dpmgr_enable_event(pgc->dpmgr_handle, DISP_PATH_EVENT_FRAME_DONE);
	pgc->state = 1;
done:
	return ret;
}

// register rdma done event
int primary_display_wait_for_idle(void)
{
	DISP_STATUS ret = DISP_STATUS_OK;
	DISPFUNC();
done:
	return ret;
}

int priamry_display_wait_for_vsync(void)
{
	int ret = 0;
	ret = dpmgr_wait_event(pgc->dpmgr_handle, DISP_PATH_EVENT_IF_VSYNC);
	if (ret == -2) {
		DISPCHECK("vsync for primary display path not enabled yet\n");
		return -1;
	}

	pgc->last_vsync_tick = 0;
	return 0;
}

#ifdef MTK_ROUND_CORNER_SUPPORT
LCM_ROUND_CORNER *primary_display_get_corner_params(void)
{
	if (pgc->plcm == NULL) {
		return NULL;
	}
	if (pgc->plcm->params) {
		return &(pgc->plcm->params->round_corner_params);
	} else {
		DISPERR("lcm_params is null\n");
		return NULL;
	}
}

int disp_get_round_corner_size(void)
{
	/* size = pattern_w * pattern_h * 2(top/bottom) * BPP */
	return DISP_GetScreenWidth() * DISP_GetScreenHeight() * 4;
}

#endif

int primary_display_get_width(void)
{
	if (pgc->plcm == NULL) {
		pgc->plcm = disp_lcm_probe(NULL, LCM_INTERFACE_NOTDEFINED);
		DISPMSG("lcm handle is null, after probe:0x%08x\n",pgc->plcm);
		if (pgc->plcm == NULL)
			return 0;
	}

	if (pgc->plcm->params) {
		return pgc->plcm->params->width;
	} else {
		DISPERR("lcm_params is null!\n");
		return 0;
	}
}

int primary_display_get_height(void)
{
	if (pgc->plcm == NULL) {
		pgc->plcm = disp_lcm_probe(NULL, LCM_INTERFACE_NOTDEFINED);
		DISPMSG("lcm handle is null, after probe:0x%08x\n",pgc->plcm);
		if (pgc->plcm == NULL)
			return 0;
	}
	if (pgc->plcm->params) {
		return pgc->plcm->params->height;
	} else {
		DISPERR("lcm_params is null!\n");
		return 0;
	}
}

int primary_display_get_bpp(void)
{
	return 32;
}

int primary_display_get_pages(void)
{
	return 3;
}

int primary_display_diagnose(void)
{
	int ret = 0;
	dpmgr_check_status(pgc->dpmgr_handle);
	return ret;
}

int primary_display_trigger(int blocking)
{
	int ret = 0;
	static int count = 0;

	DISPFUNC();
	if (pgc->mode == DIRECT_LINK_MODE || pgc->mode == SINGLE_LAYER_MODE) {
		if (dpmgr_path_is_busy(pgc->dpmgr_handle)) {
			if (primary_display_is_video_mode()) {
				return 0;
			}
			dpmgr_wait_event_timeout(pgc->dpmgr_handle, DISP_PATH_EVENT_FRAME_DONE, HZ*1);
		}
		DISPCHECK("trigger mode: %s\n", (pgc->mode == DIRECT_LINK_MODE)?"DIRECT_LINK":"SINGLE_LAYER");
		if (count++ ==0)
			disp_lcm_update(pgc->plcm, 0, 0, pgc->plcm->params->width, pgc->plcm->params->height, 0);
		dpmgr_path_start(pgc->dpmgr_handle, primary_display_use_cmdq);
		if (primary_display_use_cmdq == CMDQ_DISABLE) {
			dpmgr_path_trigger(pgc->dpmgr_handle, NULL, primary_display_use_cmdq);
		}
	} else {
		DISPCHECK("primary display mode is WRONG(%d)\n", (unsigned int)pgc->mode);
	}

	return ret;
}

extern int DSI_BIST_Pattern_Test(DISP_MODULE_ENUM module, void* cmdq, bool enable, unsigned int color);

int primary_display_config_input(disp_input_config* input)
{
	int ret = 0;
	int i=0;
	int layer =0;
	disp_ddp_path_config data_config;

	DISPFUNC();
	// all dirty should be cleared in dpmgr_path_get_last_config()
	memcpy((void*)&data_config, (void*)dpmgr_path_get_last_config(pgc->dpmgr_handle), sizeof(disp_ddp_path_config));

	// no need do this dirty = 0; dpmgr_path_get_last_config do this.
	data_config.dst_dirty = 0;
	data_config.ovl_dirty = 0;
	data_config.rdma_dirty = 0;
	data_config.wdma_dirty = 0;

	if (pgc->mode == DIRECT_LINK_MODE || pgc->mode == DECOUPLE_MODE) {
		if (dpmgr_path_is_busy(pgc->dpmgr_handle)) {
			if (primary_display_is_video_mode()) {
				dpmgr_wait_event_timeout(pgc->dpmgr_handle, DISP_PATH_EVENT_FRAME_DONE, HZ*1);
			}
		}
		ret = _convert_disp_input_to_ovl(&(data_config.ovl_config[input->layer]), input);
		data_config.ovl_dirty = 1;
		ret = dpmgr_path_config(pgc->dpmgr_handle, &data_config, primary_display_use_cmdq);

		// this is used for decouple mode, to indicate whether we need to trigger ovl
		pgc->need_trigger_overlay = 1;
	} else if (pgc->mode == SINGLE_LAYER_MODE) {
		ret = _convert_disp_input_to_rdma(&data_config.rdma_config, input);
		data_config.rdma_dirty= 1;
		ret = dpmgr_path_config(pgc->dpmgr_handle, &data_config, primary_display_use_cmdq);
	} else if (pgc->mode == DEBUG_RDMA1_DSI0_MODE) {
		ret = _convert_disp_input_to_rdma(&(data_config.rdma_config), input);
		data_config.rdma_dirty= 1;
		if (primary_display_is_video_mode() && dpmgr_path_is_busy(pgc->dpmgr_handle) == 1) {
			// TODO: should use wait_event_timeout_or_idle
			dpmgr_wait_event_timeout(pgc->dpmgr_handle, DISP_PATH_EVENT_FRAME_DONE, HZ*5);
		}
		ret = dpmgr_path_config(pgc->dpmgr_handle, &data_config, CMDQ_DISABLE);
	} else {
		DISPCHECK("primary display mode is WRONG(%d)\n", (unsigned int)pgc->mode);
	}

	return ret;
}

int primary_display_is_video_mode(void)
{
	// TODO: we should store the video/cmd mode in runtime, because  will support cmd/vdo dynamic switch
	return disp_lcm_is_video_mode(pgc->plcm);
}

int primary_display_get_vsync_interval(void)
{
	int ret = 0;
	unsigned int time0 = 0;
	unsigned int time1 = 0;
	unsigned int lcd_time = 0;

	ret = dpmgr_wait_event_timeout(pgc->dpmgr_handle, DISP_PATH_EVENT_IF_VSYNC, 2000);
	if (ret <= 0)
		goto fail;

	ret = dpmgr_wait_event_timeout(pgc->dpmgr_handle, DISP_PATH_EVENT_IF_VSYNC, 2000);
	if (ret <= 0)
		goto fail;

	// because we are polling irq status, so the first event should be ignored
	time0 = gpt4_tick2time_us(gpt4_get_current_tick());

	ret = dpmgr_wait_event_timeout(pgc->dpmgr_handle, DISP_PATH_EVENT_IF_VSYNC, 2000);
	if (ret <= 0)
		goto fail;

	ret = dpmgr_wait_event_timeout(pgc->dpmgr_handle, DISP_PATH_EVENT_IF_VSYNC, 2000);
	if (ret > 0) {
		time1 = gpt4_tick2time_us(gpt4_get_current_tick());
	} else
		goto fail;

	lcd_time = (time1 - time0)/2;

	if (0 != lcd_time)
		return (100000000/lcd_time);
	else
		return (6000);
fail:
	DISPERR("wait event fail\n");
	return 0;
}

int primary_display_setbacklight(unsigned int level)
{
	DISPMSG("lk %s level=%d\n",__func__,level);
	int ret=0;
	if (pgc->dpmgr_handle == NULL) {
		DISPCHECK("lk set backlight early!\n");
		return 0;
	}
	if (dpmgr_path_is_busy(pgc->dpmgr_handle)) {
		DISPCHECK("primary display path is busy\n");
		ret = dpmgr_wait_event_timeout(pgc->dpmgr_handle, DISP_PATH_EVENT_FRAME_DONE, HZ*1);
		DISPCHECK("wait frame done ret:%d\n", ret);
	}
	disp_lcm_set_backlight(pgc->plcm,level);
	return 0;
}

UINT32 DISP_GetScreenWidth(void)
{
	return primary_display_get_width();
}

UINT32 DISP_GetScreenHeight(void)
{
	return primary_display_get_height();
}

UINT32 DISP_GetActiveHeight(void)
{
	if (pgc->plcm == NULL) {
		pgc->plcm = disp_lcm_probe(NULL, LCM_INTERFACE_NOTDEFINED);
		DISPERR("lcm handle is null, after probe:0x%08x\n",pgc->plcm);
		if (pgc->plcm == NULL)return 0;
	}

	if (pgc->plcm->params) {
		return pgc->plcm->params->physical_height;
	} else {
		DISPERR("lcm_params is null!\n");
		return 0;
	}
}

UINT32 DISP_GetActiveWidth(void)
{
	if (pgc->plcm == NULL) {
		pgc->plcm = disp_lcm_probe(NULL, LCM_INTERFACE_NOTDEFINED);
		DISPERR("lcm handle is null, after probe:0x%08x\n",pgc->plcm);
		if (pgc->plcm == NULL)return 0;
	}

	if (pgc->plcm->params) {
		return pgc->plcm->params->physical_width;
	} else {
		DISPERR("lcm_params is null!\n");
		return 0;
	}
}

int primary_display_capture_framebuffer(unsigned int *pbuf)
{
	return 0;
}

#define ALIGN_TO(x, n)  \
    (((x) + ((n) - 1)) & ~((n) - 1))

static UINT32 disp_fb_bpp = 32;     ///ARGB8888
static UINT32 disp_fb_pages = 3;    //three for framebuffer, one for dim layer
UINT32 DISP_GetScreenBpp(void)
{
	return disp_fb_bpp;
}

UINT32 DISP_GetPages(void)
{
	return disp_fb_pages;   // Double Buffers
}

// TODO: could we use the same header file between lk/kernel to avoid definition non-match issue?
#define DAL_BPP                 (2)
#define DAL_WIDTH           (DISP_GetScreenWidth())
#define DAL_HEIGHT          (DISP_GetScreenHeight())

UINT32 DAL_GetLayerSize(void)
{
	return DAL_WIDTH * DAL_HEIGHT * DAL_BPP + 4096;
}

UINT32 DISP_GetFBRamSize(void)
{
	return ALIGN_TO(DISP_GetScreenWidth(), MTK_FB_ALIGNMENT) * ALIGN_TO(DISP_GetScreenHeight(), MTK_FB_ALIGNMENT) * ((DISP_GetScreenBpp() + 7) >> 3) * DISP_GetPages();
}

unsigned int DISP_GetVRamSize(void)
{
	static UINT32 vramSize = 0;
#ifdef MTK_ROUND_CORNER_SUPPORT
	LCM_ROUND_CORNER *corner_params;
	char *pixel;
#endif

	if (0 == vramSize) {
		vramSize = DISP_GetFBRamSize();

		vramSize += DAL_GetLayerSize();

#ifdef MTK_ROUND_CORNER_SUPPORT
		corner_params = primary_display_get_corner_params();
		vramSize += disp_get_round_corner_size();
		DISPDBG("round corner size: %u bytes\n", disp_get_round_corner_size());
#endif

		vramSize = ALIGN_TO(vramSize, 0x100000);

		DISPMSG("DISP_GetVRamSize: %u bytes\n", vramSize);
	}

	return vramSize;
}