*bugfix: add node ttl reset

df_datalink_ge/src/config/app_config.h

@@ -67,6 +67,9 @@
 #define PHY_INTR_ID XPAR_FABRIC_PHY_IRQ_INTR
 #define PERIODIC_5MS_INTR_ID XPAR_FABRIC_PHY_5MS_DELAY_2MS_INTR
 
+// Time Controller Configs
+#define TIME_CONTROLLER_BASEADDR XPAR_TMC_BASEADDR
+
 // System Bus Configs
 //#define SYSBUS_BASE_ADDR	XPAR_SYSTEMBUS_BASEADDR
 //#define SYSBUS_TX_INTR_ID	XPAR_FABRIC_SYSTEMBUS_TX_DONE_INTR

df_datalink_ge/src/main.c

@@ -108,7 +108,7 @@ static PHY_CONFIG phyConfig = {
 };
 
 TMC_CONFIG tmcConfig = {
-	.baseAddr = 0, //TIME_CONTROLLER_BASEADDR,
+	.baseAddr = TIME_CONTROLLER_BASEADDR,
 	.reset = 10
 };
 
@@ -192,7 +192,7 @@ int32_t SetupInterruptSystem(struct irq_ctrl_desc *descPtr)
 		return Status;
 	}
 	// Connect the interrupt service routine isr1 to the interrupt controller
-	Status = irq_register_callback(descPtr, PHY_INTR_ID, &periodicpull_callback_desc);
+	Status = irq_register_callback(descPtr, PERIODIC_5MS_INTR_ID, &periodicpull_callback_desc);
 	if (Status != SUCCESS)
 	{
 		DBG_ERROR("PHY_INTR register callback FAILED, ErrorCode: %ld.\n", Status);
@@ -407,99 +407,101 @@ int main(void)
 	}
 
 	// Init time controller
-		Status = TimeCtrl_Init(&tmcInstPtr, &tmcConfig);
-		if (Status == SUCCESS)
-		{
-			DBG_PRINT("TmcCtrl Init SUCCESS! \n");
-		}
-		else
-		{
-			DBG_PRINT("TmcCtrl Init FAILED! \n");
-			return Status;
-		}
+	Status = TimeCtrl_Init(&tmcInstPtr, &tmcConfig);
+	if (Status == SUCCESS)
+	{
+		DBG_PRINT("TmcCtrl Init SUCCESS! \n");
+	}
+	else
+	{
+		DBG_PRINT("TmcCtrl Init FAILED! \n");
+		return Status;
+	}
 
-		/* Physical Layer Initialize */
-		Status = Phy_InstInit(&phyInstPtr, &phyConfig);
-		if (Status == SUCCESS)
-		{
-			DBG_PRINT("Physical layer Init SUCCESS! \n");
-		}
-		else
-		{
-			DBG_PRINT("Physical layer FAILED! \n");
-			return Status;
-		}
+	/* Physical Layer Initialize */
+	Status = Phy_InstInit(&phyInstPtr, &phyConfig);
+	if (Status == SUCCESS)
+	{
+		DBG_PRINT("Physical layer Init SUCCESS! \n");
+	}
+	else
+	{
+		DBG_PRINT("Physical layer FAILED! \n");
+		return Status;
+	}
 
-		/* Link Layer Initialize */
-		linkConfig.phyInstPtr = phyInstPtr;
-		linkConfig.tmcInstPtr = tmcInstPtr;
-		Status = Linklayer_Init(&linkInstPtr, &linkConfig);
-		if (Status == SUCCESS)
-		{
-			DBG_PRINT("LinkLayer Init SUCCESS! \n");
-		}
-		else
-		{
-			DBG_PRINT("Linklayer Init FAILED! \n");
-			return Status;
-		}
+	/* Link Layer Initialize */
+	linkConfig.phyInstPtr = phyInstPtr;
+	linkConfig.tmcInstPtr = tmcInstPtr;
+	Status = Linklayer_Init(&linkInstPtr, &linkConfig);
+	if (Status == SUCCESS)
+	{
+		DBG_PRINT("LinkLayer Init SUCCESS! \n");
+	}
+	else
+	{
+		DBG_PRINT("Linklayer Init FAILED! \n");
+		return Status;
+	}
 
-//		/* System Bus Initialize */
-//		Status = SystemBus_Init(&sysbusDescPtr, &sysbusConfig);
-//		if (Status != SUCCESS)
-//		{
-//			DBG_ERROR("Systembus init FAILED, with error code: %d\n", Status);
-//			return Status;
-//		}
+	// /* System Bus Initialize */
+	// Status = SystemBus_Init(&sysbusDescPtr, &sysbusConfig);
+	// if (Status != SUCCESS)
+	// {
+	// 	DBG_ERROR("Systembus init FAILED, with error code: %d\n", Status);
+	// 	return Status;
+	// }
 
-		/* System Monitor log timer Initialize */
-		Status = timer_init(&logTmPtr, &scutimer_init_param);
-		if (Status != SUCCESS)
-		{
-			DBG_ERROR("SCU Timer init FAILED, with error code: %d\n", Status);
-			return Status;
-		}
+	/* System Monitor log timer Initialize */
+	Status = timer_init(&logTmPtr, &scutimer_init_param);
+	if (Status != SUCCESS)
+	{
+		DBG_ERROR("SCU Timer init FAILED, with error code: %d\n", Status);
+		return Status;
+	}
 
-		/* interrupts Initialize */
-		Status = SetupInterruptSystem(intcDescPtr);
-		if (Status == SUCCESS)
-		{
-			DBG_INFO("Interrupt system setup SUCCESS!\n");
-		}
-		else
-		{
-			DBG_ERROR("Interrupt system setup FAILED, ErrorCode: %d.\n", Status);
-			return Status;
-		}
+	/* interrupts Initialize */
+	Status = SetupInterruptSystem(intcDescPtr);
+	if (Status == SUCCESS)
+	{
+		DBG_INFO("Interrupt system setup SUCCESS!\n");
+	}
+	else
+	{
+		DBG_ERROR("Interrupt system setup FAILED, ErrorCode: %d.\n", Status);
+		return Status;
+	}
 
-		// Start System Monitor logging.
-		timer_start(logTmPtr);
+	// Start System Monitor logging.
+	timer_start(logTmPtr);
 
-		DBG_PRINT("Physical started...\n");
-		Phy_Start(phyInstPtr);
+	DBG_PRINT("Physical started...\n");
+	Phy_Start(phyInstPtr);
 
-		Linklayer_Start(linkInstPtr);
+	Linklayer_Start(linkInstPtr);
 
-		while (true)
-		{
-			// System bus handler
-			if (SystemBus_IsReqPendding(sysbusDescPtr))
-			{
-				Status = SystemBus_HandleCmd(sysbusDescPtr);
-				if (Status != SUCCESS)
-				{
-					DBG_ERROR("SystemBus_HandleCmd exit with ErrorCode: %d.\n", Status);
-				}
-			}
-			if (SystemBus_IsRsqPendding(sysbusDescPtr) && (!SystemBus_IsTxBusy(sysbusDescPtr)))
-			{
-				// FIXME: Required by 12 (CASC)
-				udelay(200);
-				Status = SystemBus_MakeResp(sysbusDescPtr);
-				if (Status != SUCCESS)
-				{
-					DBG_ERROR("SystemBus_HandleCmd exit with ErrorCode: %d.\n", Status);
-				}
-			}
-		}
+	while (true);
+
+	// while (true)
+	// {
+	// 	// System bus handler
+	// 	if (SystemBus_IsReqPendding(sysbusDescPtr))
+	// 	{
+	// 		Status = SystemBus_HandleCmd(sysbusDescPtr);
+	// 		if (Status != SUCCESS)
+	// 		{
+	// 			DBG_ERROR("SystemBus_HandleCmd exit with ErrorCode: %d.\n", Status);
+	// 		}
+	// 	}
+	// 	if (SystemBus_IsRsqPendding(sysbusDescPtr) && (!SystemBus_IsTxBusy(sysbusDescPtr)))
+	// 	{
+	// 		// FIXME: Required by 12 (CASC)
+	// 		udelay(200);
+	// 		Status = SystemBus_MakeResp(sysbusDescPtr);
+	// 		if (Status != SUCCESS)
+	// 		{
+	// 			DBG_ERROR("SystemBus_HandleCmd exit with ErrorCode: %d.\n", Status);
+	// 		}
+	// 	}
+	// }
 } // main

df_datalink_sp/src/config/app_config.h

@@ -67,6 +67,9 @@
 #define PHY_INTR_ID XPAR_FABRIC_PHY_IRQ_INTR
 #define PERIODIC_5MS_INTR_ID XPAR_FABRIC_PHY_5MS_DELAY_2MS_INTR
 
+// Time Controller Configs
+#define TIME_CONTROLLER_BASEADDR XPAR_TMC_BASEADDR
+
 // System Bus Configs
 #define SYSBUS_BASE_ADDR	XPAR_SYSTEMBUS_BASEADDR
 #define SYSBUS_TX_INTR_ID	XPAR_FABRIC_SYSTEMBUS_TX_DONE_INTR

df_datalink_sp/src/main.c

@@ -104,7 +104,7 @@ static PHY_CONFIG phyConfig = {
 };
 
 TMC_CONFIG tmcConfig = {
-	.baseAddr = 0, //TIME_CONTROLLER_BASEADDR,
+	.baseAddr = TIME_CONTROLLER_BASEADDR,
 	.reset = 10
 };
 
@@ -193,7 +193,7 @@ int32_t SetupInterruptSystem(struct irq_ctrl_desc *descPtr)
 		return Status;
 	}
 	// Connect the interrupt service routine isr1 to the interrupt controller
-	Status = irq_register_callback(descPtr, PHY_INTR_ID, &periodicpull_callback_desc);
+	Status = irq_register_callback(descPtr, PERIODIC_5MS_INTR_ID, &periodicpull_callback_desc);
 	if (Status != SUCCESS)
 	{
 		DBG_ERROR("PHY_INTR register callback FAILED, ErrorCode: %ld.\n", Status);

df_datalink_sp/src/networking/link_layer/routine_table.c

@@ -99,8 +99,8 @@ L2_RTNE_TABLE_ENTRY intraScanSubT[L2_SLOTS_PER_FRAME] = {
 	{L2_SLOT_ADVERTISE, 0x01, 0x01, 0xFF},
 	{L2_SLOT_ADVERTISE, 0x02, 0x01, 0xFF},
 	{L2_SLOT_ADVERTISE, 0x03, 0x01, 0xFF},
-	{L2_SLOT_IDLE, 0x00},
-	{L2_SLOT_IDLE, 0x00},
+	{L2_SLOT_IDLE, 0x00, 0x00, 0x00},
+	{L2_SLOT_IDLE, 0x00, 0x00, 0x00},
 // SubFrame 4
 	{L2_SLOT_CONFIRM, 0x00, 0x01, 0xFF},
 	{L2_SLOT_CONFIRM, 0x01, 0x01, 0xFF},

df_datalink_sp/src/networking/link_layer/scan.c

@@ -26,7 +26,9 @@
 
 /************************** Constant Definitions *****************************/
 #define ADV_LISTEN_TIMEOUT 40
-#define CFM_LISTEN_TIMEOUT 40
+#define CFM_LISTEN_TIMEOUT 25
+#define ADV_FRAME_SLOTS 4
+#define CFM_FRAME_SLOTS 4
 /***************** Macros (In-line Functions) Definitions *********************/
 
 /**************************** Type Definitions *******************************/
@@ -193,15 +195,16 @@ static int32_t Scan_CfmHandler(L2_INST *instPtr)
 	{
 		DBG_WARNING("Cmf timeout, restart net scan from L2_SCAN_INIT_STAGE.\n");
 		L2_Scan_Reset(scanFsmPtr);
+		return SUCCESS;
 	}
-	else
+	if (L2_GetNextSlotNum(instPtr) % CFM_FRAME_SLOTS == 0)
 	{
+		// using pull mode to receive confirm frame
+		// since first time sync procedure is accomplished in ADV stage.
+		Phy_SetMode(instPtr->config.phyInstPtr, PHY_MODE_PULL);
+		L2_SetupNextSlot(instPtr, L2_TOR_RX, L2_CFM_FRAME);
 		scanFsmPtr->cfmTimeout++; // increase counter.
 	}
-	// using pull mode to receive confirm frame
-	// since first time sync procedure is accomplished in BM stage.
-	Phy_SetMode(instPtr->config.phyInstPtr, PHY_MODE_PULL);
-	L2_SetupNextSlot(instPtr, L2_TOR_RX, L2_CFM_FRAME);
 	return SUCCESS;
 }
 
@@ -403,6 +406,9 @@ int32_t L2_Scan_PktHandler(L2_INST *instPtr, uint8_t *msg)
 		L2_FrameGetChunk(msg, L2_MSG_ADV_SRC_POSZ, L2_MSG_ADV_SRC_POSZ_LEN, &nodePos);
 		node->nodeInfo.pos.z = (double) nodePos;
 
+		// Reset node ttl
+		node->ttlCnt = 0;
+
 		if (L2_isCxn2Net(instPtr) == false)
 		{
 			uint32_t netstartTime, frameNum, slotNum = 0;
@@ -456,6 +462,9 @@ int32_t L2_Scan_PktHandler(L2_INST *instPtr, uint8_t *msg)
 		L2_FrameGetChunk(msg, L2_MSG_CFM_SRC_SPEEDZ, L2_MSG_CFM_SRC_SPEEDZ_LEN, &nodeSpeed);
 		node->nodeInfo.speed.z = (double) nodePos;
 
+		// Reset node ttl
+		node->ttlCnt = 0;
+
 		if (L2_GetNodeType(instPtr) != L2_NODE_HEAD)
 		{
 			// check if net setup finished.

df_datalink_sp/src/networking/link_layer/service.c

@@ -255,6 +255,9 @@ int32_t L2_Service_PktHandler(L2_INST *instPtr, uint8_t *msg)
 		L2_FrameGetChunk(msg, L2_MSG_SVC_SRC_SPEEDZ, L2_MSG_SVC_SRC_SPEEDZ_LEN, &nodeSpeed);
 		node->nodeInfo.speed.z = (double) nodePos;
 
+		// Reset node ttl
+		node->ttlCnt = 0;
+
 		if(L2_GetNodeType(instPtr) == L2_NODE_HEAD) 
 		{
 			SysMonitor_UpdateRecvPayloadLJRaw(msg+L2_MSG_SVC_PAYLOAD);

df_datalink_sp/src/networking/phy_layer/phy_layer.c

@@ -629,7 +629,7 @@ int32_t Phy_SetupNextSlot(PHY_INST *instPtr, PHY_TOR_TYPE txrxMode,
 		hopPattern = hopPattern_10KBPS_20MS;
 		break;
 	case L1_40KBPS_20MS_FRAME:
-		phyModeCtrl |= PHY_MODE_CTRL_FRAME_200KBPS_5MS;
+		phyModeCtrl |= PHY_MODE_CTRL_FRAME_40KBPS_20MS;
 		hopNum = L1_FRAME_200KBPS_5MS_HOPS;
 		hopPattern = hopPattern_200KBPS_5MS;
 		break;
@@ -654,6 +654,9 @@ int32_t Phy_SetupNextSlot(PHY_INST *instPtr, PHY_TOR_TYPE txrxMode,
 	}
 	}
 
+	// Set frame configs
+	PhyWrite(instPtr, PHY_MODE_CTRL, phyModeCtrl);
+
 	// TODO: Set antenna stand by, when suspend.
 	const uint8_t *dataSrcPtr = (uint8_t *)(&(instPtr->antConfig));
 	for (int32_t i = 0; i < hopNum; i++)
@@ -676,10 +679,12 @@ int32_t Phy_SetupNextSlot(PHY_INST *instPtr, PHY_TOR_TYPE txrxMode,
 				| ((sizeof(uint16_t) << ANT_CONFIG_LEN_SHIFT) & ANT_CONFIG_LEN_MASK);
 	*/
 	
+	// Set antenna configs
 	PhyWrite(instPtr, ANT_CONFIG, antCtrl);
 
 	if (txrxMode == PHY_TOR_TX)
 	{
+		// Set data to be sent
 		Status = Phy_SetSendData(instPtr, frameType, dataBuff);
 		if (Status != SUCCESS)
 		{