fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-11 13:21:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

[RTL]: Add CI testing for different RTL modes.

Browse Source 
added a vtol mission without a landing at the end (used for reversed RTL)
Note: reverse mission tracking check is disabled, due to potential bug in mavsdk

Signed-off-by: RomanBapst <bapstroman@gmail.com>
This commit is contained in:
RomanBapst
2023-02-01 09:11:27 +01:00
committed by Konrad
parent 4cf0d2e150
commit 4020dd004b
8 changed files with 437 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files
test/mavsdk_tests/test_vtol_mission.cpp
+46 -1
View File
@@ -31,7 +31,7 @@
*
****************************************************************************/
#include "autopilot_tester.h"
#include "autopilot_tester_rtl.h"
TEST_CASE("Fly VTOL mission", "[vtol]")
@@ -44,3 +44,48 @@ TEST_CASE("Fly VTOL mission", "[vtol]")
tester.execute_mission_raw();
tester.wait_until_disarmed();
}
TEST_CASE("RTL direct Home", "[vtol]")
{
AutopilotTesterRtl tester;
tester.connect(connection_url);
tester.wait_until_ready();
tester.store_home();
tester.load_qgc_mission_raw_and_move_here("test/mavsdk_tests/vtol_mission.plan");
// fly directly to home position
tester.set_rtl_type(0);
tester.arm();
tester.execute_rtl_when_reaching_mission_sequence(2);
tester.wait_until_disarmed(std::chrono::seconds(90));
tester.check_home_within(5.0f);
}
TEST_CASE("RTL with Mission Landing", "[vtol]")
{
AutopilotTesterRtl tester;
tester.connect(connection_url);
tester.wait_until_ready();
tester.load_qgc_mission_raw_and_move_here("test/mavsdk_tests/vtol_mission.plan");
// Vehicle should follow the mission and use the mission landing
tester.set_rtl_type(2);
tester.arm();
tester.execute_rtl_when_reaching_mission_sequence(2);
tester.check_tracks_mission_raw(30.0f);
tester.wait_until_disarmed(std::chrono::seconds(90));
}
TEST_CASE("RTL with Reverse Mission", "[vtol]")
{
AutopilotTesterRtl tester;
tester.connect(connection_url);
tester.wait_until_ready();
tester.set_takeoff_land_requirements(0);
tester.load_qgc_mission_raw_and_move_here("test/mavsdk_tests/vtol_mission_without_landing.plan");
// vehicle should follow the mission in reverse and land at the home position
tester.set_rtl_type(2);
tester.arm();
tester.execute_rtl_when_reaching_mission_sequence(6);
/* this check is currently disabled since there seems to be a bug in mavsdk which causes the reported
mission sequence to be out of order */
tester.check_tracks_mission_raw(300.0f);
tester.wait_until_disarmed(std::chrono::seconds(90));
}