Code refactor

programs/project.prog

@@ -65,8 +65,8 @@ main:
 
     // (Re)set scrolling speed
     ldr r5, >scrolling_count_addr
-    ldr r7, >scrolling_cnt_value
-    st32 r5, r7
+    ldr r4, >scrolling_cnt_value
+    st32 r5, r4
 
     // --- CAN init ---
     ldr r0, >can_acceptance_code_addr
@@ -155,6 +155,8 @@ switches_interrupt_handler:
     nop
 
 can_tx_handler:
+    // Idee: lese hier die tx data register aus und calle die rx handler
+    // dafür mussen diese umgeschrieben werden um die werte nur über register auszuzlesen...
     reti
     nop
 
@@ -263,20 +265,20 @@ can_rx_data2_addr: .word 0x000F0118
 can_rx_handler:
     // Dispatch CAN frame
     ldr r0, >can_rx_data0_addr
-    ld08 r1, r0
-
-    ldr r2, >frame_data_add
-    cmp eq r2, r1
-    br true >can_handle_data_add_frame
-    nop
+    ld08 r6, r0
 
     ldr r2, >frame_data_clear
-    cmp eq r2, r1
+    cmp eq r2, r6
     br true >can_handle_data_clear_frame
     nop
 
+    ldr r2, >frame_data_add
+    cmp eq r2, r6
+    br true >can_handle_data_add_frame
+    nop
+
     ldr r2, >frame_frequency
-    cmp eq r2, r1
+    cmp eq r2, r6
     br true >can_handle_frequency_frame
     nop
 
@@ -284,38 +286,6 @@ can_rx_handler:
     reti
     nop
 
-.align
-scrolling_addr_ptr: .word =scrolling_addr
-write_mask_ptr: .word =write_mask
-
-can_handle_data_add_frame:
-    // Expect symbol to add in r10 register
-    ldr r0, >can_rx_data1_addr
-    ld08 r10, r0
-
-    // Release receive buffer
-    ldr r0, >can_command_addr_ptr
-    ld32 r0, r0
-    clr r1
-    addi r1, 0x04
-    st08 r0, r1
-
-    ldr r0, >scrolling_addr_ptr
-    ld32 r0, r0
-
-    ldr r1, >write_mask_ptr
-    ld32 r1, r1
-
-    lsh r10, r10, 16
-    or r4, r10, r1
-    st32 r0, r4
-
-    reti
-    nop
-
-.align
-clear_mask_ptr: .word =clear_mask
-
 can_handle_data_clear_frame:
     // Release receive buffer
     ldr r0, >can_command_addr_ptr
@@ -323,7 +293,7 @@ can_handle_data_clear_frame:
     clr r1
     addi r1, 0x04
     st08 r0, r1
-
+handle_data_clear_frame:
     ldr r0, >scrolling_addr_ptr
     ldr r1, >clear_mask_ptr
 
@@ -336,21 +306,12 @@ can_handle_data_clear_frame:
     nop
 
 .align
-scrolling_count_addr_ptr: .word =scrolling_count_addr
-
-can_handle_frequency_frame:
-    // For real board shift the count value by 16!
+scrolling_addr_ptr: .word =scrolling_addr
+write_mask_ptr: .word =write_mask
 
+can_handle_data_add_frame:
     ldr r0, >can_rx_data1_addr
-    ld08 r9, r0
-
-    ldr r0, >can_rx_data2_addr
-    ld08 r10, r0
-
-    // Concat bits
-    lsh r10, r10, 8
-    or r10, r10, r9
-    // lsh r10, r10, 16 // real board !!!
+    ld08 r7, r0
 
     // Release receive buffer
     ldr r0, >can_command_addr_ptr
@@ -358,22 +319,53 @@ can_handle_frequency_frame:
     clr r1
     addi r1, 0x04
     st08 r0, r1
+handle_data_add_frame:
+    // Expect symbol to add in r7 register
 
-    ldr r0, >scrolling_count_addr_ptr
+    ldr r0, >scrolling_addr_ptr
     ld32 r0, r0
 
-    st32 r0, r10
+    ldr r1, >write_mask_ptr
+    ld32 r1, r1
+
+    lsh r7, r7, 16
+    or r4, r7, r1
+    st32 r0, r4
 
     reti
     nop
 
-wait:
-	clr r7
-    clr r8
-    addi r8, 16
-inc_i:
-	cmp neq r7,r8
-	br true >inc_i
-	addi r7,1
-	ret
+.align
+clear_mask_ptr: .word =clear_mask
+scrolling_count_addr_ptr: .word =scrolling_count_addr
+
+can_handle_frequency_frame:
+    ldr r0, >can_rx_data1_addr
+    ld08 r7, r0
+
+    ldr r0, >can_rx_data2_addr
+    ld08 r8, r0
+
+    // Release receive buffer
+    ldr r0, >can_command_addr_ptr
+    ld32 r0, r0
+    clr r1
+    addi r1, 0x04
+    st08 r0, r1
+handle_frequency_frame:
+    // Expect count value in r7 and r8 register
+
+    // For real board shift the count value by 16!
+
+    // Concat bits
+    lsh r8, r8, 8
+    or r8, r8, r7
+    // lsh r8, r8, 16 // real board !!!
+
+    ldr r0, >scrolling_count_addr_ptr
+    ld32 r0, r0
+
+    st32 r0, r8
+
+    reti
     nop