Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_NavEKF : Additional flash logging

This commit is contained in:
Paul Riseborough 2014-01-31 09:11:54 +11:00 committed by Andrew Tridgell
parent d6ead64083
commit 6b9733c013
2 changed files with 12 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

11
libraries/AP_NavEKF/AP_NavEKF.cpp
View File

@ -6,10 +6,10 @@
// uncomment this to force the optimisation of this code, note that
// this makes debugging harder
// #pragma GCC optimize("O3")
#pragma GCC optimize("O3")
#include "AP_NavEKF.h"
#include <stdio.h>
//#include <stdio.h>
extern const AP_HAL::HAL& hal;
@ -1923,6 +1923,13 @@ void NavEKF::getAccelBias(Vector3f &accelBias)
accelBias.z = states[15]*dtIMUAvgInv;
}
void NavEKF::getWind(Vector3f &wind)
{
wind.x = states[16];
wind.y = states[17];
wind.z = 0.0f; // curently don't estimate this
}
void NavEKF::getMagNED(Vector3f &magNED)
{
magNED.x = states[18]*1000.0f;

3
libraries/AP_NavEKF/AP_NavEKF.h
View File

@ -92,6 +92,9 @@ public:
// return delta velocity bias estimates
void getAccelBias(Vector3f &accelBias);
// return the NE wind speed estimates
void getWind(Vector3f &wind);
// return earth magnetic field estimates
void getMagNED(Vector3f &magNED);