diff --git a/src/modules/fw_att_pos_estimator/fw_att_pos_estimator_main.cpp b/src/modules/fw_att_pos_estimator/fw_att_pos_estimator_main.cpp
index 1d57f705a8..c9d75bce49 100644
--- a/src/modules/fw_att_pos_estimator/fw_att_pos_estimator_main.cpp
+++ b/src/modules/fw_att_pos_estimator/fw_att_pos_estimator_main.cpp
@@ -758,6 +758,7 @@ FixedwingEstimator::task_main()
 				while ((i < ekf_n_states) && (i < max_states)) {
 
 					rep.states[i] = ekf_report.states[i];
+					i++;
 				}
 
 				if (_estimator_status_pub > 0) {