fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-15 00:31: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/math_helpers.h
+14
View File
@@ -44,6 +44,20 @@ std::array<T, 3> get_local_mission_item(const Mission::MissionItem &item, const
return {static_cast<T>(local.north_m), static_cast<T>(local.east_m), -item.relative_altitude_m};
}
template<typename T>
std::array<T, 3> get_local_mission_item_from_raw_item(const mavsdk::MissionRaw::MissionItem &item,
const CoordinateTransformation &ct)
{
using GlobalCoordinate = mavsdk::geometry::CoordinateTransformation::GlobalCoordinate;
GlobalCoordinate global;
global.latitude_deg = item.x / 1e7;
global.longitude_deg = item.y / 1e7;
auto local = ct.local_from_global(global);
return {static_cast<T>(local.north_m), static_cast<T>(local.east_m), -item.z};
}
template<typename T>
T sq(T x)
{