1 files changed, 9 insertions, 5 deletions

diff --git a/example/apps/sorte/firmware/src/master/firm_main.asm b/example/apps/sorte/firmware/src/master/firm_main.asm
index 7793ef0..353f38f 100644
--- a/example/apps/sorte/firmware/src/master/firm_main.asm
+++ b/example/apps/sorte/firmware/src/master/firm_main.asm
@@ -135,12 +135,10 @@ firm_main:
 

 ; starting with idle state

 ; test if there is an active link on the port using mdio interface

-

-; test if there is an active link on the port using mdio interface

-    lbco    &TEMP_REG_2.b0, ICSS_SHARED_RAM_CONST, MDIO_PHY_CONFIG_OFFSET, 1

 IDLE_WAIT_FOR_LINK_ACTIVE:

+    lbco    &TEMP_REG_2.b0, ICSS_SHARED_RAM_CONST, MDIO_PHY_CONFIG_OFFSET, 1

     lbco    &TEMP_REG_1, ICSS_MDIO_CONST, ICSS_MDIO_LINK, 4

-    qbbc    IDLE_WAIT_FOR_LINK_ACTIVE, TEMP_REG_1.b0, TEMP_REG_2.b0

+    qbbc    IDLE_WAIT_FOR_LINK_ACTIVE, TEMP_REG_1, TEMP_REG_2.b0

 

 ; check if enabled, enabling done at startup of pru firmware.

        lbco    &TEMP_REG_1.b0, PRU0_DMEM_CONST, CTRL_REG_OFFSET , 1

@@ -461,11 +459,17 @@ STATE_PARAM_SEND:
 ; end packet with crc generated by PRU

     M_CMD16 D_PUSH_CRC_MSWORD_CMD | D_PUSH_CRC_LSWORD_CMD | D_TX_EOF

 

+    ldi        R2.w0, 0

+    ldi        R2.w2, 1000

 ; receive packet and check if all accepted

 STATE_PARAM_WAIT_BANK0:

+    add        R2.w0, R2.w0, 1

     xin        RXL2_BANK0, &R18, 1

+    qbeq    STATE_PARAM_WAIT, R2.w0, R2.w2

     qbgt    STATE_PARAM_WAIT_BANK0, r18.b0, 32

 

+   

+

     xin        RXL2_BANK0, &r2, 32+16

 

 ; received packet has PA?

@@ -488,6 +492,7 @@ STATE_PARAM_PA_CONT:
 ;    qba        STATE_DISCOVERY

 STATE_PARAM_RCV_OK:

 

+    sub        TEMP_REG_4.b0,TEMP_REG_4.b0,1

 ;  todo: read and verify rest of packet

 ;  wait for end of 1 ms period

 STATE_PARAM_WAIT:

@@ -495,7 +500,6 @@ STATE_PARAM_WAIT:
     lbbo     &PRU_CC_REG, r27, 0x0c , 4

     qblt    STATE_PARAM_WAIT, TEMP_REG_1, PRU_CC_REG

 

-    sub        TEMP_REG_4.b0,TEMP_REG_4.b0,1

     qbne    STATE_PARAM_ITERATION,TEMP_REG_4.b0, 0