fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-27 08:53:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

frsky_telemetry: fix heading for D protocol

Browse Source
This commit is contained in:
Beat Küng
2017-08-08 14:47:01 +02:00
parent 1d40336723
commit 4e5c6fc805
1 changed files with 6 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/frsky_telemetry/frsky_data.c
+6 -1
View File
@@ -248,7 +248,12 @@ void frsky_send_frame2(int uart)
time_t time_gps = global_pos->time_utc_usec / 1000000ULL; time_t time_gps = global_pos->time_utc_usec / 1000000ULL;
struct tm *tm_gps = gmtime(&time_gps); struct tm *tm_gps = gmtime(&time_gps);
course = (global_pos->yaw + M_PI_F) / M_PI_F * 180.0f; course = global_pos->yaw / M_PI_F * 180.0f;
if (course < 0.f) { // course is in range [0, 360], 0=north, CW
course += 360.f;
}
lat = frsky_format_gps(fabsf(global_pos->lat)); lat = frsky_format_gps(fabsf(global_pos->lat));
lat_ns = (global_pos->lat < 0) ? 'S' : 'N'; lat_ns = (global_pos->lat < 0) ? 'S' : 'N';
lon = frsky_format_gps(fabsf(global_pos->lon)); lon = frsky_format_gps(fabsf(global_pos->lon));