ekf2: delete orientation_covariances_euler()

- usage replaced with now public calcRotVecVariances()
This commit is contained in:
Daniel Agar
2022-12-07 12:41:27 -05:00
parent a187bb3b80
commit 8eb2a0a3ec
3 changed files with 5 additions and 64 deletions
+3 -5
View File
@@ -204,8 +204,6 @@ public:
// get the orientation (quaterion) covariances
matrix::SquareMatrix<float, 4> orientation_covariances() const { return P.slice<4, 4>(0, 0); }
matrix::SquareMatrix<float, 3> orientation_covariances_euler() const;
// get the linear velocity covariances
matrix::SquareMatrix<float, 3> velocity_covariances() const { return P.slice<3, 3>(4, 4); }
@@ -391,6 +389,9 @@ public:
// use the latest IMU data at the current time horizon.
Quatf calculate_quaternion() const;
// rotate quaternion covariances into variances for an equivalent rotation vector
Vector3f calcRotVecVariances() const;
// set minimum continuous period without GPS fail required to mark a healthy GPS status
void set_min_required_gps_health_time(uint32_t time_us) { _min_gps_health_time_us = time_us; }
@@ -967,9 +968,6 @@ private:
// calculate the measurement variance for the optical flow sensor
float calcOptFlowMeasVar(const flowSample &flow_sample);
// rotate quaternion covariances into variances for an equivalent rotation vector
Vector3f calcRotVecVariances();
// initialise the quaternion covariances using rotation vector variances
// do not call before quaternion states are initialised
void initialiseQuatCovariances(Vector3f &rot_vec_var);