From 907c4726b71ac5d5df377c1fb21b4eda90bc37ed Mon Sep 17 00:00:00 2001
From: Mathias Rasmussen <mathiasvr@gmail.com>
Date: Sat, 8 May 2021 17:20:15 +0200
Subject: [PATCH] feat: Improve arming safety check

Make sure RCP value has been for 300ms (10 times)
---
 Bluejay.asm | 6 ++++--
 1 file changed, 4 insertions(+), 2 deletions(-)

diff --git a/Bluejay.asm b/Bluejay.asm
index f74bca3..1225da3 100644
--- 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