142 lines
3.1 KiB
C
142 lines
3.1 KiB
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/cpu_id.h>
|
|
#include <asm/arch/io.h>
|
|
#include <amlogic/aml_hdmirx.h>
|
|
#include "ini/ini_platform.h"
|
|
|
|
#define HDMIRX_VERSION "Ver 2021/11/19\n"
|
|
|
|
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 hdmirx_read_edid(const char *filename,
|
|
unsigned char **pedid_buf,
|
|
int *pedid_size)
|
|
{
|
|
int rd_cnt = 0, tmp_size = 0;
|
|
unsigned char *tmp_buf = NULL;
|
|
|
|
if ((filename == NULL) || (pedid_buf == NULL) || (pedid_size == NULL))
|
|
return -1;
|
|
if (!iniIsFileExist(filename)) {
|
|
printf("%s, file \"%s\" is not exist!\n", __func__, filename);
|
|
return -1;
|
|
}
|
|
|
|
tmp_size = iniGetFileSize(filename);
|
|
if (tmp_size <= 0) {
|
|
printf("%s, file \"%s\" size error!\n", __func__, filename);
|
|
return -1;
|
|
}
|
|
tmp_buf = (unsigned char *)malloc(tmp_size);
|
|
if (tmp_buf != NULL) {
|
|
rd_cnt = iniReadFileToBuffer(filename, 0, tmp_size, tmp_buf);
|
|
if (rd_cnt <= 0) {
|
|
free(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 != NULL)
|
|
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"
|
|
);
|
|
|