merged datalink814.

2024-01-22 19:08:52 +08:00
parent add250cdcb
commit a116e2e27e
47 changed files with 3972 additions and 3110 deletions
@@ -42,24 +42,57 @@
 /************************** Function Prototypes ******************************/
 int32_t SetupInterruptSystem(struct irq_ctrl_desc *descPtr);
 void Phy_IntrHandler(void *context);
+void PeriodicPull_Handler(void *callBackRef);
 void ScuTimer_IntrHandler(void *context);
 void Systembus_RxIntrHandler(void *context);
 /************************** Constant Definitions *****************************/
 struct callback_desc phy_callback_desc = {
 	.callback = Phy_IntrHandler,
-	.ctx = NULL};
+	.ctx = NULL
+};
+
+struct callback_desc periodicpull_callback_desc = {
+	.callback = PeriodicPull_Handler,
+	.ctx = NULL
+};
+

 struct callback_desc sysbus_rx_callback_desc = {
 	.callback = Systembus_RxIntrHandler,
-	.ctx = NULL};
+	.ctx = NULL
+};

 struct callback_desc sysbus_tx_callback_desc = {
 	.callback = Systembus_RxIntrHandler,
-	.ctx = NULL};
+	.ctx = NULL
+};

 struct callback_desc scutm_callback_desc = {
 	.callback = ScuTimer_IntrHandler,
-	.ctx = NULL};
+	.ctx = NULL
+};
+
+static L2_CONFIG linkConfig = {
+	.myType = L2_NODE_HEAD,
+	.clustId = 1,
+	.myId = 1,
+	.headId = 1,
+	.bkpHeadId = 0,
+	.netScale = 2,
+	.phyInstPtr = NULL, // pyhsical layer reference
+	.tmcInstPtr = NULL
+};
+
+// static L2_CONFIG linkConfig = {
+// 	.myType = L2_NODE_MEMBER,
+// 	.clustId = 1,
+// 	.myId = 2,
+// 	.headId = 1,
+// 	.bkpHeadId = 0,
+// 	.netScale = 2,
+// 	.phyInstPtr = NULL, // pyhsical layer reference
+// 	.tmcInstPtr = NULL
+// };

 static PHY_CONFIG phyConfig = {
 	.devId = 0,
@@ -67,33 +100,25 @@ static PHY_CONFIG phyConfig = {
 	.antBramId = PHY_ANTCONFIG_BRAM_DEVICE_ID,
 	.txBramId = PHY_TXBUFF_BRAM_DEVICE_ID,
 	.rxBramId = PHY_RXBUFF_BRAM_DEVICE_ID,
-	.hwXadcId = PHY_HW_XADC_DEVICE_ID};
-
-static L2_CONFIG linkConfig = {
-	.myType = L2_HEAD_NODE,
-	.myId = 1,
-	.headId = 1,
-	.netScale = 2,
-	.phyInstRef = NULL // pyhsical layer reference
+	.hwXadcId = PHY_HW_XADC_DEVICE_ID
 };

-// static L2_CONFIG linkConfig = {
-//	.myType = L2_MEMBER_NODE,
-//	.myId = 2,
-//	.headId = 1,
-//	.netScale = 2,
-//	.phyInstRef = NULL // pyhsical layer reference
-// };
+TIMECTRL_CONFIG tmcConfig = {
+	.baseAddr = 0, //TIME_CONTROLLER_BASEADDR,
+	.reset = 10
+};

 static SYSBUS_CONFIG sysbusConfig = {
 	.baseAddr = SYSBUS_BASE_ADDR,
 	.txQueueMax = 16,
-	.rxQueueMax = 16};
+	.rxQueueMax = 16
+};
 /*********************** Driver Instance Definitions **************************/
 static struct irq_ctrl_desc *intcDescPtr; // General interrupt controller descriptor
 static struct timer_desc *logTmPtr;
 static SYSBUS *sysbusDescPtr;
 static PHY_INST *phyInstPtr;
+static TIMECTRL_INST *tmcInstPtr = NULL;
 static L2_INST *linkInstPtr;

 static struct hmc7044_dev *hmc7044_inst;
@@ -139,7 +164,7 @@ int32_t SetupInterruptSystem(struct irq_ctrl_desc *descPtr)
 		return Status;
 	}
 	// Set highest interrupt priority
-	Status = irq_set_priority(descPtr, PHY_INTR_ID, 0x00);
+	Status = irq_set_priority(descPtr, PHY_INTR_ID, 0x08);
 	if (Status != SUCCESS)
 	{
 		DBG_ERROR("PHY_INTR priority level set FAILED, ErrorCode: %ld.\n", Status);
@@ -148,6 +173,28 @@ int32_t SetupInterruptSystem(struct irq_ctrl_desc *descPtr)
 	// Connect the interrupt service routine isr1 to the interrupt controller
 	Status = irq_register_callback(descPtr, PHY_INTR_ID, &phy_callback_desc);
 	if (Status != SUCCESS)
+	{
+		DBG_ERROR("PHY_INTR register callback FAILED, ErrorCode: %ld.\n", Status);
+		return Status;
+	}
+
+		/* Initialize linklayer layer interrupt. */
+	Status = irq_trigger_level_set(descPtr, PERIODIC_5MS_INTR_ID, IRQ_EDGE_RISING);
+	if (Status != SUCCESS)
+	{
+		DBG_ERROR("PERIODIC_5MS_INTR_ID trigger level set FAILED, ErrorCode: %ld.\n", Status);
+		return Status;
+	}
+	// Set highest interrupt priority
+	Status = irq_set_priority(descPtr, PERIODIC_5MS_INTR_ID, 0x00);
+	if (Status != SUCCESS)
+	{
+		DBG_ERROR("PERIODIC_5MS_INTR_ID priority level set FAILED, ErrorCode: %ld.\n", Status);
+		return Status;
+	}
+	// Connect the interrupt service routine isr1 to the interrupt controller
+	Status = irq_register_callback(descPtr, PHY_INTR_ID, &periodicpull_callback_desc);
+	if (Status != SUCCESS)
 	{
 		DBG_ERROR("PHY_INTR register callback FAILED, ErrorCode: %ld.\n", Status);
 		return Status;
@@ -161,7 +208,7 @@ int32_t SetupInterruptSystem(struct irq_ctrl_desc *descPtr)
 		return Status;
 	}
 	// Set interrupt priority
-	Status = irq_set_priority(descPtr, SYSBUS_TX_INTR_ID, 0x08);
+	Status = irq_set_priority(descPtr, SYSBUS_TX_INTR_ID, 0x10);
 	if (Status != SUCCESS)
 	{
 		DBG_ERROR("PHY_INTR priority level set FAILED, ErrorCode: %ld.\n", Status);
@@ -182,7 +229,7 @@ int32_t SetupInterruptSystem(struct irq_ctrl_desc *descPtr)
 		return Status;
 	}
 	// Set interrupt priority
-	Status = irq_set_priority(descPtr, SYSBUS_RX_INTR_ID, 0x10);
+	Status = irq_set_priority(descPtr, SYSBUS_RX_INTR_ID, 0x18);
 	if (Status != SUCCESS)
 	{
 		DBG_ERROR("PHY_INTR priority level set FAILED, ErrorCode: %ld.\n", Status);
@@ -208,6 +255,7 @@ int32_t SetupInterruptSystem(struct irq_ctrl_desc *descPtr)

 	// Enable interrupts
 	irq_enable(descPtr, PHY_INTR_ID);
+	irq_enable(descPtr, PERIODIC_5MS_INTR_ID);
 	irq_enable(descPtr, SYSBUS_RX_INTR_ID);
 	irq_enable(descPtr, SYSBUS_TX_INTR_ID);
 	irq_enable(descPtr, SCUTIMER_INTR_ID);
@@ -233,6 +281,21 @@ int32_t SetupInterruptSystem(struct irq_ctrl_desc *descPtr)
 *
 *****************************************************************************/
 void Phy_IntrHandler(void *context)
+{
+	Phy_UpdateState(phyInstPtr);
+} // PhyIntr_Handler
+
+
+/****************************************************************************/
+/**
+ * Handler of periodic 5ms interrupt
+ *
+ * @param    callBackRef is the linklayer instance pointer.
+ *
+ * @return   None.
+ *
+ *****************************************************************************/
+void PeriodicPull_Handler(void *callBackRef)
 {
 	int32_t Status;
 	Status = Linklayer_Proc(linkInstPtr);
@@ -241,7 +304,7 @@ void Phy_IntrHandler(void *context)
 		DBG_ERROR("Link layer runs failed, with error code: %ld\n", Status);
 		_nop_();
 	}
-} // PhyIntr_Handler
+} // PeriodicPull_Handler

 /*****************************************************************************/
 /**
@@ -681,7 +744,8 @@ int main(void)
 		DBG_PRINT("System monitor Init FAILED! \n");
 		return Status;
 	}
-
+	
+	/* Hardware Initialize */
 	Status = Hardware_Init();
 	if (Status == SUCCESS)
 	{
@@ -693,6 +757,18 @@ int main(void)
 		return Status;
 	}

+	/* Time controller Initialize */
+	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)
@@ -706,7 +782,8 @@ int main(void)
 	}

 	/* Link Layer Initialize */
-	linkConfig.phyInstRef = phyInstPtr;
+	linkConfig.phyInstPtr = phyInstPtr;
+	linkConfig.tmcInstPtr = tmcInstPtr;
 	Status = Linklayer_Init(&linkInstPtr, &linkConfig);
 	if (Status == SUCCESS)
 	{
@@ -749,8 +826,10 @@ int main(void)
 	// Start System Monitor logging.
 	timer_start(logTmPtr);

-	Phy_Start(phyInstPtr);
 	DBG_PRINT("Physical started...\n");
+	Phy_Start(phyInstPtr);
+	
+	Linklayer_Start(linkInstPtr);

 	while (true)
 	{