删除发送错误标志,主站软件改C代码
This commit is contained in:
132
tb/sw/src/MstMain.c
Normal file
132
tb/sw/src/MstMain.c
Normal file
@@ -0,0 +1,132 @@
|
||||
|
||||
#include <stdint.h>
|
||||
// #include "uart.h"
|
||||
// #include "gpio.h"
|
||||
// #include "timer.h"
|
||||
|
||||
volatile uint32_t *cdr_status = (uint32_t*)( 0x000 + 0x0 ); //read
|
||||
volatile uint32_t *cdr_txLen = (uint32_t*)( 0x000 + 0x4 ); //write
|
||||
volatile uint32_t *cdr_txFifo = (uint32_t*)( 0x000 + 0x8 ); //write
|
||||
volatile uint32_t *cdr_direct = (uint32_t*)( 0x000 + 0xc ); //write
|
||||
|
||||
volatile uint32_t *cdr_softReset = (uint32_t*)( 0x000 + 0x10 ); //write
|
||||
volatile uint32_t *cdr_rxLen = (uint32_t*)( 0x000 + 0x18 ); //read
|
||||
volatile uint32_t *cdr_rxFifo = (uint32_t*)( 0x000 + 0x1c ); //read
|
||||
|
||||
|
||||
volatile uint32_t *WriteGpio = (uint32_t*) ( 0x400);
|
||||
volatile uint32_t *ReadGpio = (uint32_t*) ( 0x400);
|
||||
volatile uint32_t *ReadIsLast = (uint32_t*) ( 0x408);
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
static inline void error() {
|
||||
while(1);
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
void main()
|
||||
{
|
||||
uint32_t readDat;
|
||||
uint32_t operator;
|
||||
uint32_t downRecvLen;
|
||||
uint32_t upRecvLen;
|
||||
|
||||
uint32_t slvNum;
|
||||
uint32_t totNum;
|
||||
|
||||
uint32_t isLast;
|
||||
|
||||
while(1){
|
||||
|
||||
*cdr_softReset = 1; //复位脉冲
|
||||
*cdr_direct = 0;
|
||||
|
||||
|
||||
|
||||
//发送下行包头
|
||||
*cdr_txLen = 520; //总长520
|
||||
*cdr_txFifo = (512 << 20) |( 0 << 16) | 0; //负载长度512,操作数0, 参数全0
|
||||
*cdr_txFifo = 0;
|
||||
|
||||
for( uint32_t i = 0; i < 512/4; i ++ ){
|
||||
*cdr_txFifo = i;
|
||||
}
|
||||
|
||||
|
||||
//等待发送完成标志
|
||||
asm volatile (
|
||||
"1:\n"
|
||||
"andi ra, sp, 0x01\n"
|
||||
"beqz ra, 1b\n"
|
||||
"andi sp, sp, 0xFE\n"
|
||||
);
|
||||
|
||||
|
||||
*cdr_softReset = 1; //复位脉冲
|
||||
*cdr_direct = 1; //方向切换上行
|
||||
|
||||
|
||||
//接收第一个包
|
||||
asm volatile (
|
||||
"1:\n"
|
||||
"andi ra, sp, 0x04\n"
|
||||
"beqz ra, 1b\n"
|
||||
"andi sp, sp, 0xFB\n"
|
||||
);
|
||||
|
||||
readDat = *cdr_rxFifo;
|
||||
|
||||
|
||||
|
||||
// operator = (readDat >> 16) & 0xf; //速度不够,不校验
|
||||
upRecvLen = readDat >> 20;
|
||||
|
||||
|
||||
//接收第二个包
|
||||
// asm volatile (
|
||||
// "andi ra, sp, 0x08\n"
|
||||
// "1:\n"
|
||||
// "bnez ra, 1b\n" //error //速度不够,不校验
|
||||
// );
|
||||
|
||||
uint32_t temp = *cdr_rxFifo;
|
||||
|
||||
//上行转发负载
|
||||
for( uint32_t i = 0; i < (upRecvLen >> 2); i ++ ){ //一次传4byte
|
||||
asm volatile (
|
||||
"andi ra, sp, 0x80\n"
|
||||
"1:\n"
|
||||
"bnez ra, 1b\n" //error 速度不够,不再检查接收
|
||||
"lw t1, 0x01c(x0)\n"
|
||||
);
|
||||
}
|
||||
|
||||
//CRC
|
||||
asm volatile (
|
||||
"andi ra, sp, 0x08\n"
|
||||
"1:\n"
|
||||
"bnez ra, 1b\n" //error
|
||||
);
|
||||
uint32_t crc = *cdr_rxFifo; //CRC
|
||||
|
||||
//等待接收完成标志
|
||||
asm volatile (
|
||||
"1:\n"
|
||||
"andi ra, sp, 0x08\n"
|
||||
"beqz ra, 1b\n"
|
||||
"andi sp, sp, 0xF7\n"
|
||||
);
|
||||
|
||||
totNum = (upRecvLen >> 3);
|
||||
|
||||
while(1);
|
||||
}
|
||||
}
|
||||
@@ -126,6 +126,15 @@ void main()
|
||||
);
|
||||
|
||||
|
||||
if(!isLast){
|
||||
//等待发送完成标志
|
||||
asm volatile (
|
||||
"1:\n"
|
||||
"andi ra, sp, 0x01\n"
|
||||
"beqz ra, 1b\n"
|
||||
"andi sp, sp, 0xFE\n"
|
||||
);
|
||||
}
|
||||
|
||||
|
||||
|
||||
@@ -152,31 +161,43 @@ void main()
|
||||
"beqz ra, 1b\n"
|
||||
"andi sp, sp, 0xFB\n"
|
||||
);
|
||||
|
||||
readDat = *cdr_rxFifo;
|
||||
operator = (readDat >> 16) & 0xf;
|
||||
upRecvLen = readDat >> 20;
|
||||
totNum = slvNum + (upRecvLen >> 3) - 1;
|
||||
|
||||
//接收第二个包
|
||||
asm volatile (
|
||||
"andi ra, sp, 0x08\n"
|
||||
"1:\n"
|
||||
"bnez ra, 1b\n" //error
|
||||
);
|
||||
|
||||
readDat = *cdr_rxFifo;
|
||||
|
||||
|
||||
|
||||
// operator = (readDat >> 16) & 0xf; //速度不够,不校验
|
||||
upRecvLen = readDat >> 20;
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
//发送上行包头
|
||||
*cdr_txLen = upRecvLen + 16; //upSendLen + 8
|
||||
*cdr_txFifo = ((upRecvLen + 8) << 20) |( 0 << 16) | 0;
|
||||
*cdr_txFifo = 0;
|
||||
|
||||
for( uint8_t i = 0; i < 8/4; i ++ ){
|
||||
for( uint32_t i = 0; i < 8/4; i ++ ){
|
||||
*cdr_txFifo = 0;
|
||||
}
|
||||
|
||||
|
||||
|
||||
//接收第二个包
|
||||
// asm volatile (
|
||||
// "andi ra, sp, 0x08\n"
|
||||
// "1:\n"
|
||||
// "bnez ra, 1b\n" //error //速度不够,不校验
|
||||
// );
|
||||
|
||||
uint32_t temp = *cdr_rxFifo;
|
||||
|
||||
//上行转发负载
|
||||
for( uint16_t i = 0; i < upRecvLen >> 2; i ++ ){ //一次传4byte
|
||||
for( uint32_t i = 0; i < (upRecvLen >> 2); i ++ ){ //一次传4byte
|
||||
asm volatile (
|
||||
"andi ra, sp, 0x80\n"
|
||||
"1:\n"
|
||||
@@ -204,19 +225,27 @@ void main()
|
||||
"andi sp, sp, 0xF7\n"
|
||||
);
|
||||
|
||||
|
||||
totNum = slvNum + (upRecvLen >> 3) - 1;
|
||||
} else { //islast
|
||||
//发送上行包头
|
||||
*cdr_txLen = 16; //upSendLen + 8
|
||||
*cdr_txFifo = (8 << 20) |( 0 << 16) | 0;
|
||||
*cdr_txFifo = 0;
|
||||
|
||||
for( uint8_t i = 0; i < 8/4; i ++ ){
|
||||
for( uint32_t i = 0; i < 8/4; i ++ ){
|
||||
*cdr_txFifo = 0;
|
||||
}
|
||||
|
||||
|
||||
}
|
||||
|
||||
|
||||
//等待发送完成标志
|
||||
asm volatile (
|
||||
"1:\n"
|
||||
"andi ra, sp, 0x01\n"
|
||||
"beqz ra, 1b\n"
|
||||
"andi sp, sp, 0xFE\n"
|
||||
);
|
||||
|
||||
|
||||
|
||||
|
||||
@@ -14,6 +14,8 @@
|
||||
|
||||
|
||||
main:
|
||||
sw x0, 0x010(x0) # 软复位,写入任意值,0也可以
|
||||
sw x0, 0x00c(x0) # 配置方向,下行
|
||||
|
||||
li x6, 520
|
||||
sw x6, 0x004(x0) #cdr_0_tx_txLen
|
||||
@@ -30,7 +32,20 @@ main:
|
||||
addi x6, x6, -1 # 递减计数器
|
||||
bnez x6, 1b # 如果计数器不为0,则继续循环
|
||||
|
||||
2:
|
||||
|
||||
2:
|
||||
andi ra, sp, 0x01 # 等待发送完成标志位
|
||||
beqz ra, 2b
|
||||
andi sp, sp, 0xFE
|
||||
|
||||
sw x0, 0x010(x0) # 软复位,写入任意值,0也可以
|
||||
li x6, 1
|
||||
sw x6, 0x00c(x0) # 配置方向,上行
|
||||
|
||||
|
||||
|
||||
|
||||
3:
|
||||
j 2b
|
||||
|
||||
|
||||
|
||||
@@ -47,7 +47,8 @@ trap_entry:
|
||||
# q寄存器已经禁用, Without the q-registers, the irq return address will be stored in x3 (gp) and the IRQ bitmask in x4 (tp),
|
||||
|
||||
# addi x15, x4, 0
|
||||
|
||||
or sp, sp, x4
|
||||
|
||||
picorv32_retirq_insn()
|
||||
|
||||
|
||||
|
||||
Reference in New Issue
Block a user