diff --git a/test/mavsdk_tests/test_multicopter_offboard.cpp b/test/mavsdk_tests/test_multicopter_offboard.cpp index dad8bc9da96..3f9cb650b5d 100644 --- a/test/mavsdk_tests/test_multicopter_offboard.cpp +++ b/test/mavsdk_tests/test_multicopter_offboard.cpp @@ -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); +}