integration_tests: add debug for altitude

This is to debug the PX4 v1.11 SITL test failing often.
mavlink · Sep 24, 2020 · 960bbab · 960bbab
1 parent 894c297
commit 960bbab
Showing 1 changed file with 4 additions and 0 deletions.
diff --git a/src/integration_tests/action_hover_sync.cpp b/src/integration_tests/action_hover_sync.cpp
@@ -52,6 +52,10 @@ void takeoff_and_hover_at_altitude(float altitude_m)
     EXPECT_EQ(takeoff_altitude_result.first, Action::Result::Success);
     EXPECT_FLOAT_EQ(takeoff_altitude_result.second, altitude_m);
 
+    telemetry->subscribe_position([](Telemetry::Position position) {
+            LogDebug() << "altitude: " << position.relative_altitude_m << " m";
+    });
+
     Action::Result action_ret = action->arm();
     EXPECT_EQ(action_ret, Action::Result::Success);