汇编重写从站代码
This commit is contained in:
RuigeLee
@@ -35,15 +35,18 @@ volatile uint32_t *ReadIsLast = (uint32_t*) ( 0x408);
|
||||
|
||||
void main()
|
||||
{
|
||||
uint32_t readDat;
|
||||
uint32_t operator;
|
||||
uint32_t downRecvLen;
|
||||
uint32_t upRecvLen;
|
||||
register uint32_t readDat;
|
||||
register uint32_t operator;
|
||||
register uint32_t downRecvLen;
|
||||
register uint32_t upRecvLen;
|
||||
|
||||
|
||||
uint32_t slvNum;
|
||||
uint32_t totNum;
|
||||
|
||||
uint32_t isLast;
|
||||
register uint32_t isLast;
|
||||
register uint32_t flag;
|
||||
|
||||
|
||||
asm volatile (
|
||||
"li sp, 0\n"
|
||||
@@ -52,13 +55,19 @@ void main()
|
||||
|
||||
while(1){
|
||||
|
||||
*cdr_softReset = 1; //复位脉冲
|
||||
isLast = *ReadIsLast;
|
||||
*cdr_direct = 0;
|
||||
*WriteGpio = 0x01;
|
||||
register uint32_t flag;
|
||||
asm volatile(
|
||||
"sw x0, 0x10(x0)\n" //cdr_softReset 写入任意值进行复位//复位脉冲
|
||||
"lw %0, 0x408(x0)\n" //ReadIsLast 获取是否为最后一个从机
|
||||
"sw x0, 0xc(x0)\n" //设置CDR方向
|
||||
: "+r"(isLast)
|
||||
);
|
||||
|
||||
asm volatile (
|
||||
|
||||
|
||||
*WriteGpio = 0x01;
|
||||
|
||||
//等待接收开始中断
|
||||
asm volatile (
|
||||
"1:\n"
|
||||
"andi %0, sp, 0x04\n"
|
||||
"beqz %0, 1b\n"
|
||||
@@ -66,41 +75,55 @@ void main()
|
||||
: "+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 ){
|
||||
|
||||
|
||||
uint32_t localLen = 8;
|
||||
uint32_t downSendLen = downRecvLen - 8;
|
||||
|
||||
|
||||
//接收本地包
|
||||
for( uint32_t i = 0; i < 8/4; i++ ){
|
||||
for( uint32_t i = 0; i < 2; i++ ) {
|
||||
asm volatile (
|
||||
"andi %0, sp, 0x08\n"
|
||||
"1:\n"
|
||||
"bnez %0, 1b\n" //error
|
||||
: "+r"(flag)
|
||||
"lw %1, 0x1c(x0)\n" //read rxfifo
|
||||
: "+r"(flag), "+r"(readDat)
|
||||
);
|
||||
readDat = *cdr_rxFifo;
|
||||
}
|
||||
|
||||
|
||||
|
||||
*WriteGpio = 0x07;
|
||||
|
||||
register uint32_t downSendLen;
|
||||
|
||||
if(!isLast){
|
||||
// 下行转发新建包头
|
||||
*cdr_txLen = downRecvLen; //downSendLen + 8
|
||||
*cdr_txFifo = (downSendLen << 20) |( 0 << 16) | 0;
|
||||
*cdr_txFifo = 0;
|
||||
register uint32_t downSendHead;
|
||||
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 >> 2); i++ ){ //一次传4byte
|
||||
for( uint32_t i = 0; i < (downSendLen); i+=4 ){ //一次传4byte
|
||||
register uint32_t forData;
|
||||
asm volatile (
|
||||
"andi %0, sp, 0x08\n"
|
||||
@@ -108,9 +131,9 @@ void main()
|
||||
"bnez %0, 1b\n" //error 速度不够，不再检查接收
|
||||
"lw %1, 0x01c(x0)\n"
|
||||
"sw %1, 0x008(x0)\n"
|
||||
: "+r"(flag), "+r"(forData)
|
||||
);
|
||||
//*cdr_0_tx_txFifo = *cdr_0_rx_rxFifo; //接收即发送
|
||||
:
|
||||
"+r"(flag), "+r"(forData)
|
||||
);
|
||||
}
|
||||
} else{ //isLast
|
||||
|
||||
@@ -121,23 +144,27 @@ void main()
|
||||
"andi %0, sp, 0x08\n"
|
||||
"1:\n"
|
||||
"bnez %0, 1b\n" //error 速度不够，不再检查接收
|
||||
// "lui t0, %hi(0x40000000)\n"
|
||||
"lw %1, 0x01c(x0)\n"
|
||||
: "+r"(flag), "+r"(forData)
|
||||
|
||||
);
|
||||
}
|
||||
}
|
||||
|
||||
*WriteGpio = 0x0f;
|
||||
//CRC
|
||||
asm volatile (
|
||||
"andi %0, sp, 0x08\n"
|
||||
"1:\n"
|
||||
"bnez %0, 1b\n" //error
|
||||
:"+r"(flag)
|
||||
);
|
||||
uint32_t crc = *cdr_rxFifo; //CRC
|
||||
|
||||
//CRC
|
||||
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;
|
||||
|
||||
//等待接收完成标志
|
||||
asm volatile (
|
||||
@@ -147,7 +174,8 @@ void main()
|
||||
"andi sp, sp, 0xF7\n"
|
||||
: "+r"(flag)
|
||||
);
|
||||
*WriteGpio = 0x1f;
|
||||
|
||||
*WriteGpio = 0x3f;
|
||||
|
||||
if(!isLast){
|
||||
//等待发送完成标志
|
||||
@@ -160,21 +188,19 @@ void main()
|
||||
);
|
||||
}
|
||||
|
||||
*WriteGpio = 0x3f;
|
||||
*WriteGpio = 0x7f;
|
||||
|
||||
register uint32_t one = 1;
|
||||
register uint32_t txLen;
|
||||
register uint32_t txHeader;
|
||||
|
||||
asm volatile(
|
||||
"sw x0, 0x10(x0)\n" //cdr_softReset 写入任意值进行复位//复位脉冲
|
||||
"sw %0, 0xc(x0)\n" //设置CDR方向
|
||||
: "+r"(one)
|
||||
);
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
*cdr_softReset = 1; //复位脉冲
|
||||
*cdr_direct = 1; //方向转换
|
||||
|
||||
if(!isLast){
|
||||
//上行转发
|
||||
|
||||
@@ -187,43 +213,47 @@ void main()
|
||||
:"+r"(flag)
|
||||
);
|
||||
|
||||
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;
|
||||
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;
|
||||
);
|
||||
}
|
||||
|
||||
|
||||
|
||||
//接收第二个包
|
||||
// asm volatile (
|
||||
// "andi %0, sp, 0x08\n"
|
||||
// "1:\n"
|
||||
// "bnez %0, 1b\n" //error //速度不够，不校验
|
||||
// :"+r"(flag)
|
||||
// );
|
||||
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)
|
||||
|
||||
);
|
||||
|
||||
|
||||
uint32_t temp = *cdr_rxFifo;
|
||||
|
||||
//上行转发负载
|
||||
for( uint32_t i = 0; i < (upRecvLen >> 2); i ++ ){ //一次传4byte
|
||||
for( uint32_t i = 0; i < (upRecvLen); i += 4 ){ //一次传4byte
|
||||
register uint32_t forData;
|
||||
asm volatile (
|
||||
"andi %0, sp, 0x80\n"
|
||||
@@ -234,7 +264,6 @@ void main()
|
||||
:"+r"(flag), "+r"(forData)
|
||||
);
|
||||
|
||||
// *cdr_1_tx_txFifo = *cdr_1_rx_rxFifo; //接收即发送
|
||||
}
|
||||
|
||||
//CRC
|
||||
@@ -242,9 +271,10 @@ void main()
|
||||
"andi %0, sp, 0x08\n"
|
||||
"1:\n"
|
||||
"bnez %0, 1b\n" //error
|
||||
:"+r"(flag)
|
||||
"lw %0, 0x1c(x0)\n" //read rxfifo
|
||||
:"+r"(flag), "+r"(readDat)
|
||||
);
|
||||
crc = *cdr_rxFifo; //CRC
|
||||
|
||||
|
||||
//等待接收完成标志
|
||||
asm volatile (
|
||||
@@ -257,13 +287,27 @@ void main()
|
||||
|
||||
totNum = slvNum + (upRecvLen >> 3) - 1;
|
||||
} else { //islast
|
||||
|
||||
|
||||
|
||||
//发送上行包头
|
||||
*cdr_txLen = 16; //upSendLen + 8
|
||||
*cdr_txFifo = (8 << 20) |( 0 << 16) | 0;
|
||||
*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;
|
||||
);
|
||||
}
|
||||
|
||||
|
||||
|
||||
@@ -35,7 +35,12 @@ trap_entry:
|
||||
|
||||
or sp, sp, x4
|
||||
|
||||
andi x4, x4, 0x2
|
||||
beqz x4, 1f
|
||||
li x4, 0
|
||||
sw x3, 0x400(x0)
|
||||
|
||||
1:
|
||||
picorv32_retirq_insn()
|
||||
|
||||
|
||||
|
||||
Reference in New Issue
Block a user