Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-31 02:16:53 +08:00
Code Issues Actions 3 Packages Projects Releases Wiki Activity

mavsdk_tests: more verbose output on fail

Browse Source
This commit is contained in:
Julian Oes
2020-05-26 10:41:40 +02:00
parent 160aca9207
commit 73dda496ef
1 changed files with 11 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files
test/mavsdk_tests/autopilot_tester.cpp
+11 -4
View File
@@ -263,9 +263,16 @@ bool AutopilotTester::ground_truth_horizontal_position_close_to(const Telemetry:
CHECK(std::isfinite(current_pos.longitude_deg)); CHECK(std::isfinite(current_pos.longitude_deg));
LocalCoordinate local_pos = ct.local_from_global(GlobalCoordinate{current_pos.latitude_deg, current_pos.longitude_deg}); LocalCoordinate local_pos = ct.local_from_global(GlobalCoordinate{current_pos.latitude_deg, current_pos.longitude_deg});
const double distance = sqrt(sq(local_pos.north_m) + sq(local_pos.east_m)); const double distance = sqrt(sq(local_pos.north_m) + sq(local_pos.east_m));
const bool pass = distance < acceptance_radius_m;
std::cout << "Target: " << target_pos << std::endl; if (!pass) {
std::cout << "Current: " << current_pos << std::endl; std::cout << "target_pos.lat: " << target_pos.latitude_deg << std::endl;
std::cout << "Distance: " << distance << std::endl; std::cout << "target_pos.lon: " << target_pos.longitude_deg << std::endl;
return distance < acceptance_radius_m; std::cout << "current.lat: " << current_pos.latitude_deg << std::endl;
std::cout << "current.lon: " << current_pos.longitude_deg << std::endl;
std::cout << "Distance: " << distance << std::endl;
std::cout << "Acceptance radius: " << acceptance_radius_m << std::endl;
}
return pass;
} }