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

Expand standalone mathlib double precision functions' usage

Browse Source
This commit is contained in:
Kamil Ritz
2020-04-12 11:33:52 +02:00
committed by Lorenz Meier
parent 1fa6870cd6
commit e52482501a
2 changed files with 19 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files
geo/geo.cpp
+4 -4
View File
@@ -524,10 +524,10 @@ float get_distance_to_point_global_wgs84(double lat_now, double lon_now, float a
double lat_next, double lon_next, float alt_next,
float *dist_xy, float *dist_z)
{
double current_x_rad = lat_next / 180.0 * M_PI;
double current_y_rad = lon_next / 180.0 * M_PI;
double x_rad = lat_now / 180.0 * M_PI;
double y_rad = lon_now / 180.0 * M_PI;
double current_x_rad = math::radians(lat_next);
double current_y_rad = math::radians(lon_next);
double x_rad = math::radians(lat_now);
double y_rad = math::radians(lon_now);
double d_lat = x_rad - current_x_rad;
double d_lon = y_rad - current_y_rad;
mathlib/mathlib.h
+15 -5
View File
@@ -57,19 +57,29 @@
namespace math {
template <typename Type>
Type min(Type val1, Type val2) { return (val1 < val2) ? val1 : val2; }
Type min(Type val1, Type val2) {
return (val1 < val2) ? val1 : val2;
}
template <typename Type>
Type max(Type val1, Type val2) { return (val1 > val2) ? val1 : val2; }
Type max(Type val1, Type val2) {
return (val1 > val2) ? val1 : val2;
}
template <typename Type>
Type constrain(Type val, Type min, Type max) { return (val < min) ? min : ((val > max) ? max : val); }
Type constrain(Type val, Type min, Type max) {
return (val < min) ? min : ((val > max) ? max : val);
}
template <typename Type>
Type radians(Type degrees) { return (degrees / Type(180)) * Type(M_PI); }
Type radians(Type degrees) {
return (degrees / Type(180)) * Type(M_PI);
}
template <typename Type>
Type degrees(Type radians) { return (radians * Type(180)) / Type(M_PI); }
Type degrees(Type radians) {
return (radians * Type(180)) / Type(M_PI);
}
} // namespace math
#else