|
|
|
@ -3028,6 +3028,10 @@ void AttPosEKF::GetFilterState(struct ekf_status_report *err)
@@ -3028,6 +3028,10 @@ void AttPosEKF::GetFilterState(struct ekf_status_report *err)
|
|
|
|
|
current_ekf_state.states[i] = states[i]; |
|
|
|
|
} |
|
|
|
|
current_ekf_state.n_states = n_states; |
|
|
|
|
current_ekf_state.onGround = onGround; |
|
|
|
|
current_ekf_state.staticMode = staticMode; |
|
|
|
|
current_ekf_state.useCompass = useCompass; |
|
|
|
|
current_ekf_state.useAirspeed = useAirspeed; |
|
|
|
|
|
|
|
|
|
memcpy(err, ¤t_ekf_state, sizeof(*err)); |
|
|
|
|
|
|
|
|
|