cmd/amlogic/cmd_hdmitx21.c

// SPDX-License-Identifier: (GPL-2.0+ OR MIT)
/*
 * Copyright (c) 2019 Amlogic, Inc. All rights reserved.
 */

#include <common.h>
#include <command.h>
#include <env.h>
#include <malloc.h>
#include <asm/byteorder.h>
#include <amlogic/clk_measure.h>
#include <amlogic/media/vout/hdmitx21/hdmitx.h>
#include <linux/delay.h>
#include <image.h>
#include <amlogic/media/dv/dolby_vision.h>
#include <linux/libfdt_env.h>
#include <amlogic/media/vout/dsc.h>
#include <amlogic/media/vout/aml_vinfo.h>
#include <linux/arm-smccc.h>

static unsigned char edid_raw_buf[512] = {0};
/* there may be outputmode/2/3 when in multi-display case,
 * sel_hdmimode is used to save the selected hdmi mode
 */
static char sel_hdmimode[MODE_LEN] = {0};

static void dump_full_edid(const unsigned char *buf)
{
	int i;
	int blk_no;

	if (!buf)
		return;
	blk_no = buf[126] + 1;
	if (blk_no > 4)
		blk_no = 4;

	if (blk_no == 2)
		if (buf[128 + 4] == 0xe2 && buf[128 + 5] == 0x78)
			blk_no = buf[128 + 6] + 1;
	if (blk_no > EDID_MAX_BLOCK)
		blk_no = EDID_MAX_BLOCK;

	printf("dump EDID rawdata\n");
	printf("  ");
	for (i = 0; i < blk_no * EDID_BLK_SIZE; i++)
		printf("%02x", buf[i]);
	printf("\n");
}

static int do_edid(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	unsigned char st = 0;
	struct hdmitx_dev *hdev = get_hdmitx21_device();

	memset(edid_raw_buf, 0, ARRAY_SIZE(edid_raw_buf));

	st = hdev->hwop.read_edid(edid_raw_buf);

	if (!st)
		printf("edid read failed\n");

	return st;
}

static int do_rx_det(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	unsigned char st = 0;
	struct hdmitx_dev *hdev = get_hdmitx21_device();

	memset(edid_raw_buf, 0, ARRAY_SIZE(edid_raw_buf));

	// read edid raw data
	// current only support read 1 byte edid data
	st = hdev->hwop.read_edid(edid_raw_buf);

	if (st) {
		if (edid_raw_buf[250] == 0xfb && edid_raw_buf[251] == 0x0c) {
			printf("RX is FBC\n");

			// set outputmode ENV
			switch (edid_raw_buf[252] & 0x0f) {
			case 0x0:
				run_command("setenv outputmode 1080p50hz", 0);
				break;
			case 0x1:
				run_command("setenv outputmode 2160p50hz420", 0);
				break;
			case 0x2:
				run_command("setenv outputmode 1080p50hz44410bit", 0);
				break;
			case 0x3:
				run_command("setenv outputmode 2160p50hz42010bit", 0);
				break;
			case 0x4:
				run_command("setenv outputmode 2160p50hz42210bit", 0);
				break;
			case 0x5:
				run_command("setenv outputmode 2160p50hz", 0);
				break;
			default:
				run_command("setenv outputmode 1080p50hz", 0);
				break;
			}

			/*et RX 3D Info*/
			switch ((edid_raw_buf[252] >> 4) & 0x0f) {
			case 0x00:
				run_command("setenv rx_3d_info 0", 0);
				break;
			case 0x01:
				run_command("setenv rx_3d_info 1", 0);
				break;
			case 0x02:
				run_command("setenv rx_3d_info 2", 0);
				break;
			case 0x03:
				run_command("setenv rx_3d_info 3", 0);
				break;
			case 0x04:
				run_command("setenv rx_3d_info 4", 0);
				break;
			default:
				break;
			}

			switch (edid_raw_buf[253]) {
			case 0x1:
				/*TODO*/
				break;
			case 0x2:
				/*TODO*/
				break;
			default:
				break;
			}
		}
	} else {
		printf("edid read failed\n");
	}

	return st;
}

static void save_default_720p(void)
{
	memcpy(sel_hdmimode, DEFAULT_HDMI_MODE, sizeof(DEFAULT_HDMI_MODE));
	if (is_hdmi_mode(env_get("outputmode")))
		env_set("outputmode", DEFAULT_HDMI_MODE);
	else if (is_hdmi_mode(env_get("outputmode2")))
		env_set("outputmode2",	DEFAULT_HDMI_MODE);
	else if (is_hdmi_mode(env_get("outputmode3")))
		env_set("outputmode3", DEFAULT_HDMI_MODE);
	env_set("colorattribute", DEFAULT_COLOR_FORMAT);
}

static void hdmitx_mask_rx_info(struct hdmitx_dev *hdev)
{
	if (!hdev || !hdev->para)
		return;

	if (env_get("colorattribute"))
		hdmitx21_get_fmtpara(sel_hdmimode, env_get("colorattribute"));

	/* when current output color depth is 8bit, mask hdr capability */
	/* refer to SWPL-44445 for more detail */
	if (hdev->para->cd == COLORDEPTH_24B)
		memset(&hdev->RXCap.hdr_info, 0, sizeof(struct hdr_info));
}

/* If environment qms_en is true, and RX supports QMS, and the
 * output mode is BRR then enable TX QMS
 */
static void qms_scene_pre_process(struct hdmitx_dev *hdev)
{
	bool env_qms_en = 0;
	bool rx_qms_cap = 0;
	enum hdmi_vic qms_brr_vic = HDMI_UNKNOWN;
	const struct hdmi_timing *t = NULL;
	char *color = NULL;
	const char *i_modes[3] = {
		"480i", "576i", "1080i",
	};
	char *mode;
	int i;

	hdev->qms_en = 0; /* default as 0 */
	/* if current mode is interlaced mode, then skip QMS */
	mode = env_get("hdmimode");
	if (!mode)
		return;
	for (i = 0; i < 3; i++) {
		if (strstr(mode, i_modes[i]))
			return;
	}

	/* check uboot environment */
	if (env_get("qms_en") && (env_get_ulong("qms_en", 10, 0) == 1))
		env_qms_en = 1;

	rx_qms_cap = hdev->RXCap.qms;

	qms_brr_vic = hdmitx_find_brr_vic(hdev->vic);

	if (env_qms_en && rx_qms_cap && qms_brr_vic != HDMI_UNKNOWN)
		hdev->qms_en = 1;
	pr_info("QMS: env %d rx %d vic %d brr_vic %d\n", env_qms_en, rx_qms_cap,
		hdev->vic, qms_brr_vic);
	if (!hdev->qms_en)
		return;
	hdev->brr_vic = qms_brr_vic;
	/* reconfig the hdmi para */
	t = hdmitx21_gettiming_from_vic(hdev->brr_vic);
	if (!t) {
		pr_info("not find brr_vic %d timing\n", hdev->brr_vic);
		return;
	}
	color = env_get("colorattribute");
	/* save brr_vic to vic without the environment */
	hdev->vic = hdev->brr_vic;
	hdev->para = hdmitx21_get_fmtpara(t->sname ? t->sname : t->name, color);
}

static void qms_scene_post_process(struct hdmitx_dev *hdev)
{
	const struct hdmi_timing *t = NULL;

	// Init QMS parameter
	vrr_init_qms_para(hdev);

	/* set the BRR name as hdmimode and outputmode */
	if (hdev->qms_en) {
		t = hdmitx21_gettiming_from_vic(hdev->brr_vic);
		if (t) {
			env_set("hdmimode", t->sname ? t->sname : t->name);
			env_set("outputmode", env_get("hdmimode")); /* reassing to outputmode */
			pr_info("set outputmode as %s %d\n", env_get("outputmode"), hdev->brr_vic);
		}
	}
}

static int do_output(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	const struct hdmi_timing *timing = NULL;
	struct hdmitx_dev *hdev = get_hdmitx21_device();

#ifdef CONFIG_PXP_EMULATOR
	hdmitx21_pxp_init(1);
#endif
	if (argc < 1)
		return cmd_usage(cmdtp);

	if (strcmp(argv[1], "list") == 0) {
		hdev->hwop.list_support_modes();
	} else if (strcmp(argv[1], "bist") == 0) {
		unsigned int mode = 0;

		if (strcmp(argv[2], "off") == 0)
			mode = 0;
		else if (strcmp(argv[2], "line") == 0)
			mode = 2;
		else if (strcmp(argv[2], "dot") == 0)
			mode = 3;
		else if (strcmp(argv[2], "x") == 0)
			mode = 'x';
		else if (strcmp(argv[2], "X") == 0)
			mode = 'X';
		else
			mode = simple_strtoul(argv[2], NULL, 10);
		hdev->hwop.test_bist(mode);
	} else if (strcmp(argv[1], "prbs") == 0) {
		hdev->para->cs = HDMI_COLORSPACE_RGB;
		hdev->para->cd = COLORDEPTH_24B;
		hdev->vic = HDMI_16_1920x1080p60_16x9;
		hdmitx21_set(hdev);
		hdev->hwop.test_prbs();
	} else if (strncmp(argv[1], "div40", 5) == 0) {
		bool div40 = 0;

		if (argv[1][5] == '1')
			div40 = 1;
		hdev->hwop.set_div40(div40);
	} else { /* "output" */
		if (!hdev->pxp_mode) {
			if (!hdmitx_edid_check_data_valid(0, hdev->rawedid)) {
				/* in SWPL-34712: if EDID parsing error in kernel,
				 * only forcely output default mode(480p,RGB,8bit)
				 * in sysctl, not save the default mode to env.
				 * if uboot follow this rule, will cause issue OTT-19333:
				 * uboot read edid error and then output default mode,
				 * without save it mode env. if then kernel edid normal,
				 * sysctrl/kernel get mode from env, the actual output
				 * mode differs with outputmode env,it will
				 * cause display abnormal(such as stretch). so don't
				 * follow this rule in uboot, that's to say the actual
				 * output mode needs to stays with the outputmode env.
				 */
				printf("edid parsing ng, forcely output 720p, rgb,8bit\n");
				save_default_720p();
				hdev->vic = HDMI_4_1280x720p60_16x9;
				hdev->para =
					hdmitx21_get_fmtpara("720p60hz", "rgb,8bit");
				hdev->para->cs = HDMI_COLORSPACE_RGB;
				hdev->para->cd = COLORDEPTH_24B;
				hdmitx21_set(hdev);
				return CMD_RET_SUCCESS;
			}
		}
		if (!env_get("colorattribute"))
			env_set("colorattribute", "444,8bit");
		hdev->para = hdmitx21_get_fmtpara(argv[1], env_get("colorattribute"));
		hdev->vic = hdev->para->timing.vic;
		if (hdev->vic == HDMI_0_UNKNOWN) {
			/* Not find VIC */
			printf("Not find '%s' mapped VIC\n", argv[1]);
			return CMD_RET_FAILURE;
		}
		if (strstr(argv[1], "hz420"))
			hdev->para->cs = HDMI_COLORSPACE_YUV420;
		/* S5 support over 6G, T7 not support */
		switch (hdev->vic) {
		case HDMI_96_3840x2160p50_16x9:
		case HDMI_97_3840x2160p60_16x9:
		case HDMI_101_4096x2160p50_256x135:
		case HDMI_102_4096x2160p60_256x135:
		case HDMI_106_3840x2160p50_64x27:
		case HDMI_107_3840x2160p60_64x27:
			if (hdev->chip_type != MESON_CPU_ID_S5) {
				if (hdev->para->cs == HDMI_COLORSPACE_RGB ||
				    hdev->para->cs == HDMI_COLORSPACE_YUV444) {
					if (hdev->para->cd != COLORDEPTH_24B) {
						printf("vic %d cs %d has no cd %d\n",
							hdev->vic,
							hdev->para->cs,
							hdev->para->cd);
						hdev->para->cd = COLORDEPTH_24B;
						printf("set cd as %d\n", COLORDEPTH_24B);
					}
				}
			}
			break;
		default:
			/* In Spec2.1 Table 7-34, greater than 2160p30hz will support y420 */
			timing = hdmitx21_gettiming_from_vic(hdev->vic);
			if (!timing)
				break;
			if (timing->v_active > 2160 && timing->v_freq > 30000)
				break;
			if (timing->v_active >= 4320)
				break;
			if (hdev->para->cs == HDMI_COLORSPACE_YUV420) {
				printf("vic %d has no cs %d\n", hdev->vic,
					hdev->para->cs);
				hdev->para->cs = HDMI_COLORSPACE_YUV444;
				printf("set cs as %d\n", HDMI_COLORSPACE_YUV444);
			}
			break;
		}
		printf("set hdmitx VIC = %d CS = %d CD = %d\n",
			hdev->vic, hdev->para->cs, hdev->para->cd);
		qms_scene_pre_process(hdev);
		/* currently, hdmi mode is always set, if
		 * mode set abort/exit, need to add return
		 * result of mode setting, so that vout
		 * driver will pass it to kernel, and do
		 * mode setting again when vout init in kernel
		 */
		hdmitx21_set(hdev);
		qms_scene_post_process(hdev);
		if (hdev->frl_rate && !hdev->flt_train_st) {
			/* FLT training failed, need go to tmds mode */
			printf("hdmitx frl training failed, set tmds mode\n");
			hdmitx_module_disable();
			hdev->frl_train_fail_flag = true;
			run_command("run init_display", 0);
		}
	}
	return CMD_RET_SUCCESS;
}

static int do_clkmsr(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	struct hdmitx_dev *hdev = get_hdmitx21_device();

	if (hdev->chip_type == MESON_CPU_ID_S5) {
		clk_msr(4);
		clk_msr(8);
		clk_msr(16);
		clk_msr(27);
		clk_msr(63);
		clk_msr(64);
		clk_msr(66);
		clk_msr(68);
		clk_msr(69);
		clk_msr(70);
		clk_msr(71);
		clk_msr(72);
		clk_msr(73);
		clk_msr(74);
		clk_msr(75);
		clk_msr(76);
		clk_msr(79);
		clk_msr(82);
		clk_msr(89);
		clk_msr(90);
		clk_msr(91);
		clk_msr(92);
		clk_msr(93);
		clk_msr(94);
		clk_msr(95);
		return CMD_RET_SUCCESS;
	}
	clk_msr(51);
	clk_msr(59);
	clk_msr(61);
	clk_msr(76);
	clk_msr(77);
	clk_msr(78);
	clk_msr(80);
	clk_msr(81);
	clk_msr(82);
	clk_msr(83);
	clk_msr(219);
	clk_msr(220);
	clk_msr(221);
	clk_msr(222);
	return CMD_RET_SUCCESS;
}

static int do_blank(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	struct hdmitx_dev *hdev = get_hdmitx21_device();

	if (argc < 1)
		return cmd_usage(cmdtp);

	if (strcmp(argv[1], "1") == 0)
		hdev->hwop.output_blank(1);
	if (strcmp(argv[1], "0") == 0)
		hdev->hwop.output_blank(0);

	return CMD_RET_SUCCESS;
}

static int do_off(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	struct hdmitx_dev *hdev = get_hdmitx21_device();

	hdev->vic = HDMI_0_UNKNOWN;
	if (hdev->chip_type == MESON_CPU_ID_S5)
		hdmitx_module_disable();
	hdev->hwop.turn_off();
	printf("turn off hdmitx\n");
	return 1;
}

static int do_dump(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	struct hdmitx_dev *hdev = get_hdmitx21_device();

	hdev->hwop.dump_regs();
	return 1;
}

static int do_reg(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	unsigned long addr = 0;
	unsigned int data = 0;

	if (argc < 1)
		return cmd_usage(cmdtp);

	if (strncmp(argv[1], "rh", 2) == 0) {
		addr = strtoul(argv[1] + 2, NULL, 16);
		data = hdmitx21_rd_reg((unsigned int)addr);
		printf("rd[0x%lx] 0x%x\n", addr, data);
	}

	if (strncmp(argv[1], "wh", 2) == 0) {
		addr = strtoul(argv[1] + 2, NULL, 16);
		data = strtoul(argv[2], NULL, 16);
		hdmitx21_wr_reg(addr, data);
		printf("wr[0x%lx] 0x%x\n", addr, data);
	}

	return 1;
}

static int do_pbist(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	struct hdmitx_dev *hdev = get_hdmitx21_device();

	if (strcmp(argv[1], "1") == 0)
		hdmitx21_pbist_config(hdev, hdev->vic, 1);
	if (strcmp(argv[1], "0") == 0)
		hdmitx21_pbist_config(hdev, hdev->vic, 0);
	return 1;
}

static int do_s7_clk_config(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	struct hdmitx_dev *hdev = get_hdmitx21_device();

	if (strcmp(argv[1], "1") == 0) {
		hdev->s7_clk_config = 1;
		pr_info("s7_clk_config = %d\n",  hdev->s7_clk_config);
	} if (strcmp(argv[1], "0") == 0) {
		hdev->s7_clk_config = 0;
		pr_info("s7_clk_config = %d\n",  hdev->s7_clk_config);
	}
	return 1;
}

static int get_rterm(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	struct arm_smccc_res res;
	u8 rterm_efuse;

	arm_smccc_smc(HDCPTX_IOOPR, HDMITX_GET_RTERM, 0, 0, 0, 0, 0, 0, &res);
	rterm_efuse = (unsigned int)((res.a0) & 0xffffffff);
	pr_info("rterm_efuse = %d\n", rterm_efuse);
	return 1;
}

static int do_debug(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	unsigned int enable_all = 0;
	int pkt_op = 0;
	unsigned int mov_val = 0;
	unsigned char pb[28] = {0x46, 0xD0, 0x00, 0x00, 0x00, 0x00, 0x46, 0xD0,
	0x00, 0x10, 0x21, 0xaa, 0x9b, 0x96, 0x19, 0xfc, 0x19, 0x75, 0xd5, 0x78,
	0x10, 0x21, 0xaa, 0x9b, 0x96, 0x19, 0xfc, 0x19};
	unsigned char hb[3] = {0x01, 0x02, 0x03};

	if (argc < 1)
		return cmd_usage(cmdtp);

	if (strncmp(argv[1], "pkt", 3) == 0) {
		enable_all = strtoul(argv[1] + 3, NULL, 16);
		pkt_op = strtoul(argv[2], NULL, 16);
		mov_val = strtoul(argv[3], NULL, 10);
		pkt_send_position_change(enable_all, pkt_op, mov_val);
	} else if (strncmp(argv[1], "w_dhdr", 6) == 0 ) {
		hdmitx21_write_dhdr_sram();
	} else if (strncmp(argv[1], "r_dhdr", 6) == 0 ) {
		hdmitx21_read_dhdr_sram();
	} else if (strncmp(argv[1], "t_avi", 4) == 0 ) {
		printf("test send avi pkt\n");
		hdmi_avi_infoframe_rawset(hb, pb);
	} else if (strncmp(argv[1], "t_audio", 7) == 0 ) {
		printf("test send audio pkt\n");
		hdmi_audio_infoframe_rawset(hb, pb);
	} else if (strncmp(argv[1], "t_sbtm", 6) == 0 ) {
		printf("test send SBTM pkt\n");
		hdmitx21_send_sbtm_pkt();
	}

	return 1;
}

static bool check_vic_exist(struct hdmitx_dev *hdev, enum hdmi_vic vic,
					int count)
{
	struct rx_cap *rxcap = NULL;
	int i;

	rxcap = &hdev->RXCap;
	for (i = 0; i < count; i++)
		if (vic == rxcap->VIC[i])
			return 1;

	return 0;
}

static void disp_cap_show(struct hdmitx_dev *hdev)
{
	struct rx_cap *rxcap = NULL;
	const struct hdmi_timing *timing = NULL;
	enum hdmi_vic vic;
	int i;
	enum hdmi_vic prefer_vic = HDMI_UNKNOWN;

	if (!hdev)
		return;

	rxcap = &hdev->RXCap;
	printf("disp_cap\n");
	for (i = 0; i < rxcap->VIC_count && i < VIC_MAX_NUM; i++) {
		vic = rxcap->VIC[i];
		if (check_vic_exist(hdev, vic, i))
			continue;
		prefer_vic = hdmitx21_get_prefer_vic(hdev, vic);
		/* if mode_prefer_vic is support by RX, try 16x9 first */
		if (prefer_vic != vic) {
			printf("%s:prefer vic:%d exist, ignore [%d].\n", __func__, prefer_vic, vic);
			continue;
		}
		timing = hdmitx21_gettiming_from_vic(vic);
		if (timing && vic < HDMITX_VESA_OFFSET && !is_vic_over_limited_1080p(vic))
			printf("  %s\n", timing->sname ? timing->sname : timing->name);
	}
	printf("420_cap\n");
	for (i = 0; i < Y420_VIC_MAX_NUM; i++) {
		vic = rxcap->y420_vic[i];
		printf("420vic:%d\n", vic);
	}
}

static void vesa_cap_show(struct hdmitx_dev *hdev)
{
}

static void dc_cap_show(struct hdmitx_dev *hdev)
{
	enum hdmi_vic vic = HDMI_0_UNKNOWN;
	struct rx_cap *prxcap = &hdev->RXCap;
	const struct dv_info *dv = &hdev->RXCap.dv_info;

	printf("dc_cap\n");
	if (prxcap->dc_36bit_420)
		printf("420,12bit\n");
	if (prxcap->dc_30bit_420) {
		printf("420,10bit\n");
		printf("420,8bit\n");
	} else {
		vic = hdmitx_edid_get_VIC(hdev, "2160p60hz420", 0);
		if (vic != HDMI_0_UNKNOWN) {
			printf("420,8bit\n");
			goto next444;
		}
		vic = hdmitx_edid_get_VIC(hdev, "2160p50hz420", 0);
		if (vic != HDMI_0_UNKNOWN) {
			printf("420,8bit\n");
			goto next444;
		}
		vic = hdmitx_edid_get_VIC(hdev, "smpte60hz420", 0);
		if (vic != HDMI_0_UNKNOWN) {
			printf("420,8bit\n");
			goto next444;
		}
		vic = hdmitx_edid_get_VIC(hdev, "smpte50hz420", 0);
		if (vic != HDMI_0_UNKNOWN) {
			printf("420,8bit\n");
			goto next444;
		}
	}
next444:
	if (prxcap->native_Mode & (1 << 5)) {
		if (prxcap->dc_y444) {
			if (prxcap->dc_36bit || dv->sup_10b_12b_444 == 0x2)
				printf("444,12bit\n");
			if (prxcap->dc_30bit || dv->sup_10b_12b_444 == 0x1)
				printf("444,10bit\n");
		}
		printf("444,8bit\n");
	}
	/* y422, not check dc */
	if (prxcap->native_Mode & (1 << 4)) {
		printf("422,12bit\n");
		printf("422,10bit\n");
		printf("422,8bit\n");
	}

	if (prxcap->dc_36bit || dv->sup_10b_12b_444 == 0x2)
		printf("rgb,12bit\n");
	if (prxcap->dc_30bit || dv->sup_10b_12b_444 == 0x1)
		printf("rgb,10bit\n");
	printf("rgb,8bit\n");
}

static void aud_cap_show(struct hdmitx_dev *hdev)
{
}

static void hdr_cap_show(struct hdmitx_dev *hdev)
{
	int hdr10plugsupported = 0;
	struct hdr_info *hdr = &hdev->RXCap.hdr_info;
	const struct hdr10_plus_info *hdr10p = &hdev->RXCap.hdr_info.hdr10plus_info;

	printf("\nhdr_cap\n");
	if (hdr10p->ieeeoui == HDR10_PLUS_IEEE_OUI &&
		hdr10p->application_version != 0xFF)
		hdr10plugsupported = 1;
	printf("HDR10Plus Supported: %d\n", hdr10plugsupported);
	printf("HDR Static Metadata:\n");
	printf("    Supported EOTF:\n");
	printf("        Traditional SDR: %d\n", !!(hdr->hdr_support & HDR_SUP_EOTF_SDR));
	printf("        Traditional HDR: %d\n", !!(hdr->hdr_support & HDR_SUP_EOTF_HDR));
	printf("        SMPTE ST 2084: %d\n", !!(hdr->hdr_support & HDR_SUP_EOTF_SMPTE_ST_2084));
	printf("        Hybrid Log-Gamma: %d\n", !!(hdr->hdr_support & HDR_SUP_EOTF_HLG));
	printf("    Supported SMD type1: %d\n", hdr->static_metadata_type1);
	printf("    Luminance Data\n");
	printf("        Max: %d\n", hdr->lumi_max);
	printf("        Avg: %d\n", hdr->lumi_avg);
	printf("        Min: %d\n\n", hdr->lumi_min);
	printf("HDR Dynamic Metadata:");
}

static void _dv_cap_show(const struct dv_info *dv)
{
	int i;

	if (dv->ieeeoui != DV_IEEE_OUI || dv->block_flag != CORRECT) {
		printf("The Rx don't support DolbyVision\n");
		return;
	}
	printf("DolbyVision RX support list:\n");

	if (dv->ver == 0) {
		printf("VSVDB Version: V%d\n", dv->ver);
		printf("2160p%shz: 1\n", dv->sup_2160p60hz ? "60" : "30");
		printf("Support mode:\n");
		printf("  DV_RGB_444_8BIT\n");
		if (dv->sup_yuv422_12bit)
			printf("  DV_YCbCr_422_12BIT\n");
	}
	if (dv->ver == 1) {
		printf("VSVDB Version: V%d(%d-byte)\n", dv->ver, dv->length + 1);
		if (dv->length == 0xB) {
			printf("2160p%shz: 1\n", dv->sup_2160p60hz ? "60" : "30");
		printf("Support mode:\n");
		printf("  DV_RGB_444_8BIT\n");
		if (dv->sup_yuv422_12bit)
			printf("  DV_YCbCr_422_12BIT\n");
		if (dv->low_latency == 0x01)
			printf("  LL_YCbCr_422_12BIT\n");
		}

		if (dv->length == 0xE) {
			printf("2160p%shz: 1\n", dv->sup_2160p60hz ? "60" : "30");
			printf("Support mode:\n");
			printf("  DV_RGB_444_8BIT\n");
			if (dv->sup_yuv422_12bit)
				printf("  DV_YCbCr_422_12BIT\n");
		}
	}
	if (dv->ver == 2) {
		printf("VSVDB Version: V%d\n", dv->ver);
		printf("2160p%shz: 1\n", dv->sup_2160p60hz ? "60" : "30");
		printf("Support mode:\n");
		if (dv->Interface != 0x00 && dv->Interface != 0x01) {
			printf("  DV_RGB_444_8BIT\n");
			if (dv->sup_yuv422_12bit)
				printf("  DV_YCbCr_422_12BIT\n");
		}
		printf("  LL_YCbCr_422_12BIT\n");
		if (dv->Interface == 0x01 || dv->Interface == 0x03) {
			if (dv->sup_10b_12b_444 == 0x1)
				printf("  LL_RGB_444_10BIT\n");
			if (dv->sup_10b_12b_444 == 0x2)
				printf("  LL_RGB_444_12BIT\n");
		}
	}
	printf("IEEEOUI: 0x%06x\n", dv->ieeeoui);
	printf("VSVDB: ");
	for (i = 0; i < (dv->length + 1); i++)
		printf("%02x", dv->rawdata[i]);
	printf("\n");
}

static void dv_cap_show(struct hdmitx_dev *hdev)
{
	const struct dv_info *dv = &hdev->RXCap.dv_info;

	printf("dv_cap\n");
	if (dv->ieeeoui != DV_IEEE_OUI) {
		printf("The Rx don't support DolbyVision\n");
		return;
	}
	_dv_cap_show(dv);
}

static void edid_cap_show(struct hdmitx_dev *hdev)
{
	int i;
	struct rx_cap *prxcap = &hdev->RXCap;

	printf("Rx EDID Parse:\n");
	printf("Rx Manufacturer Name: %s\n", prxcap->IDManufacturerName);
	printf("Rx Product Code: %02x%02x\n",
		prxcap->IDProductCode[0], prxcap->IDProductCode[1]);
	printf("Rx Serial Number: %02x%02x%02x%02x\n",
		prxcap->IDSerialNumber[0],
		prxcap->IDSerialNumber[1],
		prxcap->IDSerialNumber[2],
		prxcap->IDSerialNumber[3]);
	printf("Rx Product Name: %s\n", prxcap->ReceiverProductName);

	printf("Manufacture Week: %d\n", prxcap->manufacture_week);
	printf("Manufacture Year: %d\n", prxcap->manufacture_year + 1990);

	printf("Physical size(mm): %d x %d\n",
		prxcap->physical_width, prxcap->physical_height);

	printf("EDID Version: %d.%d\n",
		prxcap->edid_version, prxcap->edid_revision);

/*	printf(
 *		"EDID block number: 0x%x\n", tx_comm->EDID_buf[0x7e]);
 *
 *
 *	printf(
 *		"Source Physical Address[a.b.c.d]: %x.%x.%x.%x\n",
 *		hdmitx_device->hdmi_info.vsdb_phy_addr.a,
 *		hdmitx_device->hdmi_info.vsdb_phy_addr.b,
 *		hdmitx_device->hdmi_info.vsdb_phy_addr.c,
 *		hdmitx_device->hdmi_info.vsdb_phy_addr.d);
 */

	// TODO native_vic2
	printf("native Mode %x, VIC (native %d):\n",
		prxcap->native_Mode, prxcap->native_vic);

	printf("ColorDeepSupport %x\n", prxcap->ColorDeepSupport);

	for (i = 0; i < prxcap->VIC_count ; i++) {
		printf("%d ", prxcap->VIC[i]);
	}
	printf("\n");
	printf("Audio {format, channel, freq, cce}\n");
	for (i = 0; i < prxcap->AUD_count; i++) {
		printf("{%d, %d, %x, %x}\n",
			prxcap->RxAudioCap[i].audio_format_code,
			prxcap->RxAudioCap[i].channel_num_max,
			prxcap->RxAudioCap[i].freq_cc,
			prxcap->RxAudioCap[i].cc3);
	}
	printf("Speaker Allocation: %x\n", prxcap->RxSpeakerAllocation);
	printf("Vendor: 0x%x ( %s device)\n", prxcap->ieeeoui, (prxcap->ieeeoui) ? "HDMI" : "DVI");

	printf("MaxTMDSClock1 %d MHz\n", prxcap->Max_TMDS_Clock1 * 5);

	if (prxcap->hf_ieeeoui) {
		printf("Vendor2: 0x%x\n",
			prxcap->hf_ieeeoui);
		printf("MaxTMDSClock2 %d MHz\n",
			prxcap->Max_TMDS_Clock2 * 5);
	}

	printf("MaxFRLRate: %d\n", prxcap->max_frl_rate);

	if (prxcap->allm)
		printf("ALLM: %x\n", prxcap->allm);

	if (prxcap->cnc3)
		printf("Game/CNC3: %x\n", prxcap->cnc3);

	printf("vLatency: ");
	if (prxcap->vLatency == LATENCY_INVALID_UNKNOWN)
		printf(" Invalid/Unknown\n");
	else if (prxcap->vLatency == LATENCY_NOT_SUPPORT)
		printf(" UnSupported\n");
	else
		printf(" %d\n", prxcap->vLatency);

	printf("aLatency: ");
	if (prxcap->aLatency == LATENCY_INVALID_UNKNOWN)
		printf(" Invalid/Unknown\n");
	else if (prxcap->aLatency == LATENCY_NOT_SUPPORT)
		printf(" UnSupported\n");
	else
		printf(" %d\n", prxcap->aLatency);

	printf("i_vLatency: ");
	if (prxcap->i_vLatency == LATENCY_INVALID_UNKNOWN)
		printf(" Invalid/Unknown\n");
	else if (prxcap->i_vLatency == LATENCY_NOT_SUPPORT)
		printf(" UnSupported\n");
	else
		printf(" %d\n", prxcap->i_vLatency);

	printf("i_aLatency: ");
	if (prxcap->i_aLatency == LATENCY_INVALID_UNKNOWN)
		printf(" Invalid/Unknown\n");
	else if (prxcap->i_aLatency == LATENCY_NOT_SUPPORT)
		printf(" UnSupported\n");
	else
		printf(" %d\n", prxcap->i_aLatency);

	if (prxcap->colorimetry_data)
		printf("ColorMetry: 0x%x\n", prxcap->colorimetry_data);

	printf("SCDC: %x\n", prxcap->scdc_present);

	printf("RR_Cap: %x\n",
		prxcap->scdc_rr_capable);
	printf("LTE_340M_Scramble: %x\n",
		prxcap->lte_340mcsc_scramble);
	/* dsc capability */
	printf("dsc_10bpc: %d\n",
		 prxcap->dsc_10bpc);
	printf("dsc_12bpc: %d\n",
		 prxcap->dsc_12bpc);
	printf("dsc_16bpc: %d\n",
		 prxcap->dsc_16bpc);
	printf("dsc_all_bpp: %d\n",
		 prxcap->dsc_all_bpp);
	printf("dsc_native_420: %d\n",
		 prxcap->dsc_native_420);
	printf("dsc_1p2: %d\n",
		 prxcap->dsc_1p2);
	printf("dsc_max_slices: 0x%x(%d slices)\n",
		 prxcap->dsc_max_slices, dsc_max_slices_num[prxcap->dsc_max_slices]);
	printf("dsc_max_frl_rate: 0x%x\n",
		 prxcap->dsc_max_frl_rate);
	printf("dsc_total_chunk_bytes: 0x%x\n",
		 prxcap->dsc_total_chunk_bytes);
	if (prxcap->dv_info.ieeeoui == DOVI_IEEEOUI)
		printf("  DolbyVision%d", prxcap->dv_info.ver);

	if (prxcap->hdr_info2.hdr_support)
		printf("  HDR/%d",
			prxcap->hdr_info2.hdr_support);
	if (prxcap->hdr_info.sbtm_info.sbtm_support)
		printf("  SBTM");
	if (prxcap->dc_y444 || prxcap->dc_30bit || prxcap->dc_30bit_420)
		printf("  DeepColor");
	printf("\n");
	printf("additional_vsif_num: %d\n", prxcap->additional_vsif_num);
	printf("ifdb_present: %d\n", prxcap->ifdb_present);
	/* for checkvalue which maybe used by application to adjust
	 * whether edid is changed
	 */
	printf("checkvalue: %s\n", prxcap->hdmichecksum);

}

static int do_info(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	struct hdmitx_dev *hdev = get_hdmitx21_device();
	struct hdmi_format_para *para;

	if (!hdev) {
		pr_info("null hdmitx dev\n");
		return CMD_RET_FAILURE;
	}
	if (!hdev->para) {
		printf("null hdmitx para\n");
		return CMD_RET_FAILURE;
	}

	para = hdev->para;
	printf("current mode %s vic %d\n", para->timing.name, hdev->vic);
	printf("cd%d cs%d cr%d\n", para->cd, para->cs, para->cr);
	printf("enc_idx %d\n", hdev->enc_idx);
	printf("frac_rate: %d\n", hdev->frac_rate_policy);
	printf("Rx EDID info\n");
	dump_full_edid(hdev->rawedid);
	disp_cap_show(hdev);
	vesa_cap_show(hdev);
	aud_cap_show(hdev);
	hdr_cap_show(hdev);
	dv_cap_show(hdev);
	dc_cap_show(hdev);
	edid_cap_show(hdev);
	printf("dsc policy: %d, enable: %d\n", hdev->dsc_policy, hdev->dsc_en);
	printf("frl_rate: %d\n", hdev->frl_rate);
	return 1;
}

static int xtochar(int num, char *checksum)
{
	struct hdmitx_dev *hdev = get_hdmitx21_device();

	if (((hdev->rawedid[num] >> 4) & 0xf) <= 9)
		checksum[0] = ((hdev->rawedid[num] >> 4) & 0xf) + '0';
	else
		checksum[0] = ((hdev->rawedid[num] >> 4) & 0xf) - 10 + 'a';

	if ((hdev->rawedid[num] & 0xf) <= 9)
		checksum[1] = (hdev->rawedid[num] & 0xf) + '0';
	else
		checksum[1] = (hdev->rawedid[num] & 0xf) - 10 + 'a';

	return 0;
}

/* hdr_priority definition:
 *   strategy1: bit[3:0]
 *       0: original cap
 *       1: disable dolby vision cap
 *       2: disable dolby vision and hdr/hlg cap
 *   strategy2:
 *       bit4: 1: disable dv  0:enable dv
 *       bit5: 1: disable hdr10/hdr10+  0: enable hdr10/hdr10+
 *       bit6: 1: disable hlg  0: enable hlg
 *   bit28-bit31 choose strategy: bit[31:28]
 *       0: strategy1
 *       1: strategy2
 */

/* for uboot, there is no need to dynamically change the hdr_priority as
 * kernel. So below functions only implement the disable_xxx_info() function,
 * and leave the enable_xxx_info as blank
 */

/* dv_info */
static void enable_dv_info(struct dv_info *des, const struct dv_info *src)
{
	if (!des || !src)
		return;
}

static void disable_dv_info(struct dv_info *des)
{
	if (!des)
		return;

	memset(des, 0, sizeof(*des));
}

/* hdr10 */
static void enable_hdr10_info(struct hdr_info *des, const struct hdr_info *src)
{
	if (!des || !src)
		return;
}

static void disable_hdr10_info(struct hdr_info *des)
{
	if (!des)
		return;

	des->hdr_support = des->hdr_support & 0xB;
	des->static_metadata_type1 = 0;
	des->lumi_max = 0;
	des->lumi_avg = 0;
	des->lumi_min = 0;
}

/* hdr10plus */
static void enable_hdr10p_info(struct hdr10_plus_info *des, const struct hdr10_plus_info *src)
{
	if (!des || !src)
		return;
}

static void disable_hdr10p_info(struct hdr10_plus_info *des)
{
	if (!des)
		return;

	memset(des, 0, sizeof(*des));
}

/* hlg */
static void enable_hlg_info(struct hdr_info *des, const struct hdr_info *src)
{
	if (!des || !src)
		return;
}

static void disable_hlg_info(struct hdr_info *des)
{
	if (!des)
		return;

	des->hdr_support = des->hdr_support & 0x7;
}

static void enable_all_hdr_info(struct rx_cap *prxcap)
{
	if (!prxcap)
		return;
}

static void update_hdr_strategy1(struct rx_cap *prxcap, u32 strategy)
{
	if (!prxcap)
		return;

	switch (strategy) {
	case 0:
		enable_all_hdr_info(prxcap);
		break;
	case 1:
		disable_dv_info(&prxcap->dv_info);
		break;
	case 2:
		disable_dv_info(&prxcap->dv_info);
		disable_hdr10_info(&prxcap->hdr_info);
		disable_hdr10p_info(&prxcap->hdr_info.hdr10plus_info);
		disable_hlg_info(&prxcap->hdr_info);
		break;
	default:
		break;
	}
}

static void update_hdr_strategy2(struct rx_cap *prxcap, u32 strategy)
{
	if (!prxcap)
		return;

	/* bit4: 1 disable dv  0 enable dv */
	if (strategy & BIT(4))
		disable_dv_info(&prxcap->dv_info);
	else
		enable_dv_info(&prxcap->dv_info, NULL);
	/* bit5: 1 disable hdr10/hdr10+   0 enable hdr10/hdr10+ */
	if (strategy & BIT(5)) {
		disable_hdr10_info(&prxcap->hdr_info);
		disable_hdr10p_info(&prxcap->hdr_info.hdr10plus_info);
	} else {
		enable_hdr10_info(&prxcap->hdr_info, NULL);
		enable_hdr10p_info(&prxcap->hdr_info.hdr10plus_info, NULL);
	}
	/* bit6: 1 disable hlg   0 enable hlg */
	if (strategy & BIT(6))
		disable_hlg_info(&prxcap->hdr_info);
	else
		enable_hlg_info(&prxcap->hdr_info, NULL);
}

static int hdmitx_set_hdr_priority(struct rx_cap *prxcap, u32 hdr_priority)
{
	u32 choose = 0;
	u32 strategy = 0;

	if (!prxcap)
		return -1;

	printf("%s, set hdr_prio: %u\n", __func__, hdr_priority);
	/* choose strategy: bit[31:28] */
	choose = (hdr_priority >> 28) & 0xf;
	switch (choose) {
	case 0:
		strategy = hdr_priority & 0xf;
		update_hdr_strategy1(prxcap, strategy);
		break;
	case 1:
		strategy = hdr_priority & 0xf0;
		update_hdr_strategy2(prxcap, strategy);
		break;
	default:
		break;
	}
	return 0;
}

void hdmitx_update_dv_strategy_info(struct dv_info *dv)
{
	if (dv->ver == 0) {
		if (dv->length == 0x19)
			dv->support_DV_RGB_444_8BIT = 1;
	}

	if (dv->ver == 1) {
		if (dv->length == 0x0B) {
			dv->support_DV_RGB_444_8BIT = 1;
			if (dv->low_latency == 0x01)
				dv->support_LL_YCbCr_422_12BIT = 1;
		} else if (dv->length == 0x0E) {
			dv->support_DV_RGB_444_8BIT = 1;
		}
	}

	if (dv->ver == 2) {
		if (dv->length >= 0x0B) {
			if (dv->Interface != 0x00 && dv->Interface != 0x01)
				dv->support_DV_RGB_444_8BIT = 1;
			dv->support_LL_YCbCr_422_12BIT = 1;
			if (dv->Interface == 0x01 || dv->Interface == 0x03) {
				if (dv->sup_10b_12b_444 == 0x1)
					dv->support_LL_RGB_444_10BIT = 1;
				if (dv->sup_10b_12b_444 == 0x2)
					dv->support_LL_RGB_444_12BIT = 1;
			}
		}
	}
}

static void get_parse_edid_data(struct hdmitx_dev *hdev)
{
	int hdr_priority = get_hdr_strategy_priority();

	hdev->hwop.read_edid(hdev->rawedid);

	/* dump edid raw data */
	dump_full_edid(hdev->rawedid);

	/* parse edid data */
	hdmitx_edid_parse(&hdev->RXCap, hdev->rawedid);

	/* Update the member variables used by the dv running strategy */
	hdmitx_update_dv_strategy_info(&hdev->RXCap.dv_info);
	hdmitx_update_dv_strategy_info(&hdev->RXCap.dv_info2);

	if (hdr_priority == -1)
		return;
	hdmitx_set_hdr_priority(&hdev->RXCap, hdr_priority);
}

/* policy process: to find the output mode/attr/dv_type */
void scene_process(struct hdmitx_dev *hdev,
	struct scene_output_info *scene_output_info)
{
	struct input_hdmi_data hdmidata;
	int dv_support = 0;

	if (!hdev || !scene_output_info)
		return;
	/* 1.read dolby vision mode from prop(maybe need to env) */
	memset(&hdmidata, 0, sizeof(struct input_hdmi_data));
	get_hdmi_data(hdev, &hdmidata);

	/* 2. dolby vision scene process */
	/* only for tv support dv and box enable dv */
	if (is_dv_preference(hdev)) {
		dv_support = dolbyvision_scene_process(&hdmidata, scene_output_info);
	} else if (is_dolby_enabled()) {
		/* for enable dolby vision core when
		 * first boot connecting non dv tv
		 * NOTE: let systemcontrol to enable DV core
		 */
		/* scene_output_info->final_dv_type = DOLBY_VISION_ENABLE; */
	} else {
		/* for UI disable dolby vision core and boot keep the status
		 * NOTE: TBD if need to disable DV here
		 */
		/* scene_output_info->final_dv_type = DOLBY_VISION_DISABLE; */
	}
	/* 3.hdr/sdr scene process */
	/* decide final display mode and deepcolor */
	if (is_dv_preference(hdev) && dv_support == 0) {
		/* do nothing
		 * already done above, just sync with sysctrl
		 */
	} else if (is_hdr_preference(hdev) || dv_support != 0) {
		hdr_scene_process(&hdmidata, scene_output_info);
	} else {
		sdr_scene_process(&hdmidata, scene_output_info);
	}
	/* not find outputmode and use default mode */
	if (strlen(scene_output_info->final_displaymode) == 0)
		strcpy(scene_output_info->final_displaymode, DEFAULT_HDMI_MODE);
	/* not find color space and use default mode */
	if (!strstr(scene_output_info->final_deepcolor, "bit"))
		strcpy(scene_output_info->final_deepcolor, DEFAULT_COLOR_FORMAT);
}

static int do_get_parse_edid(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	struct hdmitx_dev *hdev = get_hdmitx21_device();
	unsigned char *edid = hdev->rawedid;
	unsigned char *store_checkvalue;

	memset(edid, 0, EDID_BLK_SIZE * EDID_MAX_BLOCK);
	unsigned int i;
	unsigned int checkvalue[4];
	unsigned int checkvalue1;
	unsigned int checkvalue2;
	char checksum[11];
	unsigned char def_cksum[] = {'0', 'x', '0', '0', '0', '0', '0', '0', '0', '0', '\0'};
	char *hdmimode;
	char *colorattribute;
	int user_dv_mode;
	char *last_output_mode;
	char *last_colorattribute;
	int last_dv_status;
	bool over_write = false;
	char dv_type[2] = {0};
	struct scene_output_info scene_output_info;
	struct hdmi_format_para *para = NULL;
	bool mode_support = false;
	/* hdmi_mode / colorattribute may be null or "none".
	 * if either is null or "none", it means user not
	 * selected manually, and need to select the best
	 * mode or colorattribute by policy
	 */
	bool no_manual_output = false;

	if (!hdev->hpd_state) {
		printf("HDMI HPD low, no need parse EDID\n");
		return 1;
	}
	memset(&scene_output_info, 0, sizeof(struct scene_output_info));

	get_parse_edid_data(hdev);

	/* check if the tv has changed or anything wrong */
	store_checkvalue = (unsigned char *)env_get("hdmichecksum");
	/* get user selected output mode/color */
	colorattribute = env_get("user_colorattribute");
	hdmimode = env_get("hdmimode");
	user_dv_mode = get_ubootenv_dv_type();

	last_output_mode = env_get("outputmode");
	last_colorattribute = env_get("colorattribute");
	last_dv_status = get_ubootenv_dv_status();
	if (!store_checkvalue)
		store_checkvalue = def_cksum;

	printf("read hdmichecksum: %s, user hdmimode: %s, colorattribute: %s, dv_type: %d\n",
	       store_checkvalue, hdmimode ? hdmimode : "null",
	       colorattribute ? colorattribute : "null", user_dv_mode);

	for (i = 0; i < 4; i++) {
		if (('0' <= store_checkvalue[i * 2 + 2]) && (store_checkvalue[i * 2 + 2] <= '9'))
			checkvalue1 = store_checkvalue[i * 2 + 2] - '0';
		else
			checkvalue1 = store_checkvalue[i * 2 + 2] - 'W';
		if (('0' <= store_checkvalue[i * 2 + 3]) && (store_checkvalue[i * 2 + 3] <= '9'))
			checkvalue2 = store_checkvalue[i * 2 + 3] - '0';
		else
			checkvalue2 = store_checkvalue[i * 2 + 3] - 'W';
		checkvalue[i] = checkvalue1 * 16 + checkvalue2;
	}

	if (checkvalue[0] != hdev->rawedid[0x7f]  ||
	    checkvalue[1] != hdev->rawedid[0xff]  ||
	    checkvalue[2] != hdev->rawedid[0x17f] ||
	    checkvalue[3] != hdev->rawedid[0x1ff]) {
		hdev->RXCap.edid_changed = 1;

		checksum[0] = '0';
		checksum[1] = 'x';
		for (i = 0; i < 4; i++)
			xtochar(0x80 * i + 0x7f, &checksum[2 * i + 2]);
		checksum[10] = '\0';
		memcpy(hdev->RXCap.hdmichecksum, checksum, 10);
		printf("TV has changed, now crc: %s\n", checksum);
	} else {
		memcpy(hdev->RXCap.hdmichecksum, store_checkvalue, 10);
		printf("TV is same, checksum: %s\n", hdev->RXCap.hdmichecksum);
	}

	/* check user have selected both mode/color or not */
	if (!hdmimode || !strcmp(hdmimode, "none") ||
		!colorattribute || !strcmp(colorattribute, "none"))
		no_manual_output = true;
	else
		no_manual_output = false;

	if (!no_manual_output) {
		/* check current user selected mode + color support or not */
		para = hdmitx21_get_fmtpara(hdmimode, colorattribute);
		if (hdmitx_edid_check_valid_mode(hdev, para)) {
			mode_support = true;
		} else {
			printf("saved output mode not supported!\n");
			mode_support = false;
		}

		/* if user selected mode/color/dv type which saved in ubootenv of
		 * hdmimode/user_colorattribute/user_prefer_dv_type are different
		 * with last actual output mode/color/dv type which saved in
		 * ubootenv of outputmode/colorattribute/dolby_status, then it means
		 * that the user selected format is over-writen by policy(for example:
		 * firstly user has selected HDR priority to HDR, and select color
		 * to rgb,12bit(now the "user_colorattribute" env will be "rgb,12bit"),
		 * but then it selected HDR priority to DV, the actual output color
		 * will be "444,8bit" or "422,12bit" according to dv type, and
		 * the ubootenv "colorattribute" will be "444,8bit" or "422,12bit"),
		 * then uboot should use the policy to select the output format,
		 * otherwise, uboot use hdmimode/user_colorattribute/user_prefer_dv_type
		 * env, while system use outputmode/colorattribute/dolby_status env,
		 * there will be always a mode change during bootup
		 */
		if (mode_support) {
			/* note that for T7 multi-display, it may store panel in
			 * "outputmode" env, and will always run uboot policy
			 */
			if (!last_output_mode || strcmp(hdmimode, last_output_mode))
				over_write = true;
			else if (!last_colorattribute ||
				strcmp(colorattribute, last_colorattribute))
				over_write = true;
			else if (user_dv_mode != last_dv_status)
				over_write = true;
			else
				over_write = false;

			if (over_write)
				printf("last output_mode:%s, colorattribute:%s, dolby_status:%d\n",
				last_output_mode ? last_output_mode : "null",
				last_colorattribute ? last_colorattribute : "null",
				last_dv_status);
		}
	}
	/* When outputting frl mode, if frl training fails under uboot,
	 * in order to ensure that it is displayed under uboot, change
	 * to the default TMDS mode for output display. systemctrl
	 * maintains the original 8k policy. After the subsequent systermctrl
	 * starts running, if it is checked that the current output is not the
	 * original frl mode, it will switch to the original frl mode.
	 */
	if (hdev->frl_train_fail_flag) {
		save_default_720p();
	} else if (hdev->RXCap.edid_changed || no_manual_output || !mode_support || over_write) {
	/* 4 cases need to decide output by uboot mode select policy:
	 * 1.TV changed
	 * 2.either hdmimode or colorattribute is NULL or "none",
	 * which means that user have not selected mode or colorattribute,
	 * and need to select the auto best mode or best colorattribute.
	 * 3.user selected mode not supportted by uboot (probably
	 * means mode select policy or edid parse between sysctrl and
	 * uboot have some gap), then need to find proper output mode
	 * with uboot policy.
	 * 4.user selected mode is over writen by system policy
	 */
		/* find proper mode if EDID changed */
		scene_process(hdev, &scene_output_info);
		env_set("hdmichecksum", hdev->RXCap.hdmichecksum);
		if (hdmitx_edid_check_data_valid(0, hdev->rawedid)) {
			/* SWPL-34712: if EDID parsing error case, not save env,
			 * only output default mode(480p,RGB,8bit). after
			 * EDID read OK, systemcontrol will recover the hdmi
			 * mode from env, to avoid keep the default hdmi output
			 */
			memcpy(sel_hdmimode, scene_output_info.final_displaymode,
				sizeof(scene_output_info.final_displaymode));
			if (is_hdmi_mode(env_get("outputmode"))) {
				env_set("outputmode",
					scene_output_info.final_displaymode);
			} else if (is_hdmi_mode(env_get("outputmode2"))) {
				env_set("outputmode2",
					scene_output_info.final_displaymode);
			} else if (is_hdmi_mode(env_get("outputmode3"))) {
				env_set("outputmode3",
					scene_output_info.final_displaymode);
			}
			env_set("colorattribute",
			       scene_output_info.final_deepcolor);
			/* if change from DV TV to HDR/SDR TV, don't change
			 * DV status to disabled, as DV core need to be enabled.
			 * that's to say connect DV TV & output DV-> power down box ->
			 * connect HDR/SDR TV -> power on box, the dolby_status
			 * will keep the same as that when connect DV TV under follow sink.
			 */
			if (scene_output_info.final_dv_type != get_ubootenv_dv_status() &&
			    scene_output_info.final_dv_type != DOLBY_VISION_DISABLE) {
				sprintf(dv_type, "%d", scene_output_info.final_dv_type);
				env_set("dolby_status", dv_type);
				/* according to the policy of systemcontrol,
				 * if current DV mode is not supported by TV
				 * EDID, DV type maybe changed to one witch
				 * TV support, and need VPP/DV module to
				 * update new DV output mode.
				 */
				printf("update dolby_status: %d\n",
				       scene_output_info.final_dv_type);
			}
		} else {
			save_default_720p();
		}
		printf("update outputmode: %s\n", sel_hdmimode);
		printf("update colorattribute: %s\n", env_get("colorattribute"));
		printf("update hdmichecksum: %s\n", env_get("hdmichecksum"));
	} else {
		memset(sel_hdmimode, 0, sizeof(sel_hdmimode));
		memcpy(sel_hdmimode, hdmimode, strlen(hdmimode));
		if (is_hdmi_mode(env_get("outputmode")))
			env_set("outputmode", hdmimode);
		else if (is_hdmi_mode(env_get("outputmode2")))
			env_set("outputmode2", hdmimode);
		else if (is_hdmi_mode(env_get("outputmode3")))
			env_set("outputmode3", hdmimode);
		env_set("colorattribute", colorattribute);
	}
	env_set("save_outputmode", sel_hdmimode);
	/* ubootenv dolby_status is used for is_dv_preference() decision,
	 * system_control save current dv output status in it.
	 * it will be used by dv module later to decide DV output later.
	 * if currently adaptive hdr, then we should set dolby_status to
	 * 0, so that DV module won't enable DV.
	 */
	if (get_hdr_policy() == 1)
		env_set("dolby_status", 0);
	hdev->para = hdmitx21_get_fmtpara(sel_hdmimode, env_get("colorattribute"));
	hdev->vic = hdev->para->timing.vic;
	hdmitx_mask_rx_info(hdev);
	hdmitx21_select_frl(hdev);
	return 0;
}

static int do_dsc_policy(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	struct hdmitx_dev *hdev = get_hdmitx21_device();

	if (argc < 1)
		return cmd_usage(cmdtp);

	if (strcmp(argv[1], "0") == 0)
		hdev->dsc_policy = 0;
	else if (strcmp(argv[1], "1") == 0)
		hdev->dsc_policy = 1;
	else if (strcmp(argv[1], "2") == 0)
		hdev->dsc_policy = 2;
	else if (strcmp(argv[1], "3") == 0)
		hdev->dsc_policy = 3;
	else if (strcmp(argv[1], "4") == 0)
		hdev->dsc_policy = 4;
	else
		printf("note: please set dsc policy as 0~4\n");
	if (hdev->dsc_policy <= 4)
		printf("use dsc policy: %d\n", hdev->dsc_policy);

	return CMD_RET_SUCCESS;
}

static int do_manual_frl_rate(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	struct hdmitx_dev *hdev = get_hdmitx21_device();
	unsigned int temp = 0;
	char *ptr;

	/* if rx don't support FRL, return */
	if (!hdev->RXCap.max_frl_rate) {
		printf("rx not support FRL\n");
		return 0;
	}

	temp = strtoul(argv[1], &ptr, 16);
	/* forced FRL rate setting */
	if (temp <= 6) {
		hdev->manual_frl_rate = temp;
		pr_info("force set frl_rate as %d\n", hdev->manual_frl_rate);
	} else {
		pr_info("error: should set frl_rate in 0 ~ 6\n");
	}
	if (hdev->manual_frl_rate > hdev->RXCap.max_frl_rate)
		pr_info("warning: larger than rx max_frl_rate %d\n", hdev->RXCap.max_frl_rate);
	return 0;
}

static int do_manual_dfm_type(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	struct hdmitx_dev *hdev = get_hdmitx21_device();
	unsigned int temp = 0;
	char *ptr;

	temp = strtoul(argv[1], &ptr, 10);
	/* forced dfm_type setting */
	if (temp <= 2) {
		hdev->dfm_type = temp;
		pr_info("force set dfm_type as %d\n", hdev->dfm_type);
	} else {
		pr_info("error: should set frl_rate in 0 ~ 2\n");
	}
	return 0;
}

#ifdef CONFIG_EFUSE_OBJ_API
static int do_efuse_show(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	struct hdmitx_dev *hdev = get_hdmitx21_device();

	get_hdmi_efuse(hdev);
	pr_info("FEAT_DISABLE_HDMI_60HZ = %d\n", hdev->efuse_dis_hdmi_4k60);
	pr_info("FEAT_DISABLE_OUTPUT_4K = %d\n", hdev->efuse_dis_output_4k);
	pr_info("FEAT_DISABLE_HDCP_TX_22 = %d\n", hdev->efuse_dis_hdcp_tx22);
	pr_info("FEAT_DISABLE_HDMI_TX_3D = %d\n", hdev->efuse_dis_hdmi_tx3d);
	pr_info("FEAT_DISABLE_HDMI = %d\n", hdev->efuse_dis_hdcp_tx14);

	return 0;
}
#endif

static cmd_tbl_t cmd_hdmi_sub[] = {
	U_BOOT_CMD_MKENT(hpd, 1, 1, do_hpd_detect, "", ""),
	U_BOOT_CMD_MKENT(edid, 3, 1, do_edid, "", ""),
	U_BOOT_CMD_MKENT(rx_det, 1, 1, do_rx_det, "", ""),
	U_BOOT_CMD_MKENT(output, 3, 1, do_output, "", ""),
	U_BOOT_CMD_MKENT(clkmsr, 3, 1, do_clkmsr, "", ""),
	U_BOOT_CMD_MKENT(blank, 3, 1, do_blank, "", ""),
	U_BOOT_CMD_MKENT(off, 1, 1, do_off, "", ""),
	U_BOOT_CMD_MKENT(dump, 1, 1, do_dump, "", ""),
	U_BOOT_CMD_MKENT(info, 1, 1, do_info, "", ""),
	U_BOOT_CMD_MKENT(reg, 3, 1, do_reg, "", ""),
	U_BOOT_CMD_MKENT(get_parse_edid, 1, 1, do_get_parse_edid, "", ""),
	U_BOOT_CMD_MKENT(dsc_policy, 1, 1, do_dsc_policy, "", ""),
	U_BOOT_CMD_MKENT(frl_rate, 1, 1, do_manual_frl_rate, "", ""),
	U_BOOT_CMD_MKENT(dfm_type, 1, 1, do_manual_dfm_type, "", ""),
#ifdef CONFIG_EFUSE_OBJ_API
	U_BOOT_CMD_MKENT(efuse, 1, 1, do_efuse_show, "", ""),
#endif
	U_BOOT_CMD_MKENT(pbist, 3, 1, do_pbist, "", ""),
	U_BOOT_CMD_MKENT(debug, 3, 1, do_debug, "", ""),
	U_BOOT_CMD_MKENT(s7_clk_config, 3, 1, do_s7_clk_config, "", ""),
	U_BOOT_CMD_MKENT(get_rterm, 3, 1, get_rterm, "", ""),
};

static int do_hdmitx(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	cmd_tbl_t *c;

	if (argc < 2)
		return cmd_usage(cmdtp);

	argc--;
	argv++;

	c = find_cmd_tbl(argv[0], &cmd_hdmi_sub[0], ARRAY_SIZE(cmd_hdmi_sub));

	if (c)
		return  c->cmd(cmdtp, flag, argc, argv);
	else
		return cmd_usage(cmdtp);
}

U_BOOT_CMD(hdmitx, CONFIG_SYS_MAXARGS, 0, do_hdmitx,
	   "HDMITX sub-system",
	"hdmitx version:20200618\n"
	"hdmitx hpd\n"
	"    Detect hdmi rx plug-in\n"
	"hdmitx output [list | FORMAT | bist PATTERN]\n"
	"    list: list support formats\n"
	"    FORMAT can be 720p60/50hz, 1080i60/50hz, 1080p60hz, etc\n"
	"       extend with 8bits/10bits, y444/y422/y420/rgb\n"
	"       such as 2160p60hz,10bits,y420\n"
	"    PATTERN: can be as: line, dot, off, or 1920(width)\n"
	"hdmitx blank [0|1]\n"
	"    1: output blank  0: output normal\n"
	"hdmitx clkmsr\n"
	"    show hdmitx clocks\n"
	"hdmitx off\n"
	"    Turn off hdmitx output\n"
	"hdmitx info\n"
	"    current mode info\n"
	"hdmitx rx_det\n"
	"    Auto detect if RX is FBC and set outputmode\n"
);

struct hdr_info *hdmitx_get_rx_hdr_info(void)
{
	struct hdmitx_dev *hdev = get_hdmitx21_device();

	return &hdev->RXCap.hdr_info;
}

static int do_list_dsc_mode(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
#ifdef CONFIG_AML_DSC_ENC
	dsc_enc_cap_show();
#endif
	return 0;
}

static int do_dsc_debug(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
#ifdef CONFIG_AML_DSC_ENC
	dsc_debug(argc - 1, argv + 1);
#endif
	return 0;
}

static cmd_tbl_t cmd_dsc_sub[] = {
	U_BOOT_CMD_MKENT(list_mode, 1, 1, do_list_dsc_mode, "", ""),
	U_BOOT_CMD_MKENT(dbg, 20, 1, do_dsc_debug, "", ""),
};

static int do_dsc_enc(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	cmd_tbl_t *c;

	if (argc < 2)
		return cmd_usage(cmdtp);

	argc--;
	argv++;

	c = find_cmd_tbl(argv[0], &cmd_dsc_sub[0], ARRAY_SIZE(cmd_dsc_sub));

	if (c)
		return  c->cmd(cmdtp, flag, argc, argv);
	else
		return cmd_usage(cmdtp);
}

U_BOOT_CMD(dsc, CONFIG_SYS_MAXARGS, 0, do_dsc_enc,
	   "dsc cmd",
	   "dsc help function\n"
	   "dsc dbg state\n"
	   "    dump dsc status\n"
	   "dsc dbg dump_reg\n"
	   "    dump dsc registers and venc registers\n"
	   "dsc dbg read addr\n"
	   "    read dsc asic register\n"
	   "dsc dbg write addr value\n"
	   "    write dsc asic register\n"
	   "dsc dbg rst_dsc\n"
	   "    reset dsc enc\n"
	   "dsc list_mode\n"
	   "    show supported dsc encode mode list\n"
);