fwk: cypd: check the RDO mismatch flags

If the type-c device operating current is lower than maximum operating power
in the RDO, the capability mismatch flag will be set.

This change reads the contract information after the negotiation is completed.
If the capability mismatch flag is set, call the event to check if the board
allows changing the PDO or not.

BRANCH=fwk-dogwood-27111
BUG=https://app.clickup.com/t/86etza0y1
TEST=Connect the device which will set the mismatch flag, and check
     the EC log prints "RDO Mismatch, may provide more power for this
     device"

Signed-off-by: Josh Tsai <Josh_Tsai@compal.com>

Author: Josh-Tsai

zephyr/program/framework/include/cypress_pd_common.h

@@ -295,6 +295,7 @@ enum pd_task_evt {
 	CCG_EVT_PDO_C1P1 = BIT(22),
 	CCG_EVT_PERFORM_ERROR_RECOVERY = BIT(23),
 	CCG_EVT_PDO_RESET = BIT(24),
+	CCG_EVT_RDO_MISMATCH = BIT(25),
 };
 
 /************************************************
@@ -519,6 +520,7 @@ struct pd_port_current_state_t {
 	int voltage;
 	int current;
 	int ac_port;
+	bool rdo_mismatch;
 	enum ccg_c_state c_state; /* What device is attached on the other side */
 	uint8_t pd_state;
 	uint8_t cc;
@@ -813,6 +815,12 @@ int cypd_get_ac_power(void);
  */
 int cypd_get_active_port_voltage(void);
 
+/**
+ * Board can override the logic to allow PD chips to change
+ * the source PDO from 5V/1.5A to 5V/3A
+ */
+__override_proto bool cypd_allow_increase_rdo_profile(void);
+
 /**
  * Safety level LEVEL_TYPEC_1_5A trigger, modify sink 3A port to 1.5A
  *

zephyr/program/framework/src/cypress_pd_common.c

@@ -998,6 +998,7 @@ static void clear_port_state(int controller, int port)
 	pd_port_states[port_idx].c_state = 0;
 	pd_port_states[port_idx].current = 0;
 	pd_port_states[port_idx].voltage = 0;
+	pd_port_states[port_idx].rdo_mismatch = false;
 }
 
 void cypd_update_port_state(int controller, int port)
@@ -1470,6 +1471,11 @@ int cypd_get_active_port_voltage(void)
 	return pd_port_states[prev_charge_port].voltage;
 }
 
+__overridable bool cypd_allow_increase_rdo_profile(void)
+{
+	return false;
+}
+
 /*****************************************************************************/
 /* Interrupt handler */
 
@@ -1702,7 +1708,20 @@ void cypd_port_int(int controller, int port)
 	case CCG_RESPONSE_PD_CONTRACT_NEGOTIATION_COMPLETE:
 		CPRINTS("CYPD_RESPONSE_PD_CONTRACT_NEGOTIATION_COMPLETE %d", port_idx);
 		cypd_update_port_state(controller, port);
-		cypd_set_prepare_pdo(controller, port);
+
+		/* Read the contract information if we are the source */
+		int pd_port = ((controller << 2) + port);
+
+		if (pd_port_states[pd_port].pd_state == PD_ROLE_SOURCE) {
+			i2c_read_offset16_block(i2c_port, addr_flags,
+				CCG_READ_DATA_MEMORY_REG(port, 0), data2, MIN(response_len, 32));
+
+			if (data2[0] & BIT(1)) {
+				CPRINTS("RDO Mismatch, may provide more power for this device");
+				pd_port_states[pd_port].rdo_mismatch = true;
+				task_set_event(TASK_ID_CYPD, CCG_EVT_RDO_MISMATCH);
+			}
+		}
 #ifdef CONFIG_PD_CCG8_EPR
 		/* make sure enter EPR mode only process in S0 state */
 		if (chipset_in_state(CHIPSET_STATE_ON))
@@ -1713,7 +1732,6 @@ void cypd_port_int(int controller, int port)
 	case CCG_RESPONSE_PORT_CONNECT:
 		CPRINTS("CYPD_RESPONSE_PORT_CONNECT %d", port_idx);
 		record_ucsi_connector_change_event(controller, port);
-		cypd_set_typec_profile(controller, port);
 		cypd_update_port_state(controller, port);
 		break;
 	case CCG_RESPONSE_SOURCE_CAP_MSG_RX:
@@ -1933,6 +1951,17 @@ void cypd_interrupt_handler_task(void *p)
 			task_wait_event_mask(TASK_EVENT_TIMER, 10);
 		}
 
+		if (evt & CCG_EVT_RDO_MISMATCH) {
+			if (cypd_allow_increase_rdo_profile()) {
+				for (i = 0; i < PD_PORT_COUNT; i++) {
+					if (pd_port_states[i].rdo_mismatch)
+						cypd_select_pdo(PORT_TO_CONTROLLER(i),
+								PORT_TO_CONTROLLER_PORT(i),
+								CCG_PD_CMD_SET_TYPEC_3A);
+				}
+			}
+		}
+
 		if (evt & CCG_EVT_DPALT_DISABLE) {
 			poweroff_dp_check();
 		}