软件改完,开始测试
This commit is contained in:
@@ -4,22 +4,26 @@
|
||||
// #include "gpio.h"
|
||||
// #include "timer.h"
|
||||
|
||||
volatile uint32_t *cdr_tx_status = (uint32_t*)( 0x40000000 + 0x0 ); //read
|
||||
volatile uint32_t *cdr_tx_txLen = (uint32_t*)( 0x40000000 + 0x4 ); //write
|
||||
volatile uint32_t *cdr_tx_txFifo = (uint32_t*)( 0x40000000 + 0x8 ); //write
|
||||
volatile uint32_t *cdr_TransDir = (uint32_t*)( 0x40000000 + 0xc ); //write
|
||||
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_rx_softReset = (uint32_t*)( 0x40000000 + 0x10 ); //write
|
||||
volatile uint32_t *cdr_rx_status = (uint32_t*)( 0x40000000 + 0x14 ); //read
|
||||
volatile uint32_t *cdr_rx_rxLen = (uint32_t*)( 0x40000000 + 0x18 ); //read
|
||||
volatile uint32_t *cdr_rx_rxFifo = (uint32_t*)( 0x40000000 + 0x1c ); //read
|
||||
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*) ( 0x60000000);
|
||||
volatile uint32_t *ReadGpio = (uint32_t*) ( 0x60000000);
|
||||
volatile uint32_t *ReadIsLast = (uint32_t*) ( 0x60000008);
|
||||
volatile uint32_t *WriteGpio = (uint32_t*) ( 0x800);
|
||||
volatile uint32_t *ReadGpio = (uint32_t*) ( 0x800);
|
||||
volatile uint32_t *ReadIsLast = (uint32_t*) ( 0x808);
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
static inline void error() {
|
||||
while(1);
|
||||
}
|
||||
@@ -41,7 +45,10 @@ void main()
|
||||
|
||||
while(1){
|
||||
|
||||
*cdr_softReset = 1; //复位脉冲
|
||||
isLast = *ReadIsLast;
|
||||
*cdr_direct = 0;
|
||||
|
||||
|
||||
asm volatile (
|
||||
"1:\n"
|
||||
@@ -50,11 +57,11 @@ void main()
|
||||
"andi sp, sp, 0xFB\n"
|
||||
);
|
||||
|
||||
readDat = *cdr_0_rx_rxFifo;
|
||||
readDat = *cdr_rxFifo;
|
||||
operator = (readDat >> 16) & 0xf;
|
||||
downRecvLen = readDat >> 20;
|
||||
|
||||
readDat = *cdr_0_rx_rxFifo;
|
||||
readDat = *cdr_rxFifo;
|
||||
|
||||
if( operator == 0 ){
|
||||
slvNum = 64 - ( downRecvLen >> 3 );
|
||||
@@ -69,45 +76,36 @@ void main()
|
||||
"1:\n"
|
||||
"bnez ra, 1b\n" //error
|
||||
);
|
||||
readDat = *cdr_0_rx_rxFifo;
|
||||
readDat = *cdr_rxFifo;
|
||||
}
|
||||
|
||||
if(!isLast){
|
||||
// 下行转发新建包头
|
||||
*cdr_0_tx_txLen = downRecvLen; //downSendLen + 8
|
||||
*cdr_0_tx_txFifo = (downSendLen << 20) |( 0 << 16) | 0;
|
||||
*cdr_0_tx_txFifo = 0;
|
||||
*cdr_txLen = downRecvLen; //downSendLen + 8
|
||||
*cdr_txFifo = (downSendLen << 20) |( 0 << 16) | 0;
|
||||
*cdr_txFifo = 0;
|
||||
|
||||
//下行转发负载
|
||||
asm volatile (
|
||||
"lui t0, %hi(0x40000000)\n"
|
||||
);
|
||||
//下行转发负载
|
||||
for( uint32_t i = 0; i < (downSendLen >> 2); i++ ){ //一次传4byte
|
||||
asm volatile (
|
||||
// "andi ra, sp, 0x08\n"
|
||||
// "1:\n"
|
||||
// "bnez ra, 1b\n" //error 速度不够,不再检查接收
|
||||
// "lui t0, %hi(0x40000000)\n"
|
||||
"lw t1, 0x1c(t0)\n"
|
||||
"sw t1, 0x08(t0)\n"
|
||||
|
||||
// : : : "a0", "a1"
|
||||
"andi ra, sp, 0x08\n"
|
||||
"1:\n"
|
||||
"bnez ra, 1b\n" //error 速度不够,不再检查接收
|
||||
"lw t1, 0x01c(x0)\n"
|
||||
"sw t1, 0x008(x0)\n"
|
||||
);
|
||||
//*cdr_0_tx_txFifo = *cdr_0_rx_rxFifo; //接收即发送
|
||||
}
|
||||
} else{ //isLast
|
||||
|
||||
//空转掉剩余负载
|
||||
asm volatile (
|
||||
"lui t0, %hi(0x40000000)\n"
|
||||
);
|
||||
for( uint32_t i = 0; i < (downSendLen >> 2); i++ ){ //一次传4byte
|
||||
asm volatile (
|
||||
// "andi ra, sp, 0x08\n"
|
||||
// "1:\n"
|
||||
// "bnez ra, 1b\n" //error 速度不够,不再检查接收
|
||||
"andi ra, sp, 0x08\n"
|
||||
"1:\n"
|
||||
"bnez ra, 1b\n" //error 速度不够,不再检查接收
|
||||
// "lui t0, %hi(0x40000000)\n"
|
||||
"lw t1, 0x1c(t0)\n"
|
||||
"lw t1, 0x01c(x0)\n"
|
||||
);
|
||||
}
|
||||
}
|
||||
@@ -117,7 +115,7 @@ void main()
|
||||
"1:\n"
|
||||
"bnez ra, 1b\n" //error
|
||||
);
|
||||
uint32_t crc = *cdr_0_rx_rxFifo; //CRC
|
||||
uint32_t crc = *cdr_rxFifo; //CRC
|
||||
|
||||
//等待接收完成标志
|
||||
asm volatile (
|
||||
@@ -128,50 +126,63 @@ void main()
|
||||
);
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
*cdr_direct = 1; //方向转换
|
||||
|
||||
if(!isLast){
|
||||
//上行转发
|
||||
|
||||
//接收第一个包
|
||||
asm volatile (
|
||||
"1:\n"
|
||||
"andi ra, sp, 0x40\n"
|
||||
"andi ra, sp, 0x04\n"
|
||||
"beqz ra, 1b\n"
|
||||
"andi sp, sp, 0xBF\n"
|
||||
"andi sp, sp, 0xFB\n"
|
||||
);
|
||||
|
||||
readDat = *cdr_1_rx_rxFifo;
|
||||
readDat = *cdr_rxFifo;
|
||||
operator = (readDat >> 16) & 0xf;
|
||||
upRecvLen = readDat >> 20;
|
||||
totNum = slvNum + (upRecvLen >> 3) - 1;
|
||||
|
||||
//接收第二个包
|
||||
asm volatile (
|
||||
"andi ra, sp, 0x80\n"
|
||||
"1:\n"
|
||||
"bnez ra, 1b\n" //error
|
||||
"andi ra, sp, 0x08\n"
|
||||
"1:\n"
|
||||
"bnez ra, 1b\n" //error
|
||||
);
|
||||
readDat = *cdr_1_rx_rxFifo;
|
||||
readDat = *cdr_rxFifo;
|
||||
|
||||
//发送上行包头
|
||||
*cdr_1_tx_txLen = upRecvLen + 16; //upSendLen + 8
|
||||
*cdr_1_tx_txFifo = ((upRecvLen + 8) << 20) |( 0 << 16) | 0;
|
||||
*cdr_1_tx_txFifo = 0;
|
||||
*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 ++ ){
|
||||
*cdr_1_tx_txFifo = 0;
|
||||
*cdr_txFifo = 0;
|
||||
}
|
||||
|
||||
//上行转发负载
|
||||
asm volatile (
|
||||
"lui t0, %hi(0x40000000)\n"
|
||||
);
|
||||
for( uint16_t i = 0; i < upRecvLen >> 2; i ++ ){ //一次传4byte
|
||||
asm volatile (
|
||||
// "andi ra, sp, 0x80\n"
|
||||
// "1:\n"
|
||||
// "bnez ra, 1b\n" //error 速度不够,不再检查接收
|
||||
"lw t1, 0x9c(t0)\n"
|
||||
"sw t1, 0x88(t0)\n"
|
||||
"andi ra, sp, 0x80\n"
|
||||
"1:\n"
|
||||
"bnez ra, 1b\n" //error 速度不够,不再检查接收
|
||||
"lw t1, 0x01c(x0)\n"
|
||||
"sw t1, 0x008(x0)\n"
|
||||
);
|
||||
|
||||
// *cdr_1_tx_txFifo = *cdr_1_rx_rxFifo; //接收即发送
|
||||
@@ -179,29 +190,29 @@ void main()
|
||||
|
||||
//CRC
|
||||
asm volatile (
|
||||
"andi ra, sp, 0x80\n"
|
||||
"andi ra, sp, 0x08\n"
|
||||
"1:\n"
|
||||
"bnez ra, 1b\n" //error
|
||||
);
|
||||
crc = *cdr_1_rx_rxFifo; //CRC
|
||||
crc = *cdr_rxFifo; //CRC
|
||||
|
||||
//等待接收完成标志
|
||||
asm volatile (
|
||||
"1:\n"
|
||||
"andi ra, sp, 0x80\n"
|
||||
"andi ra, sp, 0x08\n"
|
||||
"beqz ra, 1b\n"
|
||||
"andi sp, sp, 0x7F\n"
|
||||
"andi sp, sp, 0xF7\n"
|
||||
);
|
||||
|
||||
|
||||
} else { //islast
|
||||
//发送上行包头
|
||||
*cdr_1_tx_txLen = 16; //upSendLen + 8
|
||||
*cdr_1_tx_txFifo = (8 << 20) |( 0 << 16) | 0;
|
||||
*cdr_1_tx_txFifo = 0;
|
||||
*cdr_txLen = 16; //upSendLen + 8
|
||||
*cdr_txFifo = (8 << 20) |( 0 << 16) | 0;
|
||||
*cdr_txFifo = 0;
|
||||
|
||||
for( uint8_t i = 0; i < 8/4; i ++ ){
|
||||
*cdr_1_tx_txFifo = 0;
|
||||
*cdr_txFifo = 0;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user