mavsdk_tests: test for losing mag during mission

test/mavsdk_tests/autopilot_tester.cpp

@@ -290,6 +290,7 @@ void AutopilotTester::execute_mission_and_lose_gps()
 		prom.set_value();
 	});
 
+	// We expect that a blind land is performed.
 	REQUIRE(poll_condition_with_timeout(
 	[this]() {
 		auto flight_mode = _telemetry->flight_mode();
@@ -299,6 +300,37 @@ void AutopilotTester::execute_mission_and_lose_gps()
 	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;
+
+		if (progress.current == 1) {
+			CHECK(_failure->inject(Failure::FailureUnit::SensorMag, Failure::FailureType::Off)
+			      == Failure::Result::Success);
+		}
+	});
+
+	_mission->start_mission_async([&prom](Mission::Result result) {
+		REQUIRE(Mission::Result::Success == result);
+		prom.set_value();
+	});
+
+	// We except the mission to continue without mag just fine.
+	REQUIRE(poll_condition_with_timeout(
+	[this]() {
+		auto progress = _mission->mission_progress();
+		return progress.current == progress.total;
+	}, std::chrono::seconds(60)));
+
+	REQUIRE(fut.wait_for(std::chrono::seconds(1)) == std::future_status::ready);
+}
+
 CoordinateTransformation AutopilotTester::get_coordinate_transformation()
 {
 	const auto home = _telemetry->home();