EKF: publish GPS check status

This commit is contained in:
Paul Riseborough
2016-04-16 13:38:40 +10:00
parent 6fa13c7806
commit 31bf342fc1
3 changed files with 12 additions and 0 deletions
+3
View File
@@ -123,6 +123,9 @@ public:
void get_accel_bias(float *bias) {*bias = _state.accel_z_bias;}
// get GPS check status
void get_gps_check_status(uint16_t *_gps_check_fail_status);
private:
static const uint8_t _k_num_states = 24;
+6
View File
@@ -316,6 +316,12 @@ void Ekf::get_heading_innov_var(float *heading_innov_var)
memcpy(heading_innov_var, &_heading_innov_var, sizeof(float));
}
// get GPS check status
void Ekf::get_gps_check_status(uint16_t *val)
{
memcpy(val, &_gps_check_fail_status, sizeof(uint16_t));
}
// get the state vector at the delayed time horizon
void Ekf::get_state_delayed(float *state)
{
+3
View File
@@ -217,6 +217,9 @@ public:
*val = _control_status.value;
}
// get GPS check status
virtual void get_gps_check_status(uint16_t *val) = 0;
protected:
parameters _params; // filter parameters