From 00e018506dacf2a3236e057cbfb72542a0137e79 Mon Sep 17 00:00:00 2001
From: "Konstantin Sharlaimov (DigitalEntity)"
 <konstantin.sharlaimov@gmail.com>
Date: Tue, 4 Jun 2019 20:09:05 +0200
Subject: [PATCH] [RTH] Fix incorrect RTH_MAX_ALT

---
 src/main/navigation/navigation.c | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/src/main/navigation/navigation.c b/src/main/navigation/navigation.c
index e0e028a29f..53efc0b7ac 100755
--- a/src/main/navigation/navigation.c
+++ b/src/main/navigation/navigation.c
@@ -2089,7 +2089,7 @@ static void updateDesiredRTHAltitude(void)
                     break;
 
                 case NAV_RTH_MAX_ALT:
-                    posControl.rthState.rthInitialAltitude = MAX(posControl.rthState.homePosition.pos.z, posControl.actualState.abs.pos.z);
+                    posControl.rthState.rthInitialAltitude = MAX(posControl.rthState.rthInitialAltitude, posControl.actualState.abs.pos.z);
                     posControl.rthState.rthFinalAltitude = posControl.rthState.rthInitialAltitude;
                     break;