video: fbdev: sunxi: hdmi2: call phy_set_reg_base if AW_PHY is enabled

scpcom · Sep 14, 2022 · 0a1107b · 0a1107b
1 parent 7a195c2
commit 0a1107b
Show file tree

Hide file tree

Showing 3 changed files with 18 additions and 0 deletions.
diff --git a/drivers/video/fbdev/sunxi/disp2/hdmi2/hdmi_core/api/api.c b/drivers/video/fbdev/sunxi/disp2/hdmi2/hdmi_core/api/api.c
@@ -554,6 +554,13 @@ static void api_dvimode_enable(u8 enable)
 
 }
 
+static void api_set_phy_base(uintptr_t base)
+{
+#ifdef CONFIG_AW_PHY
+	phy_set_reg_base(base);
+#endif
+}
+
 void hdmitx_api_init(hdmi_tx_dev_t *dev,
 			videoParams_t *video,
 			audioParams_t *audio,
@@ -633,6 +640,7 @@ void hdmitx_api_init(hdmi_tx_dev_t *dev,
 	func.avmute_enable		      = api_avmute_enable;
 	func.phy_power_enable		  = api_phy_power_enable;
 	func.dvimode_enable			  = api_dvimode_enable;
+	func.set_phy_base_addr        = api_set_phy_base;
 
 #ifdef CONFIG_AW_PHY
 	func.phy_reset                = api_phy_reset;

diff --git a/drivers/video/fbdev/sunxi/disp2/hdmi2/hdmi_core/api/core_api.h b/drivers/video/fbdev/sunxi/disp2/hdmi2/hdmi_core/api/core_api.h
@@ -905,6 +905,7 @@ struct hdmi_dev_func {
 	void (*avmute_enable)(u8 enable);
 	void (*phy_power_enable)(u8 enable);
 	void (*dvimode_enable)(u8 enable);
+	void (*set_phy_base_addr)(uintptr_t reg_base);
 #ifdef CONFIG_AW_PHY
 	void (*phy_reset)(void);
 	int (*phy_config_resume)(void);

diff --git a/drivers/video/fbdev/sunxi/disp2/hdmi2/hdmi_core/hdmi_core.c b/drivers/video/fbdev/sunxi/disp2/hdmi2/hdmi_core/hdmi_core.c
@@ -160,6 +160,13 @@ u32 hdmi_core_get_hpd_state(void)
 	return core->dev_func.dev_hpd_status();
 }
 
+void hdmi_core_set_phy_reg_base(void)
+{
+	struct hdmi_tx_core *core = get_platform();
+
+	core->dev_func.set_phy_base_addr(hdmi_reg_base);
+}
+
 /**
  * @short Set PHY number
  * @param[in] core Main structure
@@ -228,6 +235,8 @@ static int _api_init(struct hdmi_tx_core *core)
 			&core->mode.pVideo,
 			&core->mode.pAudio,
 			&core->mode.pHdcp);
+
+	hdmi_core_set_phy_reg_base();
 	return 0;
 }