aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_NavEKF3: make mag variance reporting consistent

Browse Source 
logged scaled variance should match the value used in MAVLink
EKF_STATUS_REPORT
This commit is contained in:
Andrew Tridgell 2020-04-04 16:37:11 +11:00
parent c9755cf9e6
commit be674fc36c
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
libraries/AP_NavEKF3/AP_NavEKF3_Outputs.cpp
View File

@ -607,10 +607,10 @@ void NavEKF3_core::send_status_report(mavlink_channel_t chan) const
} else { } else {
temp = 0.0f; temp = 0.0f;
} }
const float mag_max = fmaxf(fmaxf(magVar.x,magVar.y),magVar.z);
// send message // send message
mavlink_msg_ekf_status_report_send(chan, flags, velVar, posVar, hgtVar, magVar.length(), temp, tasVar); mavlink_msg_ekf_status_report_send(chan, flags, velVar, posVar, hgtVar, mag_max, temp, tasVar);
} }
// report the reason for why the backend is refusing to initialise // report the reason for why the backend is refusing to initialise