133 lines
3.0 KiB
C
133 lines
3.0 KiB
C
// SPDX-License-Identifier: (GPL-2.0+ OR MIT)
|
|
/*
|
|
* Copyright (c) 2019 Amlogic, Inc. All rights reserved.
|
|
*/
|
|
|
|
#include <command.h>
|
|
#include <asm/amlogic/arch/io.h>
|
|
#include <asm/amlogic/arch/clock.h>
|
|
#include <amlogic/aml_cec.h>
|
|
#include <amlogic/aml_hdmirx.h>
|
|
#include <asm/amlogic/arch/secure_apb.h>
|
|
#include <vsprintf.h>
|
|
|
|
static void cec_init(int logic_addr, unsigned char fun_cfg);
|
|
|
|
int meson_cec_suspend(void *dev_info)
|
|
{
|
|
char *str;
|
|
int logic_addr = 0;
|
|
int fun_cfg = 0x2f;
|
|
int phy_addr = 0;
|
|
unsigned int tmp;
|
|
|
|
str = env_get("reboot_mode");
|
|
if (str && !strcmp(str, "aocpu_watchdog")) {
|
|
str = env_get("cec_fun");
|
|
printf("env_get cec_fun: %s\n", str);
|
|
fun_cfg = simple_strtoul(str, NULL, 16);
|
|
#ifdef CONFIG_AML_HDMIRX
|
|
logic_addr = 0;
|
|
hdmirx_hw_init(0, NULL, 0);
|
|
#else
|
|
logic_addr = 4;
|
|
if (str) {
|
|
phy_addr = simple_strtoul(str, NULL, 16);
|
|
tmp = readl(SYSCTRL_STATUS_REG1);
|
|
tmp &= 0xf0000;
|
|
tmp |= phy_addr;
|
|
writel(tmp, SYSCTRL_STATUS_REG1);
|
|
}
|
|
#endif
|
|
printf("logic_addr=0x%x, fun_cfg=0x%x\n", logic_addr, fun_cfg);
|
|
cec_init(logic_addr, (unsigned char)fun_cfg);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int meson_cec_resume(void *dev_info)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
int meson_cec_poweroff(void *dev_info)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* Bit field mask
|
|
* @param m width
|
|
* @param n shift
|
|
*/
|
|
#define MSK(m, n) (((1 << (m)) - 1) << (n))
|
|
#define _BIT(n) MSK(1, (n))
|
|
#define writel_bits(mask, val, addr) \
|
|
writel((readl(addr) & ~(mask)) | (val), addr)
|
|
|
|
static void cec_init(int logic_addr, unsigned char fun_cfg)
|
|
{
|
|
#ifndef CONFIG_MESON_T5W
|
|
unsigned int tmp;
|
|
|
|
writel(fun_cfg, SYSCTRL_STATUS_REG0);
|
|
tmp = readl(SYSCTRL_STATUS_REG1);
|
|
tmp &= (~0xf0000);
|
|
tmp |= ((logic_addr & 0xf) << 16);
|
|
writel(tmp, SYSCTRL_STATUS_REG1);
|
|
printf("cec func:%#x, parm:%#x\n", readl(SYSCTRL_STATUS_REG0),
|
|
readl(SYSCTRL_STATUS_REG1));
|
|
#else
|
|
printf("%s :%d,%#x\n", __func__, logic_addr, fun_cfg);
|
|
/*cec_hw_init(logic_addr, fun_cfg);*/
|
|
writel(fun_cfg, P_AO_DEBUG_REG0);
|
|
writel(logic_addr, AO_DEBUG_REG1);
|
|
printf("cec func:%#x, parm:%#x\n", readl(P_AO_DEBUG_REG0),
|
|
readl(AO_DEBUG_REG1));
|
|
#endif
|
|
}
|
|
|
|
static int do_cec(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
|
|
{
|
|
int logic_addr = 0;
|
|
int fun_cfg = 0x2f;
|
|
|
|
if (argc >= 2)
|
|
logic_addr = simple_strtoul(argv[1], NULL, 10);
|
|
if (argc >= 3)
|
|
fun_cfg = simple_strtoul(argv[2], NULL, 16);
|
|
|
|
printf("logic_addr=0x%x, fun_cfg=0x%x\n",
|
|
logic_addr, fun_cfg);
|
|
|
|
cec_init(logic_addr, (unsigned char)fun_cfg);
|
|
|
|
return 0;
|
|
}
|
|
|
|
U_BOOT_CMD(cec, CONFIG_SYS_MAXARGS, 0, do_cec,
|
|
"Amlogic cec",
|
|
" - hdmi cec function\n"
|
|
" - param: logic addr;fun_cfg\n"
|
|
"\n"
|
|
);
|
|
|
|
void cec_get_trim_val(void)
|
|
{
|
|
int64_t cec_trim_val;
|
|
|
|
/* get trim value from efuse, return -1 if not programed */
|
|
extern int64_t meson_trustzone_efuse_caliItem(const char *str);
|
|
cec_trim_val = meson_trustzone_efuse_caliItem("odio33");
|
|
/* cec gpiow 12 enable */
|
|
writel_bits(_BIT(12), 1 << 12, PADCTRL_GPIOW_PULL_EN);
|
|
if (cec_trim_val >= 0) {
|
|
writel_bits(MSK(2, 24), cec_trim_val << 24, PADCTRL_GPIOW_DS);
|
|
printf("cec trim:0x%llx\n", cec_trim_val);
|
|
} else {
|
|
printf("no cec trim val!\n");
|
|
}
|
|
}
|
|
|