dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

mavsdk_tests: add test back in 

This failed with other frames but seems to pass with iris and
standard_vtol.
This commit is contained in:
Julian Oes 2020-06-24 16:27:43 +02:00 committed by Daniel Agar
parent 5e21eb3b78
commit 620916e4c1
1 changed files with 21 additions and 21 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

42
test/mavsdk_tests/test_multicopter_offboard.cpp
View File

@ -54,24 +54,24 @@ TEST_CASE("Offboard takeoff and land", "[multicopter][offboard][nogps]")
tester.check_home_within(1.0f);
}
// TEST_CASE("Offboard position control", "[multicopter][offboard][nogps]")
// {
// AutopilotTester tester;
// Offboard::PositionNedYaw takeoff_position {0.0f, 0.0f, -2.0f, 0.0f};
// Offboard::PositionNedYaw setpoint_1 {0.0f, 5.0f, -2.0f, 180.0f};
// Offboard::PositionNedYaw setpoint_2 {5.0f, 5.0f, -4.0f, 180.0f};
// Offboard::PositionNedYaw setpoint_3 {5.0f, 0.0f, -4.0f, 90.0f};
// tester.connect(connection_url);
// tester.wait_until_ready_local_position_only();
// tester.store_home();
// tester.arm();
// std::chrono::seconds goto_timeout = std::chrono::seconds(20);
// tester.offboard_goto(takeoff_position, 0.1f, goto_timeout);
// tester.offboard_goto(setpoint_1, 0.1f, goto_timeout);
// tester.offboard_goto(setpoint_2, 0.1f, goto_timeout);
// tester.offboard_goto(setpoint_3, 0.1f, goto_timeout);
// tester.offboard_goto(takeoff_position, 0.1f, goto_timeout);
// tester.offboard_land();
// tester.wait_until_disarmed(goto_timeout);
// tester.check_home_within(1.0f);
// }
TEST_CASE("Offboard position control", "[multicopter][offboard][nogps]")
{
AutopilotTester tester;
Offboard::PositionNedYaw takeoff_position {0.0f, 0.0f, -2.0f, 0.0f};
Offboard::PositionNedYaw setpoint_1 {0.0f, 5.0f, -2.0f, 180.0f};
Offboard::PositionNedYaw setpoint_2 {5.0f, 5.0f, -4.0f, 180.0f};
Offboard::PositionNedYaw setpoint_3 {5.0f, 0.0f, -4.0f, 90.0f};
tester.connect(connection_url);
tester.wait_until_ready_local_position_only();
tester.store_home();
tester.arm();
std::chrono::seconds goto_timeout = std::chrono::seconds(20);
tester.offboard_goto(takeoff_position, 0.1f, goto_timeout);
tester.offboard_goto(setpoint_1, 0.1f, goto_timeout);
tester.offboard_goto(setpoint_2, 0.1f, goto_timeout);
tester.offboard_goto(setpoint_3, 0.1f, goto_timeout);
tester.offboard_goto(takeoff_position, 0.1f, goto_timeout);
tester.offboard_land();
tester.wait_until_disarmed(goto_timeout);
tester.check_home_within(1.0f);
}