- Introduced 200ms after anx init after some tests

- Introduced the power role detection and VBUS enable according to this bit

Author: MaxPayne86

libraries/Portenta_Video/anx7625.cpp

@@ -1324,7 +1324,7 @@ int anx7625_init(uint8_t bus)
 		return -1;
 	}
 	ANXINFO("Powering on anx7625 successfull.\n");
-
+	mdelay(200); // Wait for anx7625 to be stable
 	return 0;
 }
 
@@ -1338,3 +1338,95 @@ void anx7625_wait_hpd_event(uint8_t bus)
 			break;
 	}
 }
+
+int anx7625_get_cc_status(uint8_t bus, uint8_t *cc_status)
+{
+	int ret = 0;
+	ret = anx7625_reg_read(bus, RX_P0_ADDR, NEW_CC_STATUS, cc_status); // 0x7e, 0x46
+	if (ret < 0) {
+		ANXERROR("Failed %s", __func__);
+		return ret;
+	}
+	switch (*cc_status & 0x0F) {
+	case 0:
+		ANXDEBUG("anx: CC1: SRC.Open\n"); break;
+	case 1:
+		ANXDEBUG("anx: CC1: SRC.Rd\n"); break;
+	case 2:
+		ANXDEBUG("anx: CC1: SRC.Ra\n"); break;
+	case 4:
+		ANXDEBUG("anx: CC1: SNK.default\n"); break;
+	case 8:
+		ANXDEBUG("anx: CC1: SNK.power.1.5\n"); break;
+	case 12:
+		ANXDEBUG("anx: CC1: SNK.power.3.0\n"); break;
+	default:
+		ANXDEBUG("anx: CC1: Reserved\n");
+	}
+	switch (*cc_status & 0xF0) {
+	case 0:
+		ANXDEBUG("anx: CC2: SRC.Open\n"); break;
+	case 1:
+		ANXDEBUG("anx: CC2: SRC.Rd\n"); break;
+	case 2:
+		ANXDEBUG("anx: CC2: SRC.Ra\n"); break;
+	case 4:
+		ANXDEBUG("anx: CC2: SNK.default\n"); break;
+	case 8:
+		ANXDEBUG("anx: CC2: SNK.power.1.5\n"); break;
+	case 12:
+		ANXDEBUG("anx: CC2: SNK.power.3.0\n"); break;
+	default:
+		ANXDEBUG("anx: CC2: Reserved\n");
+	}
+	return ret;
+}
+
+int anx7625_read_system_status(uint8_t bus, uint8_t *sys_status)
+{
+	int ret = 0;
+	ret = anx7625_reg_read(bus, RX_P0_ADDR, SYSTEM_STSTUS, sys_status); // 0x7e, 0x45
+	if (ret < 0) {
+		ANXERROR("Failed %s", __func__);
+		return ret;
+	}
+	if (*sys_status & (1<<2))
+		ANXDEBUG("anx: - VCONN status ON\n");
+	if (!(*sys_status & (1<<2)))
+		ANXDEBUG("anx: - VCONN status OFF\n");
+
+	if (*sys_status & (1<<3))
+		ANXDEBUG("anx: - VBUS power provider\n");
+	if (!(*sys_status & (1<<3)))
+		ANXDEBUG("anx: - VBUS power consumer\n");
+
+	if (*sys_status & (1<<5))
+		ANXDEBUG("anx: - Data Role: DFP\n");
+	if (!(*sys_status & (1<<5)))
+		ANXDEBUG("anx: - Data Role: UFP\n");
+
+	if (*sys_status & (1<<7))
+		ANXDEBUG("anx: - DP HPD high\n");
+	if (!(*sys_status & (1<<7)))
+		ANXDEBUG("anx: - DP HPD low\n");
+	return ret;
+}
+
+// This function is used to understand if we need to provide VBUS on USB-C
+// connector or not
+bool anx7625_is_power_provider(uint8_t bus)
+{
+	int ret = 0;
+	uint8_t sys_status = 0;
+	anx7625_read_system_status(bus, &sys_status);
+	if (ret < 0) {
+		ANXERROR("Failed %s", __func__);
+		return false; // Conservative
+	}
+	else {
+		if (sys_status & (1<<3))
+			return true;
+		else
+			return false;
+	}
+}

libraries/Portenta_Video/anx7625.h

@@ -68,10 +68,8 @@ extern "C" {
 #define INTR_SOFTWARE_INT (1<<3)
 #define INTR_RECEIVED_MSG (1<<5)
 
-#define SYSTEM_STSTUS 0x45
 #define INTERFACE_CHANGE_INT 0x44
 #define HPD_STATUS_CHANGE 0x80
-#define HPD_STATUS 0x80
 
 /******** END of I2C Address 0x58 ********/
 
@@ -199,6 +197,16 @@ extern "C" {
 #define AP_MIPI_RX_EN (1<<5) /* 1: MIPI RX input in  0: no RX in */
 #define AP_DISABLE_PD (1<<6)
 #define AP_DISABLE_DISPLAY (1<<7)
+
+#define SYSTEM_STSTUS		0x45
+#define VCONN_STATUS		(1<<2)
+#define VBUS_STATUS	        (1<<3)
+#define DATA_ROLE_STATUS	(1<<5)
+#define HPD_STATUS		    (1<<7)
+#define NEW_CC_STATUS		0x46
+
+/******** END of I2C Address 0x7e *********/
+
 /***************************************************************/
 /* Register definition of device address 0x84 */
 #define  MIPI_PHY_CONTROL_3            0x03
@@ -364,6 +372,9 @@ int anx7625_dp_start(uint8_t bus, const struct edid *edid, enum edid_modes mode
 int anx7625_dp_get_edid(uint8_t bus, struct edid *out);
 int anx7625_init(uint8_t bus);
 void anx7625_wait_hpd_event(uint8_t bus);
+int anx7625_get_cc_status(uint8_t bus, uint8_t *cc_status);
+int anx7625_read_system_status(uint8_t bus, uint8_t *sys_status);
+bool anx7625_is_power_provider(uint8_t bus);
 int stm32_dsi_config(uint8_t bus, struct edid *edid, struct display_timing *dt);
 void stm32_BriefDisplay(void);
 void stm32_LCD_Clear(uint32_t color);

libraries/Portenta_Video/examples/Envie_video_coreboot/Envie_video_coreboot.ino

@@ -7,9 +7,13 @@ struct edid recognized_edid;
 
 mbed::DigitalOut video_on(PK_2);
 mbed::DigitalOut video_rst(PJ_3);
+mbed::DigitalOut otg_on(PJ_6);
 
 void setup() {
   // put your setup code here, to run once:
+  printf("OTG_ON = 1 -> VBUS OFF\n");
+  otg_on = 1;
+
   delay(1000);
   video_on = 1;
   delay(10);
@@ -32,6 +36,12 @@ void setup() {
     while(1);
   }
 
+  if(anx7625_is_power_provider(0)) {
+    printf("OTG_ON = 0 -> VBUS ON\n");
+    otg_on = 0;
+    delay(1000); // Wait for device to be stable
+  }
+
   anx7625_wait_hpd_event(0);
 
   anx7625_dp_get_edid(0, &recognized_edid);