feat: Improve arming safety check

Make sure RCP value has been for 300ms (10 times)
mathiasvr · Jun 11, 2021 · 907c472 · 907c472
1 parent 95e7087
commit 907c472
Showing 1 changed file with 4 additions and 2 deletions.
diff --git a/Bluejay.asm b/Bluejay.asm
@@ -3785,8 +3785,10 @@ arming_begin:
 	setb	IE_EA
 
 arming_wait:
-	call	wait100ms
-	jnb	Flag_Rcp_Stop, arming_wait	; Wait for rcp stop (zero throttle)
+	clr	C
+	mov	A, Rcp_Stop_Cnt
+	subb	A, #10
+	jc	arming_wait				; Wait until rcp has been zero for ~300ms
 
 	clr	IE_EA
 	call	beep_f2_short				; Beep signal that ESC is armed