From ec73e39dfe147b44d8aea863be6beae2d30b1782 Mon Sep 17 00:00:00 2001
From: Mathias Rasmussen <mathiasvr@gmail.com>
Date: Wed, 6 Jan 2021 17:01:21 +0100
Subject: [PATCH] fix: Wait for FC to initialize during startup

---
 Bluejay.asm | 4 +++-
 1 file changed, 3 insertions(+), 1 deletion(-)

diff --git a/Bluejay.asm b/Bluejay.asm
index db90f2d..d61e426 100644
--- a/Bluejay.asm
+++ b/Bluejay.asm
@@ -3225,7 +3225,7 @@ pgm_start:
 	mov	Beep_Strength, @Temp1		; Set beep strength
 	; Initializing beeps
 	clr	IE_EA					; Disable interrupts explicitly
-	call	wait200ms
+	call	wait100ms
 	call	beep_f1
 	call	wait10ms
 	call	beep_f2
@@ -3240,6 +3240,8 @@ pgm_start:
 
 	call	led_control				; Set LEDs to programmed values
 
+	call	wait200ms					; Wait for flight controller to get ready
+	call	wait200ms
 
 ;**** **** **** **** **** **** **** **** **** **** **** **** ****
 ;