|
|
|
@ -461,14 +461,14 @@ void AutopilotTester::fly_forward_in_posctl()
@@ -461,14 +461,14 @@ void AutopilotTester::fly_forward_in_posctl()
|
|
|
|
|
std::this_thread::sleep_for(adjust_to_lockstep_speed(std::chrono::milliseconds(1000 / manual_control_rate_hz))); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// Fly forward for 30 seconds
|
|
|
|
|
for (unsigned i = 0; i < 30 * manual_control_rate_hz; ++i) { |
|
|
|
|
// Fly forward for 60 seconds
|
|
|
|
|
for (unsigned i = 0; i < 60 * manual_control_rate_hz; ++i) { |
|
|
|
|
CHECK(_manual_control->set_manual_control_input(0.5f, 0.f, 0.5f, 0.f) == ManualControl::Result::Success); |
|
|
|
|
std::this_thread::sleep_for(adjust_to_lockstep_speed(std::chrono::milliseconds(1000 / manual_control_rate_hz))); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// Descend until disarmed
|
|
|
|
|
for (unsigned i = 0; i < 30 * manual_control_rate_hz; ++i) { |
|
|
|
|
for (unsigned i = 0; i < 60 * manual_control_rate_hz; ++i) { |
|
|
|
|
CHECK(_manual_control->set_manual_control_input(0.f, 0.f, 0.0f, 0.f) == ManualControl::Result::Success); |
|
|
|
|
std::this_thread::sleep_for(adjust_to_lockstep_speed(std::chrono::milliseconds(1000 / manual_control_rate_hz))); |
|
|
|
|
|
|
|
|
@ -496,14 +496,14 @@ void AutopilotTester::fly_forward_in_altctl()
@@ -496,14 +496,14 @@ void AutopilotTester::fly_forward_in_altctl()
|
|
|
|
|
std::this_thread::sleep_for(adjust_to_lockstep_speed(std::chrono::milliseconds(1000 / manual_control_rate_hz))); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// Fly forward for 30 seconds
|
|
|
|
|
for (unsigned i = 0; i < 30 * manual_control_rate_hz; ++i) { |
|
|
|
|
// Fly forward for 60 seconds
|
|
|
|
|
for (unsigned i = 0; i < 60 * manual_control_rate_hz; ++i) { |
|
|
|
|
CHECK(_manual_control->set_manual_control_input(0.5f, 0.f, 0.5f, 0.f) == ManualControl::Result::Success); |
|
|
|
|
std::this_thread::sleep_for(adjust_to_lockstep_speed(std::chrono::milliseconds(1000 / manual_control_rate_hz))); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// Descend until disarmed
|
|
|
|
|
for (unsigned i = 0; i < 30 * manual_control_rate_hz; ++i) { |
|
|
|
|
for (unsigned i = 0; i < 60 * manual_control_rate_hz; ++i) { |
|
|
|
|
CHECK(_manual_control->set_manual_control_input(0.f, 0.f, 0.0f, 0.f) == ManualControl::Result::Success); |
|
|
|
|
std::this_thread::sleep_for(adjust_to_lockstep_speed(std::chrono::milliseconds(1000 / manual_control_rate_hz))); |
|
|
|
|
|
|
|
|
|