From e39afb148dd947c9d5786e6209b3bc552c16d4c5 Mon Sep 17 00:00:00 2001
From: Paul Riseborough <p_riseborough@live.com.au>
Date: Sun, 2 Sep 2018 21:04:27 +1000
Subject: [PATCH] drivers: publish GPS antenna heading offset
---
src/drivers/gps/gps.cpp | 3 +++
1 file changed, 3 insertions(+)
diff --git a/src/drivers/gps/gps.cpp b/src/drivers/gps/gps.cpp
index 099ded36c0..6f6ff81a7c 100644
--- a/src/drivers/gps/gps.cpp
+++ b/src/drivers/gps/gps.cpp
@@ -268,6 +268,7 @@ GPS::GPS(const char *path, gps_driver_mode_t mode, GPSHelper::Interface interfac
_port[sizeof(_port) - 1] = '\0';
_report_gps_pos.heading = NAN;
+ _report_gps_pos.heading_offset = NAN;
/* create satellite info data object if requested */
if (enable_sat_info) {
@@ -655,6 +656,7 @@ GPS::run()
_report_gps_pos.vel_ned_valid = true;
_report_gps_pos.satellites_used = 10;
_report_gps_pos.heading = NAN;
+ _report_gps_pos.heading_offset = NAN;
/* no time and satellite information simulated */
@@ -699,6 +701,7 @@ GPS::run()
/* reset report */
memset(&_report_gps_pos, 0, sizeof(_report_gps_pos));
_report_gps_pos.heading = NAN;
+ _report_gps_pos.heading_offset = heading_offset;
if (_mode == GPS_DRIVER_MODE_UBX) {
--
GitLab