azaion/autopilot
1
0
Fork 0
mirror of https://github.com/azaion/autopilot.git synced 2026-04-22 13:36:35 +00:00
Code Issues Packages Projects Releases Wiki Activity

Improve comments in Autopilot

Browse Source 
Issue: https://denyspopov.atlassian.net/browse/AZ-14
Type: Improvement
This commit is contained in:
Tuomas Järvinen
2024-05-19 19:49:39 +02:00
parent f0c8a1334a
commit b0b17d7fcc
8 changed files with 131 additions and 105 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/az_utils.cpp
+7 -4
View File
@@ -5,14 +5,17 @@ AzUtils::AzUtils() {}
#define EARTH_RADIUS 6371.0 // Earth radius in kilometers
double degrees_to_radians(double degrees) {
double degrees_to_radians(double degrees)
{
return degrees * M_PI / 180.0;
}
double AzUtils::distance(double lat1, double lon1, double lat2, double lon2) {
double AzUtils::distance(double lat1, double lon1, double lat2, double lon2)
{
double dlat = degrees_to_radians(lat2 - lat1);
double dlon = degrees_to_radians(lon2 - lon1);
double a = sin(dlat/2) * sin(dlat/2) + cos(degrees_to_radians(lat1)) * cos(degrees_to_radians(lat2)) * sin(dlon/2) * sin(dlon/2);
double c = 2 * atan2(sqrt(a), sqrt(1-a));
double a = sin(dlat / 2) * sin(dlat / 2)
+ cos(degrees_to_radians(lat1)) * cos(degrees_to_radians(lat2)) * sin(dlon / 2) * sin(dlon / 2);
double c = 2 * atan2(sqrt(a), sqrt(1 - a));
return EARTH_RADIUS * c;
}