mavsdk_tests: check for baro failure in mission

test/mavsdk_tests/autopilot_tester.cpp

@@ -273,9 +273,6 @@ void AutopilotTester::execute_mission_and_lose_gps()
 {
 	CHECK(_param->set_param_int("SYS_FAILURE_EN", 1) == Param::Result::Success);
 
-	std::promise<void> prom;
-	auto fut = prom.get_future();
-
 	_mission->subscribe_mission_progress([this](Mission::MissionProgress progress) {
 		std::cout << "Progress: " << progress.current << "/" << progress.total;
 
@@ -285,10 +282,13 @@ void AutopilotTester::execute_mission_and_lose_gps()
 		}
 	});
 
+	std::promise<void> prom;
+	auto fut = prom.get_future();
 	_mission->start_mission_async([&prom](Mission::Result result) {
 		REQUIRE(Mission::Result::Success == result);
 		prom.set_value();
 	});
+	REQUIRE(fut.wait_for(std::chrono::seconds(1)) == std::future_status::ready);
 
 	// We expect that a blind land is performed.
 	REQUIRE(poll_condition_with_timeout(
@@ -296,17 +296,12 @@ void AutopilotTester::execute_mission_and_lose_gps()
 		auto flight_mode = _telemetry->flight_mode();
 		return flight_mode == Telemetry::FlightMode::Land;
 	}, std::chrono::seconds(60)));
-
-	REQUIRE(fut.wait_for(std::chrono::seconds(1)) == std::future_status::ready);
 }
 
 void AutopilotTester::execute_mission_and_lose_mag()
 {
 	CHECK(_param->set_param_int("SYS_FAILURE_EN", 1) == Param::Result::Success);
 
-	std::promise<void> prom;
-	auto fut = prom.get_future();
-
 	_mission->subscribe_mission_progress([this](Mission::MissionProgress progress) {
 		std::cout << "Progress: " << progress.current << "/" << progress.total;
 
@@ -316,10 +311,13 @@ void AutopilotTester::execute_mission_and_lose_mag()
 		}
 	});
 
+	std::promise<void> prom;
+	auto fut = prom.get_future();
 	_mission->start_mission_async([&prom](Mission::Result result) {
 		REQUIRE(Mission::Result::Success == result);
 		prom.set_value();
 	});
+	REQUIRE(fut.wait_for(std::chrono::seconds(1)) == std::future_status::ready);
 
 	// We except the mission to continue without mag just fine.
 	REQUIRE(poll_condition_with_timeout(
@@ -328,7 +326,36 @@ void AutopilotTester::execute_mission_and_lose_mag()
 		return progress.current == progress.total;
 	}, std::chrono::seconds(60)));
 
+}
+
+void AutopilotTester::execute_mission_and_lose_baro()
+{
+	CHECK(_param->set_param_int("SYS_FAILURE_EN", 1) == Param::Result::Success);
+
+	_mission->subscribe_mission_progress([this](Mission::MissionProgress progress) {
+		std::cout << "Progress: " << progress.current << "/" << progress.total;
+
+		if (progress.current == 1) {
+			CHECK(_failure->inject(Failure::FailureUnit::SensorBaro, Failure::FailureType::Off)
+			      == Failure::Result::Success);
+		}
+	});
+
+	std::promise<void> prom;
+	auto fut = prom.get_future();
+	_mission->start_mission_async([&prom](Mission::Result result) {
+		REQUIRE(Mission::Result::Success == result);
+		prom.set_value();
+	});
 	REQUIRE(fut.wait_for(std::chrono::seconds(1)) == std::future_status::ready);
+
+	// We except the mission to continue without baro just fine.
+	REQUIRE(poll_condition_with_timeout(
+	[this]() {
+		auto progress = _mission->mission_progress();
+		return progress.current == progress.total;
+	}, std::chrono::seconds(60)));
+
 }
 
 CoordinateTransformation AutopilotTester::get_coordinate_transformation()

test/mavsdk_tests/autopilot_tester.h

@@ -79,6 +79,7 @@ public:
 	void execute_mission();
 	void execute_mission_and_lose_gps();
 	void execute_mission_and_lose_mag();
+	void execute_mission_and_lose_baro();
 	void execute_rtl();
 	void offboard_goto(const Offboard::PositionNedYaw &target, float acceptance_radius_m = 0.3f,
 			   std::chrono::seconds timeout_duration = std::chrono::seconds(60));

test/mavsdk_tests/test_multicopter_failsafe.cpp

@@ -66,3 +66,17 @@ TEST_CASE("Continue on mag lost during mission", "[multicopter][vtol]")
 	tester.execute_mission_and_lose_mag();
 	tester.wait_until_disarmed();
 }
+
+TEST_CASE("Continue on baro lost during mission", "[multicopter][vtol]")
+{
+	AutopilotTester tester;
+	tester.connect(connection_url);
+	tester.wait_until_ready();
+
+	AutopilotTester::MissionOptions mission_options;
+	mission_options.rtl_at_end = true;
+	tester.prepare_square_mission(mission_options);
+	tester.arm();
+	tester.execute_mission_and_lose_baro();
+	tester.wait_until_disarmed();
+}