mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-06-01 02:55:07 +08:00
EKF: covariances() helper return const reference and fix code style
- PX4 astyle puts the reference with the name.
This commit is contained in:
@@ -147,7 +147,7 @@ public:
|
|||||||
void get_true_airspeed(float *tas) override;
|
void get_true_airspeed(float *tas) override;
|
||||||
|
|
||||||
// get the full covariance matrix
|
// get the full covariance matrix
|
||||||
matrix::SquareMatrix<float, 24> covariances() const { return P; }
|
const matrix::SquareMatrix<float, 24> &covariances() const { return P; }
|
||||||
|
|
||||||
// get the diagonal elements of the covariance matrix
|
// get the diagonal elements of the covariance matrix
|
||||||
matrix::Vector<float, 24> covariances_diagonal() const { return P.diag(); }
|
matrix::Vector<float, 24> covariances_diagonal() const { return P.diag(); }
|
||||||
@@ -563,17 +563,17 @@ private:
|
|||||||
// fuse optical flow line of sight rate measurements
|
// fuse optical flow line of sight rate measurements
|
||||||
void fuseOptFlow();
|
void fuseOptFlow();
|
||||||
|
|
||||||
bool fuseHorizontalVelocity(const Vector3f &innov, const Vector2f &innov_gate,
|
bool fuseHorizontalVelocity(const Vector3f &innov, const Vector2f &innov_gate, const Vector3f &obs_var,
|
||||||
const Vector3f &obs_var, Vector3f &innov_var, Vector2f &test_ratio);
|
Vector3f &innov_var, Vector2f &test_ratio);
|
||||||
|
|
||||||
bool fuseVerticalVelocity(const Vector3f &innov, const Vector2f &innov_gate,
|
bool fuseVerticalVelocity(const Vector3f &innov, const Vector2f &innov_gate, const Vector3f &obs_var,
|
||||||
const Vector3f &obs_var, Vector3f &innov_var, Vector2f &test_ratio);
|
Vector3f &innov_var, Vector2f &test_ratio);
|
||||||
|
|
||||||
bool fuseHorizontalPosition(const Vector3f &innov, const Vector2f &innov_gate,
|
bool fuseHorizontalPosition(const Vector3f &innov, const Vector2f &innov_gate, const Vector3f &obs_var,
|
||||||
const Vector3f &obs_var, Vector3f &innov_var, Vector2f &test_ratio);
|
Vector3f &innov_var, Vector2f &test_ratio);
|
||||||
|
|
||||||
bool fuseVerticalPosition(const Vector3f &innov, const Vector2f &innov_gate,
|
bool fuseVerticalPosition(const Vector3f &innov, const Vector2f &innov_gate, const Vector3f &obs_var,
|
||||||
const Vector3f &obs_var, Vector3f &innov_var, Vector2f &test_ratio);
|
Vector3f &innov_var, Vector2f &test_ratio);
|
||||||
|
|
||||||
// calculate optical flow body angular rate compensation
|
// calculate optical flow body angular rate compensation
|
||||||
// returns false if bias corrected body rate data is unavailable
|
// returns false if bias corrected body rate data is unavailable
|
||||||
|
|||||||
Reference in New Issue
Block a user