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

增加了一个c语言查询版本的代码，便于沟通调试；如果编译C语言版本,Makefile中控制系统都采用rv32i的march编译即可。

Browse Source
This commit is contained in:
bacon
2025-02-10 14:38:49 +08:00
parent 94acbfae03
commit 4d853a29d7
9 changed files with 539 additions and 592 deletions
Download Patch File Download Diff File Expand all files Collapse all files

449
tb/sw/src/SlvMain.c
View File

@@ -4,7 +4,12 @@
// #include "timer.h"
#include "tl2cdr.h"
#include "system_cfg.h"
#include "halfLvdsMacSvr.h"
#include "sysDef.h"
#ifdef __riscv_i
#define USING_POLL_STRATEGY
#endif
volatile uint32_t *const plic_priority = (uint32_t *)(0xc000000U);
@@ -13,23 +18,48 @@ volatile uint32_t *plic_enable_0_31 = (uint32_t*)( 0xc000000U + 0X002000 );
volatile uint32_t *plic_threshold_0 = (uint32_t*)( 0xc000000U + 0X200000 );
volatile uint32_t *plic_claim = (uint32_t*)( 0xc000000U + 0X200004 );
static inline void error() {
static void error();
static uint32_t init_plic(void);
void main()
{
init_plic();
//复位脉冲
*tx0_softReset = 1;
*tx1_softReset = 1;
*rx0_softReset = 1;
*rx1_softReset = 1;
//tx0 下行
//tx1 上行
//rx0 下行
//rx1 上行
#ifdef USING_POLL_STRATEGY
//使用查询策略 POLL_STRATEGY 操作 half lvds mac
HLM_poll(WORKMODE_SLAVE);
#else
//使用中断策略操作half lvds mac
HLM_work_with_isr(WORKMODE_SLAVE);
#endif
while (1);
}
void error() {
while(1);
}
extern const uint8_t int_svr_code[];
uint32_t (*sys_call)(uint32_t no, ...);
void main()
uint32_t init_plic(void)
{
int i;
/*初始化plic*/
*plic_enable_0_31 = 1 << CDR_INT_TX0END
| 1 << CDR_INT_TX1END
@@ -62,406 +92,11 @@ void main()
plic_priority[CDR_INT_TX1_FIFO_DEQ] = 1;
plic_priority[CDR_INT_RX0_FIFO_ENQ] = 1;
plic_priority[CDR_INT_RX1_FIFO_ENQ] = 1;
*plic_threshold_0 = 0;
sys_call = (void *)int_svr_code;
//复位脉冲
*tx0_softReset = 1;
*tx1_softReset = 1;
*rx0_softReset = 1;
*rx1_softReset = 1;
//tx0 下行
//tx1 上行
//rx0 下行
//rx1 上行
while (1);
#if 0
register uint32_t readDat;
register uint32_t operator;
register uint32_t downRecvLen;
register uint32_t upRecvLen;
register uint32_t crc;
uint8_t localData[512];
uint32_t slvNum;
uint32_t totNum;
register uint32_t isLast;
register uint32_t flag;
*plic_enable_0_31 = 1 << CDR_INT_TXEND | 1 << CDR_INT_RXERROR | 1 << CDR_INT_RXSTART | 1 << CDR_INT_RXEND;
*plic_priority_TxEnd = 1;
*plic_priority_RxError = 1;
*plic_priority_RxStart = 1;
*plic_priority_RxEnd = 1;
*plic_threshold_0 = 0;
while(1){
*cdr_softReset = 1; //复位脉冲
*cdr_direct = 0;
isLast = *cdr_IsLast;
// asm volatile(
// "sw x0, 0x10(x0)\n" //cdr_softReset 写入任意值进行复位//复位脉冲
// "lw %0, 0x408(x0)\n" //ReadIsLast 获取是否为最后一个从机
// "sw x0, 0xc(x0)\n" //设置CDR方向
// : "+r"(isLast)
// );
// *WriteGpio = 0x01;
//等待接收开始中断
while(!flag_intRxStart);
// asm volatile (
// "1:\n"
// "andi %0, sp, 0x04\n"
// "beqz %0, 1b\n"
// "andi sp, sp, 0xFB\n"
// : "+r"(flag)
// );
readDat = *cdr_rxFifo;
operator = (readDat >> 16) & 0xf;
downRecvLen = readDat >> 20;
readDat = *cdr_rxFifo;
// asm volatile (
// "lw %0, 0x1c(x0)\n" //read rxfifo
// "srli %1, %0, 16\n" // operator = readDat >> 16
// "srli %2, %1, 4\n" // downRecvLen = operator >> 4
// "andi %1, %1,0xf\n" // operator = operator & 0xf
// "lw %0, 0x1c(x0)\n" //read rxfifo
// : "+r"(readDat), "+r"(operator), "+r"(downRecvLen)
// );
// *WriteGpio = 0x03;
if( operator == 0 ){
//接收本地包
for( uint32_t i = 0; i < 2; i++ ) {
if( flag_intRxError ){
while(1);
}
*(localData+i) = *cdr_rxFifo;
// asm volatile (
// "andi %0, sp, 0x08\n"
// "1:\n"
// "bnez %0, 1b\n" //error
// "lw %1, 0x1c(x0)\n" //read rxfifo
// : "+r"(flag), "+r"(readDat)
// );
}
// *WriteGpio = 0x07;
register uint32_t downSendLen;
downSendLen = downRecvLen - 8;
if(!isLast){
// 下行转发新建包头
register uint32_t downSendHead;
*cdr_txLen = downRecvLen;
downSendHead = (downSendLen << 20) | ( 0 << 16) | 0;
*cdr_txFifo = downSendHead;
*cdr_txFifo = 0;
// asm volatile (
// "sw %0, 0x4(x0)\n" // *cdr_txLen = downRecvLen
// "addi %2, %0, -8\n" //downSendLen = downRecvLen - 8;
// "slli %1, %2, 20\n" // downSendHead = (downSendLen << 20) |( 0 << 16) | 0;
// "sw %1, 0x8(x0)\n" //*cdr_txFifo = downSendHead
// "sw x0, 0x8(x0)\n" //*cdr_txFifo = 0
// : "+r"(downRecvLen), "+r"(downSendHead), "+r"(downSendLen)
// );
//下行转发负载
for( uint32_t i = 0; i < (downSendLen); i+=4 ){ //一次传4byte
register uint32_t forData;
if( flag_intRxError){
while(1);
}
*cdr_txFifo = *cdr_rxFifo;
// asm volatile (
// "andi %0, sp, 0x08\n"
// "1:\n"
// "bnez %0, 1b\n" //error 速度不够，不再检查接收
// "lw %1, 0x01c(x0)\n"
// "sw %1, 0x008(x0)\n"
// :
// "+r"(flag), "+r"(forData)
// );
}
} else{ //isLast
//空转掉剩余负载
for( uint32_t i = 0; i < (downSendLen >> 2); i++ ){ //一次传4byte
register uint32_t forData;
if( flag_intRxError ){
while(1);
}
readDat = *cdr_rxFifo;
// asm volatile (
// "andi %0, sp, 0x08\n"
// "1:\n"
// "bnez %0, 1b\n" //error 速度不够，不再检查接收
// "lw %1, 0x01c(x0)\n"
// : "+r"(flag), "+r"(forData)
// );
}
}
// *WriteGpio = 0x0f;
//CRC
if( flag_intRxError ){
while(1);
}
crc = *cdr_rxFifo;
// asm volatile (
// "andi %0, sp, 0x08\n"
// "1:\n"
// "bnez %0, 1b\n" //error
// "lw %1, 0x1c(x0)\n" //read rxfifo
// : "+r"(flag), "+r"(readDat)
// );
// *WriteGpio = 0x1f;
//等待接收完成标志
while(!flag_intRxEnd);
flag_intRxEnd = 0;
// asm volatile (
// "1:\n"
// "andi %0, sp, 0x08\n"
// "beqz %0, 1b\n"
// "andi sp, sp, 0xF7\n"
// : "+r"(flag)
// );
// *WriteGpio = 0x3f;
if(!isLast){
//等待发送完成标志
while(!flag_intTxEnd);
flag_intTxEnd = 0;
// asm volatile (
// "1:\n"
// "andi %0, sp, 0x01\n"
// "beqz %0, 1b\n"
// "andi sp, sp, 0xFE\n"
// :"+r"(flag)
// );
}
// *WriteGpio = 0x7f;
register uint32_t one = 1;
register uint32_t txLen;
register uint32_t txHeader;
*cdr_softReset = 1;
*cdr_direct = 1;
// asm volatile(
// "sw x0, 0x10(x0)\n" //cdr_softReset 写入任意值进行复位//复位脉冲
// "sw %0, 0xc(x0)\n" //设置CDR方向
// : "+r"(one)
// );
if(!isLast){
//上行转发
//接收第一个包
while(!flag_intRxStart);
flag_intRxStart = 0;
// asm volatile (
// "1:\n"
// "andi %0, sp, 0x04\n"
// "beqz %0, 1b\n"
// "andi sp, sp, 0xFB\n"
// :"+r"(flag)
// );
//接收第一个包
if(flag_intRxError){while(1);}
readDat = *cdr_rxFifo;
upRecvLen = readDat >> 20;
txLen = upRecvLen + 16;
txHeader = upRecvLen + 8;
txHeader = (txHeader << 20) | ( 0 << 16) | 0;
//发送上行包头
*cdr_txLen = txLen;
*cdr_txFifo = txHeader;
*cdr_txFifo = 0;
// asm volatile (
// "lw %0, 0x1c(x0)\n" //read rxfifo
// "srli %1, %0, 20\n" // upRecvLen = readDat >> 20
// "addi %2, %1, 16\n" //txLen = upRecvLen + 16
// "addi %3, %1, 8\n" //txHeader = upRecvLen + 8
// "slli %3, %3, 20\n" //txHeader = txHeader << 20 |( 0 << 16) | 0
// "sw %2, 0x4(x0)\n" //*cdr_txLen = txLen
// "sw %3, 0x8(x0)\n" //*cdr_txFifo = txHeader
// "sw x0, 0x8(x0)\n" //*cdr_txFifo = 0
// : "+r"(readDat), "+r"(upRecvLen), "+r"( txLen ), "+r"( txHeader )
// );
for( uint32_t i = 0; i < 8/4; i ++ ){
*cdr_txFifo = 0;
// asm volatile (
// "sw x0, 0x8(x0)\n" //*cdr_txFifo = 0;
// );
}
//接收第二个包
if(flag_intRxError){while(1);}
readDat = *cdr_rxFifo;
// asm volatile (
// "andi %0, sp, 0x08\n"
// "1:\n"
// "bnez %0, 1b\n" //error //速度不够，不校验
// "lw %1, 0x1c(x0)\n" //read rxfifo
// :"+r"(flag), "+r"(readDat)
// );
//上行转发负载
for( uint32_t i = 0; i < (upRecvLen); i += 4 ){ //一次传4byte
register uint32_t forData;
if( flag_intRxError ){
while(1);
}
*cdr_txFifo = *cdr_rxFifo;
// asm volatile (
// "andi %0, sp, 0x80\n"
// "1:\n"
// "bnez %0, 1b\n" //error 速度不够，不再检查接收
// "lw %1, 0x01c(x0)\n"
// "sw %1, 0x008(x0)\n"
// :"+r"(flag), "+r"(forData)
// );
}
//CRC
if( flag_intRxError ){
while(1);
}
crc = *cdr_rxFifo;
// asm volatile (
// "andi %0, sp, 0x08\n"
// "1:\n"
// "bnez %0, 1b\n" //error
// "lw %0, 0x1c(x0)\n" //read rxfifo
// :"+r"(flag), "+r"(readDat)
// );
//等待接收完成标志
while(!flag_intRxEnd);
flag_intRxEnd = 0;
// asm volatile (
// "1:\n"
// "andi %0, sp, 0x08\n"
// "beqz %0, 1b\n"
// "andi sp, sp, 0xF7\n"
// :"+r"(flag)
// );
totNum = slvNum + (upRecvLen >> 3) - 1;
} else { //islast
//发送上行包头
txLen = upRecvLen + 16;
txHeader = ( 8 << 20 ) | ( 0 << 16) | 0;
*cdr_txLen = txLen;
*cdr_txFifo = txHeader;
*cdr_txFifo = 0;
// asm volatile (
// "li %0, 16\n" //txLen = upRecvLen + 16
// "sw %0, 0x4(x0)\n" //*cdr_txLen = txLen
// "lui %1, 0x800\n" //txHeader = 8 << 20 |( 0 << 16) | 0
// "sw %1, 0x8(x0)\n" //*cdr_txFifo = txHeader
// "sw x0, 0x8(x0)\n" //*cdr_txFifo = 0
// : "+r"( txLen ), "+r"( txHeader )
// );
for( uint32_t i = 0; i < 8/4; i ++ ){
*cdr_txFifo = 0;
// asm volatile (
// "sw x0, 0x8(x0)\n" //*cdr_txFifo = 0;
// );
}
}
//等待发送完成标志
while(!flag_intTxEnd);
flag_intTxEnd = 0;
// asm volatile (
// "1:\n"
// "andi %0, sp, 0x01\n"
// "beqz %0, 1b\n"
// "andi sp, sp, 0xFE\n"
// :"+r"(flag)
// );
slvNum = 64 - ( downRecvLen >> 3 );
// *WriteGpio = 1 << slvNum;
} else if ( operator == 1 ){
// error();
} else if ( operator == 2 ){
// error();
} else {
// error();
}
}
#endif
return 0;
}