add ground emulator code.

2024-01-22 19:09:45 +08:00
parent a116e2e27e
commit 68678b39f6
367 changed files with 115148 additions and 0 deletions
@@ -0,0 +1,505 @@
+/*****************************************************************************/
+/**
+ * Description: main.c
+ *
+
+ * Date: 2021-11-13 13:19
+ * Last Editors: Fan Hao
+ * Last Edit Time: [2022-03-28 20:32]
+ *
+ * Revisions: Rev 0.0
+ * History:
+ * [2021-11-13]: Initial edition.
+ * [2022-03-28]: Add bit error test mode.
+ *
+ * Copyright(c) 2021 Beijing Institute of Technology.
+ * Lab of Communication and Networking
+ *
+ ******************************************************************************/
+
+/***************************** Include Files *********************************/
+// Standard
+#include <stdlib.h>
+#include <stdint.h>
+#include <stdbool.h>
+// Xilinx
+#include "sleep.h"
+#include "xil_cache.h"
+#include "xscugic.h"
+#include "xscutimer.h"
+#include "xgpiops.h"
+#include "drivers/platform/xilinx_irq.h"
+#include "drivers/platform/xilinx_timer.h"
+// App
+#include "common.h"
+#include "error.h"
+#include "timer.h"
+#include "config/app_config.h"
+#include "dev_profile/dev_profile.h"
+#include "systembus/systembus.h"
+#include "networking/phy_layer/phy_layer.h"
+#include "networking/link_layer/link_layer.h"
+// RF-Driver
+#include "hardware/headless.h"
+#include "hardware/platform_drivers.h"
+
+/************************** 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
+};
+
+struct callback_desc periodicpull_callback_desc = {
+	.callback = PeriodicPull_Handler,
+	.ctx = NULL
+};
+
+
+struct callback_desc sysbus_rx_callback_desc = {
+	.callback = Systembus_RxIntrHandler,
+	.ctx = NULL
+};
+
+struct callback_desc sysbus_tx_callback_desc = {
+	.callback = Systembus_RxIntrHandler,
+	.ctx = NULL
+};
+
+struct callback_desc scutm_callback_desc = {
+	.callback = ScuTimer_IntrHandler,
+	.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,
+	.baseAddr = PHY_BASEADDR,
+	.antBramId = PHY_ANTCONFIG_BRAM_DEVICE_ID,
+	.txBramId = PHY_TXBUFF_BRAM_DEVICE_ID,
+	.rxBramId = PHY_RXBUFF_BRAM_DEVICE_ID,
+	.hwXadcId = PHY_HW_XADC_DEVICE_ID
+};
+
+TIMECTRL_CONFIG tmcConfig = {
+	.baseAddr = 0, //TIME_CONTROLLER_BASEADDR,
+	.reset = 10
+};
+
+//static SYSBUS_CONFIG sysbusConfig = {
+//	.baseAddr = SYSBUS_BASE_ADDR,
+//	.txQueueMax = 16,
+//	.rxQueueMax = 16
+//};
+/************************** Function Prototypes ******************************/
+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;
+
+/****************************************************************************/
+/**
+ * This function is responsible for initializing the SCUGIC instance, looking
+ * for the device configuration based on the unique device ID, initializing a
+ * SCUGIC instance, and initialize the interrupt at IRQ_F2P[0:0]
+ *
+ * @param    intcDesc	A pointer to INTC descriptor
+ *
+ * @return  SUCCESS if initialize successful.
+ *          FAILURE if initialization failed.
+ *
+ *****************************************************************************/
+int32_t SetupInterruptSystem(struct irq_ctrl_desc *descPtr)
+{
+	int32_t Status;
+	struct xil_irq_desc *xil_dev;
+
+	Status = irq_ctrl_init(&descPtr, &intc_init_param);
+	if (Status != SUCCESS)
+	{
+		DBG_ERROR("Intc Init FAILED, ErrorCode: %ld.\n", Status);
+		return Status;
+	}
+
+	xil_dev = (struct xil_irq_desc *)(descPtr->extra);
+
+	// Clear any pending interrupt flags
+	uint32_t intrState = XScuGic_CPUReadReg((XScuGic *)(xil_dev->instance), XSCUGIC_INT_ACK_OFFSET);
+	XScuGic_CPUWriteReg((XScuGic *)(xil_dev->instance), XSCUGIC_EOI_OFFSET, intrState);
+
+	/* Initialize physical layer interrupt. */
+	Status = irq_trigger_level_set(descPtr, PHY_INTR_ID, IRQ_EDGE_RISING);
+	if (Status != SUCCESS)
+	{
+		DBG_ERROR("PHY_INTR trigger level set FAILED, ErrorCode: %ld.\n", Status);
+		return Status;
+	}
+	// Set highest interrupt priority
+	Status = irq_set_priority(descPtr, PHY_INTR_ID, 0x08);
+	if (Status != SUCCESS)
+	{
+		DBG_ERROR("PHY_INTR 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, &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;
+	}
+
+//	/* Initialize system bus interrupt. */
+//	Status = irq_trigger_level_set(descPtr, SYSBUS_TX_INTR_ID, IRQ_EDGE_RISING);
+//	if (Status != SUCCESS)
+//	{
+//		DBG_ERROR("PHY_INTR trigger level set FAILED, ErrorCode: %ld.\n", Status);
+//		return Status;
+//	}
+//	// Set interrupt priority
+//	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);
+//		return Status;
+//	}
+//
+//	// Connect the interrupt service routine isr1 to the interrupt controller
+//	Status = irq_register_callback(descPtr, SYSBUS_TX_INTR_ID, &sysbus_tx_callback_desc);
+//	if (Status != SUCCESS)
+//	{
+//		DBG_ERROR("PHY_INTR register callback FAILED, ErrorCode: %ld.\n", Status);
+//		return Status;
+//	}
+//	Status = irq_trigger_level_set(descPtr, SYSBUS_RX_INTR_ID, IRQ_EDGE_RISING);
+//	if (Status != SUCCESS)
+//	{
+//		DBG_ERROR("PHY_INTR trigger level set FAILED, ErrorCode: %ld.\n", Status);
+//		return Status;
+//	}
+//	// Set interrupt priority
+//	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);
+//		return Status;
+//	}
+//
+//	// Connect the interrupt service routine isr1 to the interrupt controller
+//	Status = irq_register_callback(descPtr, SYSBUS_RX_INTR_ID, &sysbus_rx_callback_desc);
+//	if (Status != SUCCESS)
+//	{
+//		DBG_ERROR("PHY_INTR register callback FAILED, ErrorCode: %ld.\n", Status);
+//		return Status;
+//	}
+//
+//	/* Initialize Scu timer interrupt. */
+//	// Connect the interrupt service routine isr1 to the interrupt controller
+//	Status = irq_register_callback(descPtr, SCUTIMER_INTR_ID, &scutm_callback_desc);
+//	if (Status != SUCCESS)
+//	{
+//		DBG_ERROR("PHY_INTR register callback FAILED, ErrorCode: %ld.\n", Status);
+//		return Status;
+//	}
+
+	// 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);
+
+	// Enable Exceptions
+	Status = irq_global_enable(descPtr);
+	if (Status != SUCCESS)
+	{
+		DBG_ERROR("IRQ global enable FAILED, ErrorCode: %ld.\n", Status);
+		return Status;
+	}
+	return SUCCESS;
+} // SetupInterruptSystem
+
+/****************************************************************************/
+/**
+ * This function is a interrupt service routine for IRQ_F2P[1:1], IRQ_F2P[1:1]
+ * tells CPU that the data in OCM is ready!
+ *
+ * @param    context
+ *
+ * @return   None.
+ *
+ *****************************************************************************/
+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);
+	if (Status != SUCCESS)
+	{
+		DBG_ERROR("Link layer runs failed, with error code: %ld\n", Status);
+		_nop_();
+	}
+} // PeriodicPull_Handler
+
+/*****************************************************************************/
+/**
+ * @brief   Handler of System Bus RX done interrupt.
+ *
+ * @param   context
+ *
+ * @return  None.
+ *
+ ******************************************************************************/
+void Systembus_RxIntrHandler(void *context)
+{
+	int32_t Status;
+	Status = SystemBus_RxIntrHandler(sysbusDescPtr);
+	if (Status != SUCCESS)
+	{
+		DBG_ERROR("SystemBus_RxIntrHandler exit with error code %ld,\n", Status);
+	}
+}
+
+/*****************************************************************************/
+/**
+ * @brief   Handler of System Bus TX done interrupt.
+ *
+ * @param   context
+ *
+ * @return  None.
+ *
+ ******************************************************************************/
+void Systembus_TxIntrHandler(void *context)
+{
+	int32_t Status;
+	Status = SystemBus_TxIntrHandler(sysbusDescPtr);
+	if (Status != SUCCESS)
+	{
+		DBG_ERROR("SystemBus_TxIntrHandler exit with error code %ld,\n", Status);
+	}
+}
+
+/*****************************************************************************/
+/**
+ * @brief   Handler of ScuTimer interrupt.
+ *
+ * @param   context
+ *
+ * @return  None.
+ *
+ ******************************************************************************/
+void ScuTimer_IntrHandler(void *context)
+{
+	struct xil_timer_desc *xdesc;
+	xdesc = (struct xil_timer_desc *)(logTmPtr->extra);
+	if (XScuTimer_IsExpired((XScuTimer *)xdesc->instance))
+	{
+		// Update log
+		Phy_UpdateHwSate(phyInstPtr);
+		XScuTimer_ClearInterruptStatus((XScuTimer *)xdesc->instance);
+	}
+	else
+	{
+		DBG_WARNING("UNEXPECTED CALL of ScuTimer_IntrHandler\n");
+	}
+}
+
+/*****************************************************************************/
+/**
+ * @brief	Main function, initialize all the device needed, initialize
+ * 			interrupt system, halt in while(1) wait for event interrupt.
+ *
+ * @param   None.
+ *
+ * @return
+ *
+ ******************************************************************************/
+int main(void)
+{
+	int Status;
+	DBG_PRINT("Application Version: %2d.%2d.%4d.\n", _APP_VER_MAIN, _APP_VER_MINOR, _APP_VER_PATCH);
+
+	/* System Monitor Initialize */
+	Status = SysMonitor_Init();
+	if (Status == SUCCESS)
+	{
+		DBG_PRINT("System monitor Init SUCCESS! \n");
+	}
+	else
+	{
+		DBG_PRINT("System monitor Init FAILED! \n");
+		return Status;
+	}
+
+	Status = HARDWARE_initialize();
+	if (Status == SUCCESS)
+	{
+		DBG_PRINT("Hardware Init SUCCESS! \n");
+	}
+	else
+	{
+		DBG_PRINT("Hardware Init FAILED! \n");
+		return Status;
+	}
+
+	// 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;
+		}
+
+		/* 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;
+		}
+
+//		/* 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;
+		}
+
+		/* 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);
+
+		DBG_PRINT("Physical started...\n");
+		Phy_Start(phyInstPtr);
+
+		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);
+				}
+			}
+		}
+} // main