Browse Source

refactor: Change motor start RCP glitch check

main
Mathias Rasmussen 4 years ago
parent
commit
f7b88684e2
  1. 8
      Bluejay.asm

8
Bluejay.asm

@ -3817,15 +3817,13 @@ wait_for_power_on_not_missing:
sjmp wait_for_power_on_not_missing ; Check DShot command again, in case it needs to be received multiple times sjmp wait_for_power_on_not_missing ; Check DShot command again, in case it needs to be received multiple times
wait_for_power_on_nonzero: wait_for_power_on_nonzero:
call wait100ms ; Wait to see if start pulse was only a glitch
mov DShot_Cmd, #0 ; Reset DShot command mov DShot_Cmd, #0 ; Reset DShot command
mov DShot_Cmd_Cnt, #0 mov DShot_Cmd_Cnt, #0
mov A, Rcp_Timeout_Cntd ; Load RC pulse timeout counter value
jnz init_start ; If it is not zero - proceed
call wait100ms ; Wait to see if start pulse was glitch
ljmp init_no_signal ; If it is zero (pulses missing) - go back to detect input signal
; If Rcp returned to stop - start over
jb Flag_Rcp_Stop, wait_for_power_on_loop
;**** **** **** **** **** **** **** **** **** **** **** **** **** ;**** **** **** **** **** **** **** **** **** **** **** **** ****

Loading…
Cancel
Save