mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-07-04 11:00:35 +08:00
gnss(septentrio): fix broken heading
Heading wasn't working because of an incorrect check during parsing.
This commit is contained in:
committed by
Daniel Agar
parent
bfbbf2ff6f
commit
49dc896d20
@@ -1246,7 +1246,7 @@ int SeptentrioDriver::process_message()
|
||||
|
||||
AttEuler att_euler;
|
||||
|
||||
if (_sbf_decoder.parse(&att_euler) &&
|
||||
if (_sbf_decoder.parse(&att_euler) == PX4_OK &&
|
||||
!att_euler.error_not_requested &&
|
||||
att_euler.error_aux1 == Error::None &&
|
||||
att_euler.error_aux2 == Error::None &&
|
||||
@@ -1540,10 +1540,6 @@ void SeptentrioDriver::publish()
|
||||
|
||||
_sensor_gps_pub.publish(_message_gps_state);
|
||||
|
||||
// Heading/yaw data can be updated at a lower rate than the other navigation data.
|
||||
// The uORB message definition requires this data to be set to a NAN if no new valid data is available.
|
||||
_message_gps_state.heading = NAN;
|
||||
|
||||
if (_message_gps_state.spoofing_state != _spoofing_state) {
|
||||
|
||||
if (_message_gps_state.spoofing_state > sensor_gps_s::SPOOFING_STATE_NONE) {
|
||||
|
||||
Reference in New Issue
Block a user