|
|
|
@ -77,10 +77,10 @@ Ekf::Ekf():
@@ -77,10 +77,10 @@ Ekf::Ekf():
|
|
|
|
|
_last_known_posNE.setZero(); |
|
|
|
|
_earth_rate_NED.setZero(); |
|
|
|
|
_R_prev = matrix::Dcm<float>(); |
|
|
|
|
_vel_pos_innov = {0}; |
|
|
|
|
_mag_innov = {0}; |
|
|
|
|
_vel_pos_innov_var = {0}; |
|
|
|
|
_mag_innov_var = {0}; |
|
|
|
|
memset(_vel_pos_innov, 0, sizeof(_vel_pos_innov)); |
|
|
|
|
memset(_mag_innov, 0, sizeof(_mag_innov)); |
|
|
|
|
memset(_vel_pos_innov_var, 0, sizeof(_vel_pos_innov_var)); |
|
|
|
|
memset(_mag_innov_var, 0, sizeof(_mag_innov_var)); |
|
|
|
|
_delta_angle_corr.setZero(); |
|
|
|
|
_delta_vel_corr.setZero(); |
|
|
|
|
_vel_corr.setZero(); |
|
|
|
|