File containing funtions to implement kalman filter on femur. More...
Functions | |
int | set_mes_err_cov (gsl_matrix *R, femur fem, int frame_count) |
double | get_cov_err (int i, double err[]) |
int | run_kalman_femur_theta (femur &fem, vector< vector< double > > &state) |
Run the EKF on the femur. |
File containing funtions to implement kalman filter on femur.
double get_cov_err | ( | int | i, |
double | err[] | ||
) |
int run_kalman_femur_theta | ( | femur & | fem, |
vector< vector< double > > & | state | ||
) |
Run the EKF on the femur.
[in] | fem | The femur structure with all data |
[out] | state | The state vector, for each iteration. Output of the kalman filter |
References ekf_kalman_gain(), ekf_predict_step(), ekf_update_cov(), ekf_update_estimate(), generate_jacobian_femur_theta(), generate_mes_vec_femur(), h_femur_theta_encaps(), tibia::opti_count, and set_mes_err_cov().
int set_mes_err_cov | ( | gsl_matrix * | R, |
femur | fem, | ||
int | frame_count | ||
) |
References get_cov_err(), tibia::opti_count, tibia::optical, and sensor::point_flag.
Referenced by run_kalman_femur_theta().