NavigateToLocation: fixing returned success/failure

source/armarx/navigation/skills/NavigateToLocation.cpp

@@ -80,7 +80,10 @@ namespace armarx::navigation::skills
         if (se)
         {
             ARMARX_INFO << "Goal `" << location << "`reached.";
-        }
+            return ::armarx::skills::Skill::MainResult{
+                      .status = ::armarx::skills::TerminatedSkillStatus::Succeeded};
+
+	}
         else
         {
             if (se.isSafetyStopTriggeredEvent())
@@ -109,7 +112,7 @@ namespace armarx::navigation::skills
 
 
         return ::armarx::skills::Skill::MainResult{
-            .status = ::armarx::skills::TerminatedSkillStatus::Succeeded};
+            .status = ::armarx::skills::TerminatedSkillStatus::Failed};
     }