fwk: cypd: fix multi-port switch affect by new request

if have a new request from charger task
we should make sure the port is connected and must be an active port.

BRANCH=fwk-main
BUG=when unplug second port adp(bigger adp), the small one won't charge battery
TEST=test on Lotus, plug in 65w adp to port2, and plug 180w to port3, than unplug
180w, make sure 65w still can charge, type cypdstatus 1 check port2 VBUS-FET is EC ON.

Signed-off-by: LeoCX_Tsai <[email protected]>
(cherry picked from commit b922b830a1b1d374889a034e3b0a9c092e9f4c06)

Author: LeoCX-Tsai

zephyr/program/framework/src/cypress_pd_common.c

@@ -2031,7 +2031,8 @@ void pd_set_new_power_request(int port)
 	 * eg: after PD send again CCG_RESPONSE_PD_CONTRACT_NEGOTIATION_COMPLETE
 	 * will set a new power request, the VBUS port need to open again.
 	 */
-	board_set_active_charge_port(port);
+	if (get_active_charge_pd_port() == port && pd_is_connected(port))
+		board_set_active_charge_port(port);
 	return;
 }