AttPosEKF: Disable unused function

This commit is contained in:
Johan Jansen 2015-02-05 13:20:10 +01:00
parent 7287dc3c4c
commit 83298110c1
2 changed files with 6 additions and 4 deletions

View File

@ -6,10 +6,10 @@
#include <algorithm>
#ifndef M_PI_F
#define M_PI_F ((float)M_PI)
#define M_PI_F static_cast<float>(M_PI)
#endif
#define EKF_COVARIANCE_DIVERGED 1.0e8f
constexpr float EKF_COVARIANCE_DIVERGED = 1.0e8f;
AttPosEKF::AttPosEKF() :
covTimeStepMax(0.0f),
@ -2401,6 +2401,7 @@ void AttPosEKF::RecallOmega(float* omegaForFusion, uint64_t msec)
}
}
#if 0
void AttPosEKF::quat2Tnb(Mat3f &Tnb, const float (&quat)[4])
{
// Calculate the nav to body cosine matrix
@ -2425,6 +2426,7 @@ void AttPosEKF::quat2Tnb(Mat3f &Tnb, const float (&quat)[4])
Tnb.x.z = 2*(q13 - q02);
Tnb.y.z = 2*(q23 + q01);
}
#endif
void AttPosEKF::quat2Tbn(Mat3f &Tbn_ret, const float (&quat)[4])
{

View File

@ -218,7 +218,7 @@ public:
void updateDtHgtFilt(float dt);
void UpdateStrapdownEquationsNED();
void UpdateStrapdownEquationsNED();
void CovariancePrediction(float dt);
@ -272,7 +272,7 @@ public:
static void calcLLH(float posNED[3], double &lat, double &lon, float &hgt, double latRef, double lonRef, float hgtRef);
static void quat2Tnb(Mat3f &Tnb, const float (&quat)[4]);
//static void quat2Tnb(Mat3f &Tnb, const float (&quat)[4]);
static inline float sq(float valIn) {return valIn * valIn;}