ruige/eb001
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

合并bacon_dev分支的修改:1.协议基本运转;2.增加make debug_hlm

Browse Source
This commit is contained in:
bacon
2025-02-27 12:55:34 +08:00
parent b167d3affa
commit be7adef4aa
14 changed files with 1060 additions and 291 deletions
Download Patch File Download Diff File Expand all files Collapse all files

593
tb/sw/src/halfLvdsMacSvr.c
View File

@@ -5,6 +5,12 @@
#include "plic.h"
#include "clint.h"
#define DETECT_DEVICE_PKT_LEN 4
#define MAGIC_NUM 0xa53fd1a0U
#define DETECT_DEV_INTERVAL ((40)/CLINT_MTIME_TICK_PERIOD)
//-------------------------------------------------------------------
uint8_t MST_TX_BUF[TX_BUF_NUM * TX_BUF_MAX_LEN] __attribute__((aligned(32)));
uint8_t MST_RX_BUF[RX_BUF_NUM * RX_BUF_MAX_LEN] __attribute__((aligned(32)));
@@ -13,96 +19,202 @@ uint8_t MST_RX_BUF[RX_BUF_NUM * RX_BUF_MAX_LEN] __attribute__((aligned(32)));
//-------------------------------------------------------------------
extern const uint8_t int_svr_code[];
uint32_t (*sys_call)(uint32_t no, ...);
static uint32_t HLM_slave_poll(void);
volatile uint32_t exti_isr_flag[32] = {0};
uint32_t HLM_poll(uint32_t mode)
{
sys_call = (void *)int_svr_code;
//复位脉冲
*tx0_softReset = 1;
*tx1_softReset = 1;
*rx0_softReset = 1;
*rx1_softReset = 1;
//*tx0_softReset = 1;
i_tx0_softReset(1);
//*tx1_softReset = 1;
i_tx1_softReset(1);
//*rx0_softReset = 1;
i_rx0_softReset(1);
//*rx1_softReset = 1;
i_rx1_softReset(1);
if (mode == WORKMODE_MASTER)
{
uint32_t tx_pkt_len = 1024;
uint32_t rx_pkt_len = 0;
uint32_t rx_start = 0;
uint32_t status;
uint32_t is_exit = 0;
uint32_t seq = 0;
uint32_t i;
uint32_t *tx_data_ptr = (uint32_t *)MST_TX_BUF;
uint32_t *rx_data_ptr = (uint32_t *)MST_RX_BUF;
//准备数据
for (i = 0; i < tx_pkt_len; i++)
MST_TX_BUF[i] = i;
//开始发送工作
*tx0_txLen = tx_pkt_len + 4;
*tx0_txFifo = (tx_pkt_len << 20) | 0;
uint32_t tx_index = 0;
uint32_t rx_index = 0;
for (i = 0; i < HLM_TX_FIFO_LEN - 1; i++)
while (1)
{
if ((tx_index * 4) < tx_pkt_len)
uint32_t tx_pkt_len;
uint32_t rx_pkt_len = 0;
uint32_t rx_start = 0;
uint32_t status;
uint32_t is_exit = 0;
uint32_t intflag;
uint32_t is_tx_crc;
uint32_t is_rx_crc;
uint32_t recv_valid;
uint32_t i;
uint32_t *tx_data_ptr = (uint32_t *)MST_TX_BUF;
uint32_t *rx_data_ptr = (uint32_t *)MST_RX_BUF;
if (seq == 0)
{
*tx0_txFifo = tx_data_ptr[tx_index];
tx_index++;
is_tx_crc = 0;
is_rx_crc = 0;
tx_pkt_len = DETECT_DEVICE_PKT_LEN + 4;
tx_data_ptr[0] = (DETECT_DEVICE_PKT_LEN << 20) | 1;
tx_data_ptr[1] = MAGIC_NUM;
}
else if (seq == 1)
{
is_tx_crc = 1;
is_rx_crc = 1;
tx_pkt_len = 256 + 4;
tx_data_ptr[0] = ((tx_pkt_len - 4) << 20) | 2;
for (i = 4; i < (tx_pkt_len - 4 * is_tx_crc); i++)
MST_TX_BUF[i] = i;
}
else
break;
}
while (!is_exit)
{
status = *HLM_status;
for (i = 0; i < HLM_TX_FIFO_LEN - HLM_TX0_FIFO_LEFT(status); i++)
{
if ((tx_index * 4) < tx_pkt_len)
is_tx_crc = 1;
is_rx_crc = 1;
tx_pkt_len = 5 * 4 + 4;
//准备数据
tx_data_ptr[0] = ((tx_pkt_len - 4) << 20) | 2;
tx_data_ptr[1] = 0; //64bit time hi
tx_data_ptr[2] = 0; //64bit time lo
tx_data_ptr[3] = 0; //delta time
tx_data_ptr[4] = 0; //ctr | dev_num
//tx_data_ptr[5] = 0; //crc
}
//开始发送工作
i_tx0_txLen(tx_pkt_len);
uint32_t tx_index = 0;
uint32_t rx_index = 0;
uint32_t tx_len;
tx_len = is_tx_crc? (tx_pkt_len - 4):tx_pkt_len;
//i_tx0_clear_timer(0);
for (i = 0; i < HLM_TX_FIFO_LEN; i++)
{
if ((tx_index * 4) < tx_len)
{
*tx0_txFifo = tx_data_ptr[tx_index];
i_tx0_txFifo(tx_data_ptr[tx_index]);
tx_index++;
}
else
break;
}
for (i = 0; i < HLM_RX1_FIFO_LEFT(status); i++)
{
//if ((rx_start) && (status & HLM_RX1_VALID))
if (rx_start)
{
rx_data_ptr[rx_index] = *rx1_rxFifo;
if (rx_index == 0)
rx_pkt_len = (rx_data_ptr[rx_index] >> 20) + 4;
rx_index++;
if (rx_pkt_len <= (rx_index * 4))
if (is_tx_crc)
{
rx_start = 0;
rx_index = 0;
is_exit = 1;
break;
uint32_t crc;
i_tx0_txCrc(crc);
i_tx0_txFifo(crc);
tx_index++;
}
break;
}
}
if (exti_isr_flag[CDR_INT_RX1START])
while (!is_exit)
{
exti_isr_flag[CDR_INT_RX1START] = 0;
rx_start = 1;
rx_index = 0;
uint32_t tx_times;
//i_tx1_softReset(1);
i_hlm_status(status);
i_hlm_read_intflag(intflag);
i_hlm_clear_intflag(intflag);
tx_times = HLM_TX_FIFO_LEN - HLM_TX0_FIFO_LEFT(status);
for (i = 0; i < tx_times; i++)
{
if ((tx_index * 4) < tx_len)
{
i_tx0_txFifo(tx_data_ptr[tx_index]);
tx_index++;
}
else
{
if (is_tx_crc && ((tx_index * 4) == tx_len))
{
uint32_t crc;
i_tx0_txCrc(crc);
i_tx0_txFifo(crc);
tx_index++;
}
break;
}
}
for (i = 0; i < HLM_RX1_FIFO_LEFT(status); i++)
{
if (rx_start)
{
if ((rx_pkt_len - 4) == (rx_index * 4))
{
uint32_t crc;
i_rx1_rxCrc(crc);
i_rx1_rxFifo(rx_data_ptr[rx_index]);
if (is_rx_crc)
while (crc != rx_data_ptr[rx_index]);
}
else
{
i_rx1_rxFifo(rx_data_ptr[rx_index]);
}
if (rx_index == 0)
{
rx_pkt_len = (rx_data_ptr[rx_index] >> 20) + 4;
}
rx_index++;
if (rx_pkt_len < (rx_index * 4))
{
rx_start = 0;
rx_index = 0;
break;
}
}
}
//if ((rx_start == 0) && (status & HLM_RX1_VALID))
if (intflag & HLM_INT_RX1_START)
{
//exti_isr_flag[CDR_INT_RX1START] = 0;
rx_start = 1;
rx_index = 0;
}
if (intflag & HLM_INT_RX1_END)
{
is_exit = 1;
i_rx1_softReset(1);
i_tx0_softReset(1);
}
}
if (seq == 0)
{
if ((rx_pkt_len == 8) && ((rx_data_ptr[0] & 0xff) == 0x1) && (rx_data_ptr[1] == MAGIC_NUM))
{
seq = 1;
}
}
else if (seq == 1)
{
}
}
@@ -118,23 +230,19 @@ uint32_t HLM_poll(uint32_t mode)
return 0;
}
#define DETECT_DEVICE_PKT_LEN 4
#define DETECT_DEVICE_PKT_TX_LEN (DETECT_DEVICE_PKT_LEN + 4)
#define MAGIC_NUM 0xa53fd1a0U
#define DETECT_DEV_INTERVAL ((200)/CLINT_MTIME_TICK_PERIOD)
uint32_t HLM_slave_2streams_poll(uint32_t protocol, uint32_t data, uint32_t is_crc);
uint32_t HLM_slave_1stream_poll(uint32_t protocol, uint32_t data, uint32_t is_crc);
uint32_t HLM_slave_poll(void)
{
uint32_t rx_index = 0;
uint32_t tx_pkt_len;
uint32_t rx_pkt_len = 0;
uint32_t down_rx_work = 0;
uint32_t detect_work = 0;
uint32_t downstream_work = 0;
uint32_t hlm_status;
uint32_t is_terminal = 1;
uint32_t detect_result = 0;
uint32_t intflag;
uint32_t protocol = 0;
uint64_t stamp_time;
uint64_t cur_time;
@@ -144,17 +252,19 @@ uint32_t HLM_slave_poll(void)
int i;
*rx0_rxTxPair = 1;
*rx0_rxTimerAim = 0;// 280;
*rx1_rxTxPair = 0;
*rx1_rxTimerAim = 0;
//*rx0_rxTxPair = 1;
i_rx0_txPair(1);
i_rx0_limitTime(0);
i_rx1_txPair(0);
i_rx1_limitTime(0);
//*rx0_rxTimerAim = 0; //240;
//*rx1_rxTxPair = 0;
//*rx1_rxTimerAim = 0;
*plic_enable_0_31 = 0;
stamp_time = read_mtimer();
//set_mtimer(150);
//enable_mtimer_int();
stamp_time = 0; //read_mtimer();
#ifdef __riscv_e
sys_call(SYS_SLAVE_WORK);
@@ -164,88 +274,106 @@ uint32_t HLM_slave_poll(void)
{
if (is_terminal)
{//是终节点
hlm_status = *HLM_status;
if ((!down_rx_work) && (hlm_status & HLM_RX0_VALID))
{
down_rx_work = 1;
}
//status = *HLM_status;
i_hlm_status(hlm_status);
i_hlm_read_intflag(intflag);
for (i = 0; i < HLM_RX0_FIFO_LEFT(hlm_status); i++)
//i_hlm_clear_intflag(intflag);
//if ((!downstream_work) && (hlm_status & HLM_RX0_VALID))
// downstream_work = 1;
if (intflag & HLM_INT_RX0_START)
{
downstream_work = 1;
i_hlm_clear_intflag(HLM_INT_RX0_START);
}
if (downstream_work && (hlm_status & HLM_RX0_VALID))
{
uint32_t data;
if (down_rx_work)
{//处理上行接收
data = *rx0_rxFifo;
if (rx_index == 0)
{
rx_pkt_len = (data >> 20) + 4;
*tx1_txLen = rx_pkt_len;
//rx_pkt_len += 4; //最后是一个0,接收入队列，但不写入tx_fifo
}
rx_index++;
if (rx_pkt_len >= (rx_index * 4))
{
*tx1_txFifo = data;
}
else
{
down_rx_work = 0;
rx_index = 0;
//*rx0_softReset = 1;
break;
}
i_rx0_rxFifo(data);
protocol = (data & 0xff);
if ((protocol == 2) && (detect_result) && (detect_work == 0))
{
HLM_slave_2streams_poll(protocol, data, 0);
}
else
break;
{
HLM_slave_1stream_poll(protocol, data, 0);
}
}
if (down_rx_work == 0)
if (detect_work == 1)
{
if ((detect_work == 1))
{
detect_work = 2;
detect_work = 2;
*tx0_txLen = (DETECT_DEVICE_PKT_TX_LEN);
*tx0_txFifo = ((DETECT_DEVICE_PKT_LEN << 20) | 1);
*tx0_txFifo = detect_pkt;
}
//*tx0_txLen = DETECT_DEVICE_PKT_TX_LEN;
i_tx0_clear_timer(0);
if ((detect_work == 2) && (HLM_RX1_FIFO_LEFT(hlm_status) >= 2))
i_tx0_txLen(DETECT_DEVICE_PKT_LEN + 4);
//*tx0_txFifo = (DETECT_DEVICE_PKT_LEN << 20) | 1;
i_tx0_txFifo(((DETECT_DEVICE_PKT_LEN << 20) | 1));
//*tx0_txFifo = detect_pkt;
i_tx0_txFifo(detect_pkt);
}
if (detect_work == 2)
{
if (HLM_RX1_FIFO_LEFT(hlm_status) >= 2)
{
uint32_t data;
uint32_t num;
uint32_t dummy;
data = *rx1_rxFifo;
num = *rx1_rxFifo;
//data = *rx1_rxFifo;
i_rx1_rxFifo(data);
//num = *rx1_rxFifo;
i_rx1_rxFifo(num);
for (i = 0; i < HLM_RX1_FIFO_LEFT(hlm_status) - 2; i++)
dummy = *rx1_rxFifo;
{
//dummy = *rx1_rxFifo;
i_rx1_rxFifo(dummy);
}
*rx1_softReset = 1;
*tx0_softReset = 1;
//*rx1_softReset = 1;
i_rx1_softReset(1);
//*tx0_softReset = 1;
i_tx0_softReset(1);
if (((data & 0xff) == 0x1) && (num == MAGIC_NUM))
detect_result = 1;
else
detect_result = 0;
detect_work = 3;
detect_work = 0;
}
if (detect_work == 0)
else
{
cur_time = read_mtimer();
if ((cur_time - stamp_time) >= DETECT_DEV_INTERVAL)
uint32_t t;
i_tx0_read_timer(t);
if (t >= 600)
{
stamp_time = cur_time;
detect_work = 1;
i_rx1_softReset(1);
i_tx0_softReset(1);
detect_work = 0;
detect_result = 0;
}
}
if ((detect_work == 3))
{
detect_work = 0;
}
if ((detect_work == 0) && (downstream_work == 0))
{
cur_time = read_mtimer();
//i_tx0_read_timer(cur_time);
if ((cur_time - stamp_time) >= DETECT_DEV_INTERVAL)
{
stamp_time = cur_time;
detect_work = 1;
}
}
}
@@ -259,3 +387,194 @@ uint32_t HLM_slave_poll(void)
}
uint32_t HLM_slave_1stream_poll(uint32_t protocol, uint32_t data, uint32_t is_crc)
{
uint32_t hlm_status;
uint32_t intflag;
uint32_t i;
uint32_t downstream_work = 1;
uint32_t upstream_work = 0;
uint32_t d_rx_index = 0;
uint32_t d_rx_pkt_len;
uint32_t u_rx_index = 0;
uint32_t u_rx_pkt_len = 0;
d_rx_pkt_len = (data >> 20) + 4;
i_tx1_txLen(d_rx_pkt_len);
i_tx1_txFifo(data);
d_rx_index++;
while (1)
{
i_hlm_status(hlm_status);
i_hlm_read_intflag(intflag);
i_hlm_clear_intflag(intflag);
for (i = 0; i < HLM_RX0_FIFO_LEFT(hlm_status); i++)
{
uint32_t data;
if (downstream_work)
{//处理下行接收
i_rx0_rxFifo(data);
d_rx_index++;
if (d_rx_pkt_len > (d_rx_index * 4))
{
i_tx1_txFifo(data);
}
else if (d_rx_pkt_len == (d_rx_index * 4))
{
i_tx1_txFifo(data);
}
else
{
downstream_work = 0;
d_rx_index = 0;
break;
}
}
else
break;
}
if (intflag & HLM_INT_TX1_END)
{
i_rx0_softReset(1);
i_tx1_softReset(1);
break;
}
}
}
#define HLM_Slave_2streams_down_poll(ds_work, index, pkt_len, intflag, status) \
do {\
if (status & HLM_RX0_VALID)\
{\
uint32_t data;\
if (ds_work)\
{/*处理下行接收*/ \
i_rx0_rxFifo(data);\
index++;\
if (pkt_len > (index))\
{\
i_tx0_txFifo(data);\
}\
else if (pkt_len == (index))\
{\
i_tx0_txFifo(data);\
}\
else\
{\
ds_work = 0;\
index = 0;\
}\
}\
}\
} while (0)
#define HLM_Slave_2streams_up_poll(us_work, index, pkt_len, intflag, status) \
do {\
if (status & HLM_RX1_VALID)\
{\
uint32_t data;\
if (us_work)\
{/*处理上行接收*/\
i_rx1_rxFifo(data);\
if (index == 0)\
{\
pkt_len = (data >> 20) + 4;\
i_tx1_txLen(pkt_len);\
pkt_len = (pkt_len >> 2);\
}\
index++;\
if (pkt_len > (index))\
{\
i_tx1_txFifo(data);\
}\
else if (pkt_len == (index))\
{\
i_tx1_txFifo(data);\
}\
else\
{\
us_work = 0;\
index = 0;\
/*is_work = 0;*/\
}\
}\
}\
} while (0)
uint32_t HLM_slave_2streams_poll(uint32_t protocol, uint32_t data, uint32_t is_crc)
{
uint32_t hlm_status;
uint32_t intflag;
uint32_t i;
uint32_t downstream_work = 1;
uint32_t upstream_work = 0;
uint32_t d_rx_index = 0;
uint32_t d_rx_pkt_len = 0;
uint32_t u_rx_index = 0;
uint32_t u_rx_pkt_len = 0;
//uint32_t is_work = 1;
d_rx_pkt_len = (data >> 20) + 4;
i_tx0_txLen(d_rx_pkt_len);
i_tx0_txFifo(data);
d_rx_pkt_len = (d_rx_pkt_len >> 2);
d_rx_index++;
while (1)
{
i_hlm_status(hlm_status);
i_hlm_read_intflag(intflag);
i_hlm_clear_intflag(intflag);
HLM_Slave_2streams_down_poll(downstream_work,
d_rx_index,
d_rx_pkt_len,
intflag,
hlm_status);
if (intflag & HLM_INT_RX1_START)
{
upstream_work = 1;
intflag = 0;
do {
i_hlm_status(hlm_status);
//i_hlm_read_intflag(intflag);
//i_hlm_clear_intflag(intflag);
HLM_Slave_2streams_down_poll(downstream_work,
d_rx_index,
d_rx_pkt_len,
intflag,
hlm_status);
HLM_Slave_2streams_up_poll(upstream_work,
u_rx_index,
u_rx_pkt_len,
intflag,
hlm_status);
} while ((upstream_work) || (downstream_work));
}
if (intflag & HLM_INT_TX1_END)
{
i_tx0_softReset(1);
i_tx1_softReset(1);
i_rx0_softReset(1);
i_rx1_softReset(1);
break;
}
}
return 0;
}