fwk: let connector remap port not to overwrite the other memory location

The connector change indicated port's size is 7 bits. We should
keep the memory's 8th-bit value. Add the 8th-bit value back when
we rewrite the EC_CUSTOMIZED_MEMMAP_UCSI_CTR_SPECIFIC shared
memory.
fix commit 64c85ed

BRANCH=fwk-main
BUG=https://app.clickup.com/t/86ervu6rf
BUG=https://app.clickup.com/t/86er6n76t
TEST=check HLK test item all pass

Signed-off-by: LeilaCY-Lin <LeilaCY_Lin@compal.com>
(cherry picked from commit 52ff80e)

Author: LeilaCY-Lin

zephyr/program/framework/src/ucsi.c

@@ -104,6 +104,7 @@ int ucsi_write_tunnel(void)
 	int controller = 0;
 	int offset = 0;
 	int rv = EC_SUCCESS;
+	int new_port = 0;
 
 	/**
 	 * Note that CONTROL data has always to be written after MESSAGE_OUT data is written
@@ -156,8 +157,13 @@ int ucsi_write_tunnel(void)
 				CPRINTS("UCSI write invalid type-c port:%d",
 					change_connector_indicator);
 		} else {
-			*host_get_memmap(EC_CUSTOMIZED_MEMMAP_UCSI_CTR_SPECIFIC + offset) =
-				  ucsi_pd_port_map[change_connector_indicator-1].pd_controller_port;
+			new_port =
+				ucsi_pd_port_map[change_connector_indicator-1].pd_controller_port;
+			if (new_port != change_connector_indicator) {
+				*host_get_memmap(EC_CUSTOMIZED_MEMMAP_UCSI_CTR_SPECIFIC + offset) =
+				(*host_get_memmap(EC_CUSTOMIZED_MEMMAP_UCSI_CTR_SPECIFIC + offset)
+				& 0x80)	| new_port;
+			}
 			controller = ucsi_pd_port_map[change_connector_indicator-1].pd_controller;
 		}
 
@@ -322,6 +328,7 @@ int ucsi_read_tunnel(int controller)
 	int rv, port_indicator;
 	int message_in_max_length;
 	uint16_t *version = (uint16_t *)host_get_memmap(EC_CUSTOMIZED_MEMMAP_UCSI_VERSION);
+	int new_port = 0;
 
 	if (ucsi_debug_enable && pd_chip_ucsi_info[controller].read_tunnel_complete == 1 &&
 		(pd_chip_ucsi_info[controller].cci & CCI_BUSY_FLAG) == 0) {
@@ -340,8 +347,11 @@ int ucsi_read_tunnel(int controller)
 		if (ucsi_debug_enable && port_indicator > PORTS_PER_CONTROLLER)
 			CPRINTS("UCSI read invalid type-c port:%d", port_indicator);
 	} else {
-		pd_chip_ucsi_info[controller].cci = (pd_chip_ucsi_info[controller].cci & 0xFFFFFF01)
-		| (pd_ucsi_port_map[controller*2+port_indicator-1] << 1);
+		new_port = (pd_ucsi_port_map[controller*2+port_indicator-1]);
+		if (port_indicator != new_port) {
+			pd_chip_ucsi_info[controller].cci = (pd_chip_ucsi_info[controller].cci
+			& 0xFFFFFF01) | (new_port << 1);
+		}
 	}
 
 	message_in_max_length = (*version < 0x0200) ? 16 : 34;