// SPDX-License-Identifier: (GPL-2.0+ OR MIT) /* * Copyright (c) 2019 Amlogic, Inc. All rights reserved. */ //#include #include #include #include #include #include #include #include #include #include "../../drivers/amlogic/media/vout/hdmitx/hdmitx_common/hdmitx_policy_setting.h" #ifdef CONFIG_AML_VOUT #include #endif static unsigned char edid_raw_buf[256] = {0}; static void dump_edid_raw_8bytes(unsigned char *buf) { int i = 0; for (i = 0; i < 8; i++) printf("%02x ", buf[i]); printf("\n"); } 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_BLK_NO) blk_no = EDID_BLK_NO; printf("dump EDID rawdata\n"); printf(" "); for (i = 0; i < blk_no * EDID_BLK_SIZE; i++) printk("%02x", buf[i]); printf("\n"); } static int do_edid(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[]) { unsigned int tmp_addr = 0; unsigned char edid_addr = 0; unsigned char st = 0; struct hdmitx_dev *hdev = hdmitx_get_hdev(); if (!hdev) { printf("null hdmitx dev\n"); return CMD_RET_FAILURE; } memset(edid_raw_buf, 0, ARRAY_SIZE(edid_raw_buf)); if (argc < 2) return cmd_usage(cmdtp); if (strcmp(argv[1], "read") == 0) { tmp_addr = simple_strtoul(argv[2], NULL, 16); if (tmp_addr > 0xff) return cmd_usage(cmdtp); edid_addr = tmp_addr; /* read edid raw data */ /* current only support read 1 byte edid data */ st = hdev->hwop.read_edid( &edid_raw_buf[edid_addr & 0xf8], edid_addr & 0xf8, 8); printf("edid[0x%02x]: 0x%02x\n", edid_addr, edid_raw_buf[edid_addr]); if (0) /* Debug only */ dump_edid_raw_8bytes(&edid_raw_buf[edid_addr & 0xf8]); 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 edid_addr = 0xf8; // Fixed Address unsigned char st = 0; struct hdmitx_dev *hdev = hdmitx_get_hdev(); if (!hdev) { printf("null hdmitx dev\n"); return CMD_RET_FAILURE; } 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[edid_addr & 0xf8], edid_addr & 0xf8, 8); if (1) // Debug only dump_edid_raw_8bytes(&edid_raw_buf[edid_addr & 0xf8]); if (st) { #if 0 // set fake value for debug edid_raw_buf[250] = 0xfb; edid_raw_buf[251] = 0x0c; edid_raw_buf[252] = 0x01; #endif 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) { env_set("outputmode", 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")) hdmi_parse_attr(hdev->para, env_get("colorattribute")); /* when current output color depth is 8bit, mask hdr capability */ /* refer to SWPL-44445 for more detail */ if (hdev->para->cd == HDMI_COLOR_DEPTH_24B) memset(&hdev->RXCap.hdr_info, 0, sizeof(struct hdr_info)); } static void hdmitx_config_csc_en(struct hdmitx_dev *hdev) { if (!hdev) return; if (env_get("config_csc_en")) { if (strncmp("0", env_get("config_csc_en"), 1) == 0) hdev->config_csc_en = 0; else hdev->config_csc_en = 1; printf("config_csc_en:%d\n", hdev->config_csc_en); } else { hdev->config_csc_en = 0; } } static int _do_output(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[]) { struct hdmitx_dev *hdev = hdmitx_get_hdev(); int ret; if (argc < 1) return cmd_usage(cmdtp); if (!hdev) { printf("null hdmitx dev\n"); return CMD_RET_FAILURE; } 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 mode = simple_strtoul(argv[2], NULL, 10); hdev->hwop.test_bist(mode); } else if (strcmp(argv[1], "prbs") == 0) { if (!hdev->para) { printf("null hdmitx para\n"); return CMD_RET_FAILURE; } hdev->para->cs = HDMI_COLOR_FORMAT_RGB; hdev->para->cd = HDMI_COLOR_DEPTH_24B; hdev->vic = HDMI_1920x1080p60_16x9; ret = hdmi_tx_set(hdev); hdev->hwop.test_prbs(); if (ret != 0) return CMD_RET_FAILURE; } 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 (!edid_parsing_ok(hdev)) { /* 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_1280x720p60_16x9; hdev->para = hdmi_get_fmt_paras(hdev->vic); hdev->para->cs = HDMI_COLOR_FORMAT_RGB; hdev->para->cd = HDMI_COLOR_DEPTH_24B; hdmi_tx_set(hdev); return CMD_RET_SUCCESS; } hdev->vic = hdmi_get_fmt_vic(argv[1]); hdev->para = hdmi_get_fmt_paras(hdev->vic); if (hdev->vic == HDMI_unknown) { /* Not find VIC */ printf("Not find '%s' mapped VIC\n", argv[1]); return CMD_RET_FAILURE; } else { printf("set hdmitx VIC = %d\n", hdev->vic); } if (!hdev->para) { printf("null hdmitx para\n"); return CMD_RET_FAILURE; } if (env_get("colorattribute")) hdmi_parse_attr(hdev->para, env_get("colorattribute")); if (strstr(argv[1], "hz420") != NULL) hdev->para->cs = HDMI_COLOR_FORMAT_420; /* For RGB444 or YCbCr444 under 6Gbps mode, no deepcolor */ /* Only 4k50/60 has 420 modes */ switch (hdev->vic) { case HDMI_3840x2160p50_16x9: case HDMI_3840x2160p60_16x9: case HDMI_4096x2160p50_256x135: case HDMI_4096x2160p60_256x135: case HDMI_3840x2160p50_64x27: case HDMI_3840x2160p60_64x27: case HDMI_3840x2160p50_16x9_Y420: case HDMI_3840x2160p60_16x9_Y420: case HDMI_4096x2160p50_256x135_Y420: case HDMI_4096x2160p60_256x135_Y420: case HDMI_3840x2160p50_64x27_Y420: case HDMI_3840x2160p60_64x27_Y420: if ((hdev->para->cs == HDMI_COLOR_FORMAT_RGB) || (hdev->para->cs == HDMI_COLOR_FORMAT_444)) { if (hdev->para->cd != HDMI_COLOR_DEPTH_24B) { printf("vic %d cs %d has no cd %d\n", hdev->vic, hdev->para->cs, hdev->para->cd); hdev->para->cd = HDMI_COLOR_DEPTH_24B; printf("set cd as %d\n", HDMI_COLOR_DEPTH_24B); } } if (hdev->para->cs == HDMI_COLOR_FORMAT_420) hdev->vic |= HDMITX_VIC420_OFFSET; break; default: if (hdev->para->cs == HDMI_COLOR_FORMAT_420) { printf("vic %d has no cs %d\n", hdev->vic, hdev->para->cs); hdev->para->cs = HDMI_COLOR_FORMAT_444; printf("set cs as %d\n", HDMI_COLOR_FORMAT_444); } /* For VESA modes, should be RGB format */ if (hdev->vic >= HDMITX_VESA_OFFSET) { hdev->para->cs = HDMI_COLOR_FORMAT_RGB; hdev->para->cd = HDMI_COLOR_DEPTH_24B; } break; } printf("set hdmitx VIC = %d CS = %d CD = %d\n", hdev->vic, hdev->para->cs, hdev->para->cd); hdmitx_config_csc_en(hdev); ret = hdmi_tx_set(hdev); if (ret != 0) return CMD_RET_FAILURE; } return CMD_RET_SUCCESS; } static int do_output(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[]) { int ret; ret = _do_output(cmdtp, flag, argc, argv); hdmi_mode_frac_postprocess(); return ret; } static int do_blank(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[]) { struct hdmitx_dev *hdev = hdmitx_get_hdev(); if (argc < 1) return cmd_usage(cmdtp); if (!hdev) { printf("null hdmitx dev\n"); return CMD_RET_FAILURE; } 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 = hdmitx_get_hdev(); if (!hdev) { printf("null hdmitx dev\n"); return CMD_RET_FAILURE; } hdev->vic = HDMI_unknown; hdev->hwop.turn_off(); printf("turn off hdmitx\n"); return CMD_RET_SUCCESS; } static int do_dump(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[]) { struct hdmitx_dev *hdev = hdmitx_get_hdev(); if (!hdev) { printf("null hdmitx dev\n"); return CMD_RET_FAILURE; } hdev->hwop.dump_regs(); return CMD_RET_SUCCESS; } 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 = hdmitx_rd_reg((unsigned int)addr); printk("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); hdmitx_wr_reg(addr, data); printk("wr[0x%lx] 0x%x\n", addr, data); } 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; struct hdmi_format_para *para = NULL; enum hdmi_vic vic; int i; 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; para = hdmi_get_fmt_paras(vic); if (para && vic < HDMITX_VESA_OFFSET && !is_vic_over_limited_1080p(vic)) printf(" %s\n", para->sname ? para->sname : para->name); } } static void vesa_cap_show(struct hdmitx_dev *hdev) { } static void dc_cap_show(struct hdmitx_dev *hdev) { enum hdmi_vic vic = HDMI_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_unknown) { printf("420,8bit\n"); goto next444; } vic = hdmitx_edid_get_VIC(hdev, "2160p50hz420", 0); if (vic != HDMI_unknown) { printf("420,8bit\n"); goto next444; } vic = hdmitx_edid_get_VIC(hdev, "smpte60hz420", 0); if (vic != HDMI_unknown) { printf("420,8bit\n"); goto next444; } vic = hdmitx_edid_get_VIC(hdev, "smpte50hz420", 0); if (vic != HDMI_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.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("EDID Version: %d.%d\n", prxcap->edid_version, prxcap->edid_revision); printf("EDID block number: 0x%x\n", hdev->rawedid[0x7e]); printf("blk0 chksum: 0x%02x\n", prxcap->chksum); 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("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("Video_Latency: "); if (prxcap->Video_Latency == 0) printf(" Invalid/Unknown\n"); else if (prxcap->Video_Latency == 0xffff) printf(" UnSupported\n"); else printf(" %d\n", prxcap->Video_Latency); printf("Audio_Latency: "); if (prxcap->Audio_Latency == 0) printf(" Invalid/Unknown\n"); else if (prxcap->Audio_Latency == 0xffff) printf(" UnSupported\n"); else printf(" %d\n", prxcap->Audio_Latency); printf("Interlaced_Video_Latency: "); if (prxcap->Interlaced_Video_Latency == 0) printf(" Invalid/Unknown\n"); else if (prxcap->Interlaced_Video_Latency == 0xffff) printf(" UnSupported\n"); else printf(" %d\n", prxcap->Interlaced_Video_Latency); printf("Interlaced_Audio_Latency: "); if (prxcap->Interlaced_Audio_Latency == 0) printf(" Invalid/Unknown\n"); else if (prxcap->Interlaced_Audio_Latency == 0xffff) printf(" UnSupported\n"); else printf(" %d\n", prxcap->Interlaced_Audio_Latency); 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); if (prxcap->dv_info.ieeeoui == DV_IEEE_OUI) printf(" DolbyVision%d", prxcap->dv_info.ver); if (prxcap->hdr_info.hdr_support & HDR_SUP_EOTF_SMPTE_ST_2084) printf(" HDR/%d", !!(prxcap->hdr_info.hdr_support & HDR_SUP_EOTF_SMPTE_ST_2084)); if (prxcap->dc_y444 || prxcap->dc_30bit || prxcap->dc_30bit_420) printf(" DeepColor"); printf("\n"); } static int do_info(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[]) { struct hdmitx_dev *hdev = hdmitx_get_hdev(); struct hdmi_format_para *para; if (!hdev) { printf("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->ext_name, hdev->vic); printf("cd%d cs%d cr%d\n", hdev->para->cd, hdev->para->cs, hdev->para->cr); 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); return CMD_RET_SUCCESS; } static int xtochar(int num, char* checksum) { struct hdmitx_dev *hdev = hdmitx_get_hdev(); if (!hdev) { printf("null hdmitx dev\n"); return -1; } 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->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->hdr10plus_info); } else { enable_hdr10_info(&prxcap->hdr_info, NULL); enable_hdr10p_info(&prxcap->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; } static void get_parse_edid_data(struct hdmitx_dev *hdev) { unsigned char *edid = hdev->rawedid; unsigned int byte_num = 0; unsigned char blk_no = 1; /* get edid data */ while (byte_num < 128 * blk_no) { hdev->hwop.read_edid(&edid[byte_num], byte_num & 0x7f, byte_num / 128); if (byte_num == 120) { blk_no = edid[126] + 1; if (blk_no > 4) blk_no = 4; /* MAX Read Blocks 4 */ } if (byte_num == 128) { if (edid[128 + 4] == 0xe2 && edid[128 + 5] == 0x78) blk_no = edid[128 + 6] + 1; if (blk_no > EDID_BLK_NO) blk_no = EDID_BLK_NO; /* MAX Read Blocks 8 */ } byte_num += 8; } /* dump edid raw data */ dump_full_edid(hdev->rawedid); /* parse edid data */ hdmi_edid_parsing(hdev->rawedid, &hdev->RXCap); } /* policy process: to find the output mode/attr/dv_type */ void scene_process(struct hdmitx_dev *hdev, struct meson_policy_out *output) { struct meson_policy_in input; hdmitx_set_mode_policy(); memset(&input, 0, sizeof(struct meson_policy_in)); get_hdmi_input(hdev, &input); hdmitx_get_policy_output(output); } static int _do_get_parse_edid(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) { struct hdmitx_dev *hdev = hdmitx_get_hdev(); unsigned char *store_checkvalue; 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 meson_policy_out output; 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; /* * The hdmitx driver gets the value of env too early in hdmitx21_init. * The value of emmc's env partition has not been loaded yet. * Therefore, the value obtained at this time is the data saved at compile time, * which is the default value defined in board.h. * To prevent this case, need to get the value of env later */ char *dongle_mode = env_get("dongle_mode"); char *edid_check = env_get("edid_check"); if (!hdev) { printf("null hdmitx dev\n"); return CMD_RET_FAILURE; } if (dongle_mode && (dongle_mode[0] == '1')) hdev->dongle_mode = 1; if (edid_check && edid_check[0] != '\0') { u8 tmp = edid_check[0] - '0'; if (tmp <= 3) hdev->RXCap.edid_check = tmp; else hdev->RXCap.edid_check = 0; } else { hdev->RXCap.edid_check = 0; } printf("[%s][%d] dongle_mode=[%d], edid_check=[%d]\n", __func__, __LINE__, hdev->dongle_mode, hdev->RXCap.edid_check); if (!hdev->hpd_state) { printf("HDMI HPD low, no need parse EDID\n"); return 1; } memset(&output, 0, sizeof(output)); memset(hdev->rawedid, 0, EDID_BLK_SIZE * EDID_BLK_NO); 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.checksum, checksum, 10); printf("TV has changed, now crc: %s\n", checksum); } else { memcpy(hdev->RXCap.checksum, store_checkvalue, 10); printf("TV is the same, checksum: %s\n", hdev->RXCap.checksum); } /* 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 = hdmi_tst_fmt_name(hdmimode, colorattribute); if (hdmitx_edid_check_valid_mode(hdev, para)) mode_support = true; else 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-written 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) { 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); } } /* 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 supported 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 written by system policy */ if (hdev->RXCap.edid_changed || no_manual_output || !mode_support || over_write) { /* find proper mode if EDID changed */ scene_process(hdev, &output); env_set("hdmichecksum", hdev->RXCap.checksum); if (edid_parsing_ok(hdev)) { env_set("outputmode", output.displaymode); env_set("colorattribute", output.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 ((output.amdv_type != get_ubootenv_dv_status()) && (output.amdv_type != DOLBY_VISION_DISABLE)) { sprintf(dv_type, "%d", output.amdv_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", output.amdv_type); } } else { save_default_720p(); } printf("update outputmode: %s\n", env_get("outputmode")); printf("update colorattribute: %s\n", env_get("colorattribute")); printf("update hdmichecksum: %s\n", env_get("hdmichecksum")); } else { env_set("outputmode", hdmimode); env_set("colorattribute", colorattribute); } /* 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->vic = hdmi_get_fmt_vic(env_get("outputmode")); hdev->para = hdmi_get_fmt_paras(hdev->vic); /* update the hdr/hdr10+/dv capabilities in the end of scene_process */ int hdr_priority = get_hdr_strategy_priority(); if (hdr_priority != -1) hdmitx_set_hdr_priority(&hdev->RXCap, hdr_priority); hdmitx_mask_rx_info(hdev); return 0; } static int do_get_parse_edid(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[]) { hdmi_mode_frac_preprocess(); return _do_get_parse_edid(cmdtp, flag, argc, argv); } #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 = hdmitx_get_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); return 0; } #endif static void vout_hdmi_hpd(struct hdmitx_dev *hdev, int hpd_st) { char *hdmimode; char *cvbsmode; char *colorattribute; /* get hdmi mode and colorattribute from env */ hdmimode = env_get("hdmimode"); if (hdmimode) printf("%s: hdmimode=%s\n", __func__, hdmimode); colorattribute = env_get("colorattribute"); if (colorattribute) printf("%s: colorattribute=%s\n", __func__, colorattribute); /* * Check whether the current connector is HDMI or CVBS, * and set a new value for the outputmode based on the HPD status. * In this way, the LCD will not be processed. * if hpd_st high, outputmode and connector0_type will be saved on hdmi side * if hpd_st low, outputmode and connector0_type will be saved on cvbs side */ if (!hpd_st) { cvbsmode = env_get("cvbsmode"); if (cvbsmode) env_set("outputmode", cvbsmode); env_set("hdmichecksum", "0x00000000"); env_set("connector0_type", "TV-1"); } else { if (env_get("outputmode")) { if (!strstr(env_get("outputmode"), "hz")) env_set("outputmode", "1080p60hz"); } else { printf("ERROR %s: outputmode env is NULL\n", __func__); env_set("outputmode", "1080p60hz"); } switch (hdev->enc_idx) { case 0: env_set("connector0_type", "HDMI-A-A"); break; case 1: env_set("connector0_type", "HDMI-A-B"); break; case 2: env_set("connector0_type", "HDMI-A-C"); break; } } } static void vout2_hdmi_hpd(struct hdmitx_dev *hdev, int hpd_st) { char *hdmimode; char *cvbsmode; char *colorattribute; /* get hdmi mode and colorattribute from env */ hdmimode = env_get("hdmimode"); if (hdmimode) printf("%s: hdmimode=%s\n", __func__, hdmimode); colorattribute = env_get("colorattribute"); if (colorattribute) printf("%s: colorattribute=%s\n", __func__, colorattribute); /* * Check whether the current connector is HDMI or CVBS, * and set a new value for the outputmode2 based on the HPD status. * if hpd_st high, outputmode2 will be saved on hdmi side * if hpd_st low, outputmode2 will be saved on cvbs side */ if (!hpd_st) { cvbsmode = env_get("cvbsmode"); if (cvbsmode) env_set("outputmode2", cvbsmode); env_set("hdmichecksum", "0x00000000"); } else { if (env_get("outputmode2")) { if (!strstr(env_get("outputmode2"), "hz")) env_set("outputmode2", "1080p60hz"); } else { printf("ERROR %s: outputmode2 env is NULL\n", __func__); env_set("outputmode2", "1080p60hz"); } } } int do_hpd_detect(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[]) { char *st; int hpd_st = 0; unsigned long i = 0; /* some TV sets pull hpd high 1.3S after detect pwr5v high */ unsigned long hdmitx_hpd_wait_cnt = 15; #ifdef CONFIG_AML_HDMITX20 struct hdmitx_dev *hdev = hdmitx_get_hdev(); #else struct hdmitx_dev *hdev = get_hdmitx21_device(); #endif unsigned short on_connector_dev = vout_connector_check(0); char *outputmode, *outputmode2, *connector0_type, *connector1_type; if (env_get_yesno("hdmitx_hpd_bypass") == 1) { printf("hdmitx_hpd_bypass detect\n"); return 0; } st = env_get("hdmitx_hpd_wait_cnt"); if (st) hdmitx_hpd_wait_cnt = simple_strtoul(st, NULL, 10); hpd_st = hdev->hwop.get_hpd_state(); if (!hpd_st) { /* For some TV, they cost extra time to pullup HPD after 5V */ for (i = 0; i < hdmitx_hpd_wait_cnt; i++) { mdelay(100); hpd_st = hdev->hwop.get_hpd_state(); if (hpd_st) { printf("hpd delay %lu ms\n", (i + 1) * 100); break; } } } printf("%s, hpd_state=%d\n", __func__, hpd_st); #ifdef CONFIG_MAX_BOOT_TIME if (!hpd_st) env_set_ulong("hpd_detect", i * 100 * 1000); #endif outputmode = env_get("outputmode"); outputmode2 = env_get("outputmode2"); connector0_type = env_get("connector0_type"); connector1_type = env_get("connector1_type"); printf("%s: outputmode=%s, outputmode2=%s, connector0_type=%s, connector1_type=%s\n", __func__, outputmode ? outputmode : "NULL", outputmode2 ? outputmode2 : "NULL", connector0_type ? connector0_type : "NULL", connector1_type ? connector1_type : "NULL"); /* * lacks the both env "connector0_type" and "connector1_type" * set "HDMI-A-A" for "connector0_type", and notice to burn the whole image */ if (!connector0_type && !connector1_type) { env_set("connector0_type", "HDMI-A-A"); printf("ERROR %s, miss env connectorX_type, must burn the whole image\n", __func__); printf("%s:set default connector0_type=%s\n", __func__, env_get("connector0_type")); } /* * Check whether the current connector is HDMI or CVBS * In this way, the LCD will not be processed. */ for (i = 0; i < 3; i++) { on_connector_dev = vout_connector_check(i); if ((on_connector_dev & CONNECTOR_DEV_MASK) == CONNECTOR_DEV_HDMI || (on_connector_dev & CONNECTOR_DEV_MASK) == CONNECTOR_DEV_CVBS) { if (i == 0) { vout_hdmi_hpd(hdev, hpd_st); } else if (i == 1) { vout2_hdmi_hpd(hdev, hpd_st); } else { printf("warning unregistered connectorX_type\n"); vout_hdmi_hpd(hdev, hpd_st); } } } hdev->hpd_state = hpd_st; return hpd_st; } 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(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, "", ""), #ifdef CONFIG_EFUSE_OBJ_API U_BOOT_CMD_MKENT(efuse, 1, 1, do_efuse_show, "", ""), #endif }; 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" #if 0 "hdmitx edid read ADDRESS\n" " Read hdmi rx edid from ADDRESS(0x00~0xff)\n" #endif "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 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 = hdmitx_get_hdev(); return &hdev->RXCap.hdr_info; }