net: gptp: gptp port role disabled on link down

Set GPTP port role to disabled if port link is down.

Signed-off-by: Xabier Marquiegui <[email protected]>

Author: ainguraXmarquiegui

subsys/net/l2/ethernet/gptp/gptp.c

@@ -521,18 +521,23 @@ static void gptp_state_machine(void)
 	for (port = GPTP_PORT_START; port < GPTP_PORT_END; port++) {
 		struct gptp_port_ds *port_ds = GPTP_PORT_DS(port);
 
-		switch (GPTP_GLOBAL_DS()->selected_role[port]) {
-		case GPTP_PORT_DISABLED:
-		case GPTP_PORT_MASTER:
-		case GPTP_PORT_PASSIVE:
-		case GPTP_PORT_SLAVE:
-			gptp_md_state_machines(port);
-			gptp_mi_port_sync_state_machines(port);
-			gptp_mi_port_bmca_state_machines(port);
-			break;
-		default:
-			NET_DBG("%s: Unknown port state", __func__);
-			break;
+		/* If interface is down, don't move foward */
+		if (net_if_flag_is_set(GPTP_PORT_IFACE(port), NET_IF_UP)) {
+			switch (GPTP_GLOBAL_DS()->selected_role[port]) {
+			case GPTP_PORT_DISABLED:
+			case GPTP_PORT_MASTER:
+			case GPTP_PORT_PASSIVE:
+			case GPTP_PORT_SLAVE:
+				gptp_md_state_machines(port);
+				gptp_mi_port_sync_state_machines(port);
+				gptp_mi_port_bmca_state_machines(port);
+				break;
+			default:
+				NET_DBG("%s: Unknown port state", __func__);
+				break;
+			}
+		} else {
+			GPTP_GLOBAL_DS()->selected_role[port] = GPTP_PORT_DISABLED;
 		}
 
 		port_ds->prev_ptt_port_enabled = port_ds->ptt_port_enabled;