Fixed missing increment across states

11 years ago · 29abf6db39
1 changed files with 1 additions and 0 deletions
--- 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()
				@@ -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) {