|
|
@ -67,7 +67,7 @@ C_ EQU 3 ; Ac Ap MC MB MA CC X RC X X X X Cc Cp Bc Bp |
|
|
|
D_ EQU 4 ; X X RC X CC MA MC MB X X Cc Cp Bc Bp Ac Ap Com fets inverted |
|
|
|
E_ EQU 5 ; L1 L0 RC X MC MB MA CC X L2 Cc Cp Bc Bp Ac Ap A with LEDs |
|
|
|
F_ EQU 6 ; X X RC X MA MB MC CC X X Cc Cp Bc Bp Ac Ap |
|
|
|
G_ EQU 7 ; X X RC X CC MA MC MB X X Cc Cp Bc Bp Ac Ap Like D, but noninverted com fets |
|
|
|
G_ EQU 7 ; X X RC X CC MA MC MB X X Cc Cp Bc Bp Ac Ap Like D, but non-inverted com fets |
|
|
|
H_ EQU 8 ; RC X X X MA MB CC MC X Ap Bp Cp X Ac Bc Cc |
|
|
|
I_ EQU 9 ; X X RC X MC MB MA CC X X Ac Bc Cc Ap Bp Cp |
|
|
|
J_ EQU 10 ; L2 L1 L0 RC CC MB MC MA X X Cc Bc Ac Cp Bp Ap LEDs |
|
|
@ -601,7 +601,7 @@ t1_int_outside_range: |
|
|
|
mov Dshot_Cmd, A ; Clear DShot command |
|
|
|
mov Dshot_Cmd_Cnt, A ; Clear DShot command count |
|
|
|
|
|
|
|
ajmp t1_int_exit_no_tlm ; Exit without reseting timeout |
|
|
|
ajmp t1_int_exit_no_tlm ; Exit without resetting timeout |
|
|
|
|
|
|
|
t1_int_exit_timeout: |
|
|
|
mov Rcp_Timeout_Cntd, #10 ; Set timeout count |
|
|
@ -1923,7 +1923,7 @@ calc_new_wait_per_demag_done: |
|
|
|
subb A, #0 |
|
|
|
mov Temp4, A |
|
|
|
jc load_min_time ; Check that result is still positive |
|
|
|
jnz calc_new_wait_times_exit ; Check that result is still above minumum |
|
|
|
jnz calc_new_wait_times_exit ; Check that result is still above minimum |
|
|
|
mov A, Temp3 |
|
|
|
jnz calc_new_wait_times_exit |
|
|
|
|
|
|
@ -1990,7 +1990,7 @@ calc_next_comm_timing_fast: |
|
|
|
subb A, Temp1 |
|
|
|
mov Temp3, A |
|
|
|
jc load_min_time_fast ; Check that result is still positive |
|
|
|
jnz calc_new_wait_times_fast_done ; Check that result is still above minumum |
|
|
|
jnz calc_new_wait_times_fast_done ; Check that result is still above minimum |
|
|
|
|
|
|
|
load_min_time_fast: |
|
|
|
mov Temp3, #1 |
|
|
@ -2427,7 +2427,7 @@ setup_comm_wait: |
|
|
|
; |
|
|
|
; Evaluate comparator integrity |
|
|
|
; |
|
|
|
; Checks comparator signal behaviour versus expected behaviour |
|
|
|
; Checks comparator signal behavior versus expected behavior |
|
|
|
; |
|
|
|
;**** **** **** **** **** **** **** **** **** **** **** **** **** |
|
|
|
evaluate_comparator_integrity: |
|
|
@ -3698,7 +3698,7 @@ normal_run_checks: |
|
|
|
jnb Flag_INITIAL_RUN_PHASE, initial_run_phase_done ; If not initial run phase - branch |
|
|
|
jb Flag_DIR_CHANGE_BRAKE, initial_run_phase_done ; If a direction change - branch |
|
|
|
|
|
|
|
; Decrement startup rotaton count |
|
|
|
; Decrement startup rotation count |
|
|
|
mov A, Initial_Run_Rot_Cntd |
|
|
|
dec A |
|
|
|
; Check number of initial rotations |
|
|
|