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

寄存器保护

Browse Source
This commit is contained in:
RuigeLee
2024-11-05 17:48:34 +08:00
parent 85457b581d
commit 9e0d0a4177
3 changed files with 106 additions and 62 deletions
Download Patch File Download Diff File Expand all files Collapse all files

53
tb/sw/src/MstMain.c
View File

@@ -3,6 +3,8 @@
// #include "uart.h" // #include "uart.h"
// #include "gpio.h" // #include "gpio.h"
// #include "timer.h" // #include "timer.h"
#include "custom_ops.S"
volatile uint32_t *cdr_status = (uint32_t*)( 0x000 + 0x0 ); //read volatile uint32_t *cdr_status = (uint32_t*)( 0x000 + 0x0 ); //read
volatile uint32_t *cdr_txLen = (uint32_t*)( 0x000 + 0x4 ); //write volatile uint32_t *cdr_txLen = (uint32_t*)( 0x000 + 0x4 ); //write
@@ -46,18 +48,26 @@ void main()
uint32_t led = 0; uint32_t led = 0;
asm volatile (
"li sp, 0\n"
".4byte 0x600600b\n"
);
while(1){ while(1){
*cdr_softReset = 1; //复位脉冲 *cdr_softReset = 1; //复位脉冲
*cdr_direct = 0; *cdr_direct = 0;
register uint32_t flag;
asm volatile ( //timer 2s asm volatile ( //timer 2s
"1:\n" "1:\n"
"rdcycle ra\n" "rdcycle %0\n"
"srli ra, ra, 12\n" "srli %0, %0, 12\n"
// "srli ra, ra, 26\n" // "srli %0, %0, 26\n"
"andi ra, ra, 0x1\n" "andi %0, %0, 0x1\n"
"beqz ra, 1b\n" "beqz %0, 1b\n"
:"+r"(flag)
); );
if( led ){ if( led ){
@@ -82,9 +92,10 @@ void main()
//等待发送完成标志 //等待发送完成标志
asm volatile ( asm volatile (
"1:\n" "1:\n"
"andi ra, sp, 0x01\n" "andi %0, sp, 0x01\n"
"beqz ra, 1b\n" "beqz %0, 1b\n"
"andi sp, sp, 0xFE\n" "andi sp, sp, 0xFE\n"
:"+r"(flag)
); );
@@ -95,9 +106,10 @@ void main()
//接收第一个包 //接收第一个包
asm volatile ( asm volatile (
"1:\n" "1:\n"
"andi ra, sp, 0x04\n" "andi %0, sp, 0x04\n"
"beqz ra, 1b\n" "beqz %0, 1b\n"
"andi sp, sp, 0xFB\n" "andi sp, sp, 0xFB\n"
:"+r"(flag)
); );
readDat = *cdr_rxFifo; readDat = *cdr_rxFifo;
@@ -110,37 +122,42 @@ void main()
//接收第二个包 //接收第二个包
// asm volatile ( // asm volatile (
// "andi ra, sp, 0x08\n" // "andi %0, sp, 0x08\n"
// "1:\n" // "1:\n"
// "bnez ra, 1b\n" //error //速度不够，不校验 // "bnez %0, 1b\n" //error //速度不够，不校验
// :"+r"(flag),
// ); // );
uint32_t temp = *cdr_rxFifo; uint32_t temp = *cdr_rxFifo;
//上行转发负载 //上行转发负载
for( uint32_t i = 0; i < (upRecvLen >> 2); i ++ ){ //一次传4byte for( uint32_t i = 0; i < (upRecvLen >> 2); i ++ ){ //一次传4byte
register uint32_t upData;
asm volatile ( asm volatile (
"andi ra, sp, 0x80\n" "andi %0, sp, 0x80\n"
"1:\n" "1:\n"
"bnez ra, 1b\n" //error 速度不够，不再检查接收 "bnez %0, 1b\n" //error 速度不够，不再检查接收
"lw t1, 0x01c(x0)\n" "lw %1, 0x01c(x0)\n"
:"+r"(flag), "+r"(upData)
); );
} }
//CRC //CRC
asm volatile ( asm volatile (
"andi ra, sp, 0x08\n" "andi %0, sp, 0x08\n"
"1:\n" "1:\n"
"bnez ra, 1b\n" //error "bnez %0, 1b\n" //error
:"+r"(flag)
); );
uint32_t crc = *cdr_rxFifo; //CRC uint32_t crc = *cdr_rxFifo; //CRC
//等待接收完成标志 //等待接收完成标志
asm volatile ( asm volatile (
"1:\n" "1:\n"
"andi ra, sp, 0x08\n" "andi %0, sp, 0x08\n"
"beqz ra, 1b\n" "beqz %0, 1b\n"
"andi sp, sp, 0xF7\n" "andi sp, sp, 0xF7\n"
:"+r"(flag)
); );
totNum = (upRecvLen >> 3); totNum = (upRecvLen >> 3);

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

@@ -3,6 +3,8 @@
// #include "uart.h" // #include "uart.h"
// #include "gpio.h" // #include "gpio.h"
// #include "timer.h" // #include "timer.h"
#include "custom_ops.S"
volatile uint32_t *cdr_status = (uint32_t*)( 0x000 + 0x0 ); //read volatile uint32_t *cdr_status = (uint32_t*)( 0x000 + 0x0 ); //read
volatile uint32_t *cdr_txLen = (uint32_t*)( 0x000 + 0x4 ); //write volatile uint32_t *cdr_txLen = (uint32_t*)( 0x000 + 0x4 ); //write
@@ -24,9 +26,9 @@ volatile uint32_t *ReadIsLast = (uint32_t*) ( 0x408);
static inline void error() { // static inline void error() {
while(1); // while(1);
} // }
@@ -43,18 +45,25 @@ void main()
uint32_t isLast; uint32_t isLast;
asm volatile (
"li sp, 0\n"
".4byte 0x600600b\n"
);
while(1){ while(1){
*cdr_softReset = 1; //复位脉冲 *cdr_softReset = 1; //复位脉冲
isLast = *ReadIsLast; isLast = *ReadIsLast;
*cdr_direct = 0; *cdr_direct = 0;
*WriteGpio = 0xaaaa; *WriteGpio = 0x01;
register uint32_t flag;
asm volatile ( asm volatile (
"1:\n" "1:\n"
"andi ra, sp, 0x04\n" "andi %0, sp, 0x04\n"
"beqz ra, 1b\n" "beqz %0, 1b\n"
"andi sp, sp, 0xFB\n" "andi sp, sp, 0xFB\n"
: "+r"(flag)
); );
readDat = *cdr_rxFifo; readDat = *cdr_rxFifo;
@@ -63,6 +72,8 @@ void main()
readDat = *cdr_rxFifo; readDat = *cdr_rxFifo;
*WriteGpio = 0x03;
if( operator == 0 ){ if( operator == 0 ){
@@ -72,14 +83,15 @@ void main()
//接收本地包 //接收本地包
for( uint32_t i = 0; i < 8/4; i++ ){ for( uint32_t i = 0; i < 8/4; i++ ){
asm volatile ( asm volatile (
"andi ra, sp, 0x08\n" "andi %0, sp, 0x08\n"
"1:\n" "1:\n"
"bnez ra, 1b\n" //error "bnez %0, 1b\n" //error
: "+r"(flag)
); );
readDat = *cdr_rxFifo; readDat = *cdr_rxFifo;
} }
*WriteGpio = 0x07;
if(!isLast){ if(!isLast){
// 下行转发新建包头 // 下行转发新建包头
@@ -89,12 +101,14 @@ void main()
//下行转发负载 //下行转发负载
for( uint32_t i = 0; i < (downSendLen >> 2); i++ ){ //一次传4byte for( uint32_t i = 0; i < (downSendLen >> 2); i++ ){ //一次传4byte
register uint32_t forData;
asm volatile ( asm volatile (
"andi ra, sp, 0x08\n" "andi %0, sp, 0x08\n"
"1:\n" "1:\n"
"bnez ra, 1b\n" //error 速度不够，不再检查接收 "bnez %0, 1b\n" //error 速度不够，不再检查接收
"lw t2, 0x01c(x0)\n" "lw %1, 0x01c(x0)\n"
"sw t2, 0x008(x0)\n" "sw %1, 0x008(x0)\n"
: "+r"(flag), "+r"(forData)
); );
//*cdr_0_tx_txFifo = *cdr_0_rx_rxFifo; //接收即发送 //*cdr_0_tx_txFifo = *cdr_0_rx_rxFifo; //接收即发送
} }
@@ -102,43 +116,51 @@ void main()
//空转掉剩余负载 //空转掉剩余负载
for( uint32_t i = 0; i < (downSendLen >> 2); i++ ){ //一次传4byte for( uint32_t i = 0; i < (downSendLen >> 2); i++ ){ //一次传4byte
register uint32_t forData;
asm volatile ( asm volatile (
"andi ra, sp, 0x08\n" "andi %0, sp, 0x08\n"
"1:\n" "1:\n"
"bnez ra, 1b\n" //error 速度不够，不再检查接收 "bnez %0, 1b\n" //error 速度不够，不再检查接收
// "lui t0, %hi(0x40000000)\n" // "lui t0, %hi(0x40000000)\n"
"lw t2, 0x01c(x0)\n" "lw %1, 0x01c(x0)\n"
: "+r"(flag), "+r"(forData)
); );
} }
} }
*WriteGpio = 0x0f;
//CRC //CRC
asm volatile ( asm volatile (
"andi ra, sp, 0x08\n" "andi %0, sp, 0x08\n"
"1:\n" "1:\n"
"bnez ra, 1b\n" //error "bnez %0, 1b\n" //error
:"+r"(flag)
); );
uint32_t crc = *cdr_rxFifo; //CRC uint32_t crc = *cdr_rxFifo; //CRC
//等待接收完成标志 //等待接收完成标志
asm volatile ( asm volatile (
"1:\n" "1:\n"
"andi ra, sp, 0x08\n" "andi %0, sp, 0x08\n"
"beqz ra, 1b\n" "beqz %0, 1b\n"
"andi sp, sp, 0xF7\n" "andi sp, sp, 0xF7\n"
: "+r"(flag)
); );
*WriteGpio = 0x1f;
if(!isLast){ if(!isLast){
//等待发送完成标志 //等待发送完成标志
asm volatile ( asm volatile (
"1:\n" "1:\n"
"andi ra, sp, 0x01\n" "andi %0, sp, 0x01\n"
"beqz ra, 1b\n" "beqz %0, 1b\n"
"andi sp, sp, 0xFE\n" "andi sp, sp, 0xFE\n"
:"+r"(flag)
); );
} }
*WriteGpio = 0x3f;
@@ -159,9 +181,10 @@ void main()
//接收第一个包 //接收第一个包
asm volatile ( asm volatile (
"1:\n" "1:\n"
"andi ra, sp, 0x04\n" "andi %0, sp, 0x04\n"
"beqz ra, 1b\n" "beqz %0, 1b\n"
"andi sp, sp, 0xFB\n" "andi sp, sp, 0xFB\n"
:"+r"(flag)
); );
readDat = *cdr_rxFifo; readDat = *cdr_rxFifo;
@@ -191,21 +214,24 @@ void main()
//接收第二个包 //接收第二个包
// asm volatile ( // asm volatile (
// "andi ra, sp, 0x08\n" // "andi %0, sp, 0x08\n"
// "1:\n" // "1:\n"
// "bnez ra, 1b\n" //error //速度不够，不校验 // "bnez %0, 1b\n" //error //速度不够，不校验
// :"+r"(flag)
// ); // );
uint32_t temp = *cdr_rxFifo; uint32_t temp = *cdr_rxFifo;
//上行转发负载 //上行转发负载
for( uint32_t i = 0; i < (upRecvLen >> 2); i ++ ){ //一次传4byte for( uint32_t i = 0; i < (upRecvLen >> 2); i ++ ){ //一次传4byte
register uint32_t forData;
asm volatile ( asm volatile (
"andi ra, sp, 0x80\n" "andi %0, sp, 0x80\n"
"1:\n" "1:\n"
"bnez ra, 1b\n" //error 速度不够，不再检查接收 "bnez %0, 1b\n" //error 速度不够，不再检查接收
"lw t2, 0x01c(x0)\n" "lw %1, 0x01c(x0)\n"
"sw t2, 0x008(x0)\n" "sw %1, 0x008(x0)\n"
:"+r"(flag), "+r"(forData)
); );
// *cdr_1_tx_txFifo = *cdr_1_rx_rxFifo; //接收即发送 // *cdr_1_tx_txFifo = *cdr_1_rx_rxFifo; //接收即发送
@@ -213,18 +239,20 @@ void main()
//CRC //CRC
asm volatile ( asm volatile (
"andi ra, sp, 0x08\n" "andi %0, sp, 0x08\n"
"1:\n" "1:\n"
"bnez ra, 1b\n" //error "bnez %0, 1b\n" //error
:"+r"(flag)
); );
crc = *cdr_rxFifo; //CRC crc = *cdr_rxFifo; //CRC
//等待接收完成标志 //等待接收完成标志
asm volatile ( asm volatile (
"1:\n" "1:\n"
"andi ra, sp, 0x08\n" "andi %0, sp, 0x08\n"
"beqz ra, 1b\n" "beqz %0, 1b\n"
"andi sp, sp, 0xF7\n" "andi sp, sp, 0xF7\n"
:"+r"(flag)
); );
totNum = slvNum + (upRecvLen >> 3) - 1; totNum = slvNum + (upRecvLen >> 3) - 1;
@@ -244,20 +272,21 @@ void main()
//等待发送完成标志 //等待发送完成标志
asm volatile ( asm volatile (
"1:\n" "1:\n"
"andi ra, sp, 0x01\n" "andi %0, sp, 0x01\n"
"beqz ra, 1b\n" "beqz %0, 1b\n"
"andi sp, sp, 0xFE\n" "andi sp, sp, 0xFE\n"
:"+r"(flag)
); );
slvNum = 64 - ( downRecvLen >> 3 ); slvNum = 64 - ( downRecvLen >> 3 );
*WriteGpio = 1 << slvNum; *WriteGpio = 1 << slvNum;
} else if ( operator == 1 ){ } else if ( operator == 1 ){
error(); // error();
} else if ( operator == 2 ){ } else if ( operator == 2 ){
error(); // error();
} else { } else {
error(); // error();
} }
} }

4
tb/sw/src/mstStartup.S
View File

@@ -9,12 +9,10 @@
_prog_start: _prog_start:
li x15, 0
li sp, 0 li sp, 0
# picorv32_maskirq_insn(zero, zero) picorv32_maskirq_insn(zero, zero)
call main call main
li gp, 1;
ecall ecall