feat: 修改聆听建网逻辑, 增加建网帧接收控制

src/networking/link_layer/scan.c

@@ -39,8 +39,52 @@
 /************************** Variable Definitions *****************************/
 
 /************************** Function Prototypes ******************************/
+static void AdvRecvStateUpdate(L2_SCAN_FSM *scanFsmPtr, bool state);
+static int32_t Scan_AdvHandler(L2_INST *instPtr);
 static int32_t ScanMsg_Packing(L2_INST *instPtr, L2_FRAME_TYPE type, uint8_t dstId);
 
+/**
+ * @brief   Update Base-info Advertisement state.
+ */
+static void AdvRecvStateUpdate(L2_SCAN_FSM *scanFsmPtr, bool state)
+{
+	ASSERT(scanFsmPtr != NULL);
+	DBG_INFO("Update AdvRecvState from [%" PRId8 "] to [%" PRId8 "].\n",
+			 scanFsmPtr->isAdvRecvd, state);
+	scanFsmPtr->isAdvRecvd = state;
+	return;
+}
+
+/*****************************************************************************/
+/**
+ * @brief	Member node scan net BmAdvt stage handler.
+ *
+ * @param	instPtr	Pointer to linklayer layer instance.
+ *
+ * @return	used slot (2 ms slot).
+ *
+ ******************************************************************************/
+static int32_t Scan_AdvHandler(L2_INST *instPtr)
+{
+	ASSERT(instPtr != NULL);
+	L2_SCAN_FSM *scanFsmPtr = instPtr->scanFSM;
+	DBG_INFO("** Net-Setup - Advertisement Procedure (Attempts: %" PRIu8 ") **\n", scanFsmPtr->advCnt);
+
+	// Network status is updated in L2_Scan_PktHandler() if valid ADV frame is received.
+	if (scanFsmPtr->isAdvRecvd == true)
+	{
+		DBG_ERROR("Only unconnected node can execute Scan_AdvHandler().\n");
+		return EUNEXP;
+	}
+	// no valid bm frame was received.
+	else
+	{
+		(void)L2_SetupNextSlot(instPtr, L2_TOR_RX, L2_FRAME_ADV);
+		scanFsmPtr->advCnt++;
+	}
+	return SUCCESS;
+}
+
 /*****************************************************************************/
 /**
  * @brief   Packing Scan message to a bit array.
@@ -167,6 +211,7 @@ int32_t L2_Scan_PktHandler(L2_INST *instPtr, uint8_t *msg)
 	ASSERT(instPtr != NULL);
 	ASSERT(msg != NULL);
 	int32_t Status;
+	L2_SCAN_FSM *scanFsmPtr = instPtr->scanFSM;
 	L2_FRAME_TYPE frameType = L2_FRAME_NONE;
 	L2_FrameGetChunk(msg, L2_MSG_TYPE, L2_MSG_TYPE_LEN, &frameType);
 
@@ -247,6 +292,8 @@ int32_t L2_Scan_PktHandler(L2_INST *instPtr, uint8_t *msg)
 		memcpy(instPtr->log.rxLog.data, msg, sizeof(L2_MSG_ADV));
 		instPtr->log.rxLog.dataId = dataId;
 
+		// trigger flag
+		AdvRecvStateUpdate(scanFsmPtr, true);
 		Status = SUCCESS;
 		break;
 	}
@@ -327,6 +374,82 @@ int32_t L2_Scan_PktHandler(L2_INST *instPtr, uint8_t *msg)
 	return Status;
 }
 
+/*****************************************************************************/
+/**
+ * @brief   Initialize scan FSM.
+ *
+ * @param   instPtr
+ *
+ * @return
+ *
+ ******************************************************************************/
+int32_t L2_Scan_Init(L2_SCAN_FSM **scanFSMPtr)
+{
+	ASSERT(scanFSMPtr != NULL);
+	*scanFSMPtr = (L2_SCAN_FSM *)malloc(sizeof(L2_SCAN_FSM));
+	if (*scanFSMPtr == NULL)
+	{
+		DBG_ERROR("Failed to allocate memory for scanFsmPtr.\n");
+		return ENOMEM;
+	}
+	L2_Scan_Reset(*scanFSMPtr);
+	return SUCCESS;
+}
+
+/*****************************************************************************/
+/**
+ * @brief  Reset ScanNet FSM
+ *
+ * @param   scanFsmPtr a pointer to scan net  finite state machine
+ *
+ * @return  NONE
+ *
+ ******************************************************************************/
+void L2_Scan_Reset(L2_SCAN_FSM *scanFSMPtr)
+{
+	ASSERT(scanFSMPtr != NULL);
+	scanFSMPtr->isAdvRecvd = false;
+	scanFSMPtr->advCnt = 0;
+}
+
+/*****************************************************************************/
+/**
+ * @brief  Destroy ScanNet FSM, free memory
+ *
+ * @param   scanFsmPtr a pointer to scan net  finite state machine
+ *
+ * @return  NONE
+ *
+ ******************************************************************************/
+void L2_Scan_Destroy(L2_SCAN_FSM *scanFSMPtr)
+{
+	free(scanFSMPtr);
+}
+
+/*****************************************************************************/
+/**
+ * @brief   Execute a member node scan net procedure.
+ *
+ * @param   instPtr	a pointer to linklayer layer instance
+ *
+ * @return  used slot (2 ms slot).
+ *
+ ******************************************************************************/
+int32_t L2_Scan_Proc(L2_INST *instPtr)
+{
+	if (L2_GetNodeType(instPtr) == L2_NODE_HEAD)
+	{
+		DBG_ERROR("Only member node needs to execute L2_Scan_Proc. \n");
+		return FAILURE;
+	}
+	int32_t Status;
+	DBG_INFO("-------- ScanNet Process --------\n");
+
+	Status = Scan_AdvHandler(instPtr);
+
+	return Status;
+}
+
 /*****************************************************************************/
 
 /**