From ec3ea388cc025e72b0c5a02818af473bca97eddc Mon Sep 17 00:00:00 2001
From: Joy Cho <joy.cho@hardkernel.com>
Date: Thu, 28 Mar 2019 14:45:08 +0900
Subject: [PATCH] ODROID-COMMON: display: Support hdmi phy control using osd
 blank ioctl

1. control with env 'monitor_onoff' in boot.ini
2. blank_mode
  - FB_BLANK_POWERDOWN - hdmi phy off
  - FB_BLANK_UNBLANK - hdmi phy on

Change-Id: I00411be529fe80f19d9a1e4b17eed3583934ff4a
Signed-off-by: Dongjin Kim <tobetter@gmail.com>
---
 drivers/amlogic/media/osd/osd_fb.c            | 37 +++++++++++++++++++
 .../vout/hdmitx/hdmi_tx_20/hdmi_tx_main.c     |  7 ++++
 2 files changed, 44 insertions(+)

diff --git a/drivers/amlogic/media/osd/osd_fb.c b/drivers/amlogic/media/osd/osd_fb.c
index 3e3e1dcb49bf..850090f59780 100644
--- a/drivers/amlogic/media/osd/osd_fb.c
+++ b/drivers/amlogic/media/osd/osd_fb.c
@@ -1878,9 +1878,46 @@ done:
 	return err;
 }
 
+#if defined(CONFIG_ARCH_MESON64_ODROID_COMMON)
+extern void control_hdmiphy(bool on);
+
+static bool monitor_onoff_action;
+
+static int __init osd_setup_monitor_onoff(char *str)
+{
+	if (!strcmp(str, "true") || !strcmp(str, "1"))
+		monitor_onoff_action = true;
+	else
+		monitor_onoff_action = false;
+
+	return 0;
+}
+__setup("monitor_onoff=", osd_setup_monitor_onoff);
+#endif
+
 int osd_blank(int blank_mode, struct fb_info *info)
 {
 	osd_enable_hw(info->node, (blank_mode != 0) ? 0 : 1);
+
+#if defined(CONFIG_ARCH_MESON64_ODROID_COMMON)
+	if (!monitor_onoff_action)
+		return 0;
+
+	switch (blank_mode) {
+	case FB_BLANK_UNBLANK:
+		control_hdmiphy(true);
+		break;
+	case FB_BLANK_POWERDOWN:
+		control_hdmiphy(false);
+		break;
+	case FB_BLANK_NORMAL:
+	case FB_BLANK_HSYNC_SUSPEND:
+	case FB_BLANK_VSYNC_SUSPEND:
+	default:
+		break;
+	}
+#endif
+
 	return 0;
 }
 
diff --git a/drivers/amlogic/media/vout/hdmitx/hdmi_tx_20/hdmi_tx_main.c b/drivers/amlogic/media/vout/hdmitx/hdmi_tx_20/hdmi_tx_main.c
index e94c658f68d6..0d397e1ceba1 100644
--- a/drivers/amlogic/media/vout/hdmitx/hdmi_tx_20/hdmi_tx_main.c
+++ b/drivers/amlogic/media/vout/hdmitx/hdmi_tx_20/hdmi_tx_main.c
@@ -5392,3 +5392,10 @@ static int __init hdmitx_boot_hdr_priority(char *str)
 
 __setup("hdr_priority=", hdmitx_boot_hdr_priority);
 
+#if defined(CONFIG_ARCH_MESON64_ODROID_COMMON)
+void control_hdmiphy(bool on)
+{
+	hdmitx_device.hwop.cntlmisc(&hdmitx_device, MISC_TMDS_PHY_OP,
+			on ?  TMDS_PHY_ENABLE : TMDS_PHY_DISABLE);
+}
+#endif