BPI-CM9-Linux/aml-comp/uboot/bl33/v2019/cmd/amlogic/cmd_hdmirx.c

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

#include <common.h>
#include <command.h>
#include <malloc.h>
#include <asm/arch/io.h>
#include <amlogic/aml_hdmirx.h>
#include <amlogic/aml_model.h>
#include <linux/string.h>

#define HDMIRX_VERSION "Ver 2022/03/21\n"

/* for t5m */
#define TOP_EDID_RAM_OVR0_DATA	(0xfe398000 + (0x016 << 2))
/* for t3x */
#define TOP_EDID_RAM_OVR0_DATA_T3X	(0xfe399800 + (0x016 << 2))

static int hdmirx_hpd(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	if (argc < 1)
		return cmd_usage(cmdtp);

	return CMD_RET_SUCCESS;
}

int meson_hdmirx_suspend(void *dev_info)
{
	int ret = 0;
	char *hdmi_5v_wakeup_val_str = NULL;
	unsigned int hdmi_5v_wakeup_val = 0;

	//Get hdmirx 5v wakeup status from dtb
	ret = run_command("fdt get value rx_5v_wake_up_value /hdmirx rx_5v_wake_up_en", 0);
	if (ret) {
		printf("get cmd buf error\n");
		return 0;
	}
	hdmi_5v_wakeup_val_str = env_get("rx_5v_wake_up_value");
	if (!hdmi_5v_wakeup_val_str) {
		printf("get 5v wakeup value fail\n");
	} else {
		hdmi_5v_wakeup_val = ustrtoul(hdmi_5v_wakeup_val_str, NULL, 16);
		printf("5v wakeup value = %d\n", hdmi_5v_wakeup_val);
	}
	if (hdmi_5v_wakeup_val) {
	#if defined(CONFIG_MESON_T5M)
		writel(0x1, TOP_EDID_RAM_OVR0_DATA);
	#elif defined(CONFIG_MESON_T3X)
		writel(0x1, TOP_EDID_RAM_OVR0_DATA_T3X);
	#endif
	}
	return 0;
}

int meson_hdmirx_resume(void *dev_info)
{
	return 0;
}

int meson_hdmirx_poweroff(void *dev_info)
{
	return 0;
}

int hdmirx_read_edid(const char *filename,
					unsigned char **pedid_buf,
					int *pedid_size)
{
	int tmp_size = 0;
	unsigned char *tmp_buf = NULL;

	if (!filename || !pedid_buf || !pedid_size)
		return -1;

	tmp_buf = model_read_file_to_buffer(filename, &tmp_size);
	if (!tmp_buf)
		return -1;

	*pedid_size = tmp_size;
	*pedid_buf = tmp_buf;

	return 0;
}

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

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

	port_map = simple_strtoul(argv[1], NULL, 16);
	printf("port map %#x\n", port_map);
	port_map = simple_strtoul(argv[2], NULL, 16);
	printf("edid select %#x\n", port_map);
	printf("FILE:%s\n", argv[3]);
	printf("FILE:%s\n", argv[4]);

	return CMD_RET_SUCCESS;
}

static int hdmirx_init(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
{
	unsigned int port_map;
	int error_code = CMD_RET_SUCCESS;
	unsigned char *edid_buf = NULL;
	int edid_size = 0;

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

	if (argc >= 2) {
		port_map = simple_strtoul(argv[1], NULL, 16);
		/*get the edid from param 2*/
		if (argc >= 3) {
			if (strlen(argv[2]) > 0) {
				printf("FILE:%s\n", argv[2]);
				if (hdmirx_read_edid(argv[2],
					&edid_buf, &edid_size) != 0)
					printf("read edid file error\n");
			}
		}
		hdmirx_hw_init(port_map, edid_buf, edid_size);
		if (edid_buf)
			free(edid_buf);
		error_code = CMD_RET_SUCCESS;
	} else {
		printf("HDMIRX: Error! No port map param\n");
		error_code = CMD_RET_FAILURE;
	}

	return error_code;
}

static cmd_tbl_t cmd_hdmi_sub[] = {
	U_BOOT_CMD_MKENT(init, 1, 1, hdmirx_init, "", ""),
	U_BOOT_CMD_MKENT(hpd, 1, 1, hdmirx_hpd, "", ""),
	U_BOOT_CMD_MKENT(edid, 1, 1, hdmirx_edid, "", ""),
};

static int do_hdmirx(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(hdmirx, CONFIG_SYS_MAXARGS, 0, do_hdmirx,
	   "hdmirx init function\n",
				"hdmirx init\n"
				"      param: port_map edid_patch\n"
				"\n"
);