fix: Wait for FC to initialize during startup

mathiasvr · Jan 6, 2021 · ec73e39 · ec73e39
1 parent 944d3fd
commit ec73e39
Showing 1 changed file with 3 additions and 1 deletion.
diff --git 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
 
 ;**** **** **** **** **** **** **** **** **** **** **** **** ****
 ;