write trust setpoint to correct field for logging

RomanBapst · Mar 25, 2015 · b361f7c · b361f7c
1 parent 7554eb5
commit b361f7c
Show file tree

Hide file tree

Showing 2 changed files with 4 additions and 4 deletions.
diff --git a/src/modules/mc_pos_control/mc_pos_control_main.cpp b/src/modules/mc_pos_control/mc_pos_control_main.cpp
@@ -1308,8 +1308,8 @@ MulticopterPositionControl::task_main()
 
 					/* save thrust setpoint for logging */
 					_local_pos_sp.acc_x = thrust_sp(0);
-					_local_pos_sp.acc_x = thrust_sp(1);
-					_local_pos_sp.acc_x = thrust_sp(2);
+					_local_pos_sp.acc_y = thrust_sp(1);
+					_local_pos_sp.acc_z = thrust_sp(2);
 
 					_att_sp.timestamp = hrt_absolute_time();
 

diff --git a/src/modules/mc_pos_control_multiplatform/mc_pos_control.cpp b/src/modules/mc_pos_control_multiplatform/mc_pos_control.cpp
@@ -922,8 +922,8 @@ void  MulticopterPositionControl::handle_vehicle_attitude(const px4_vehicle_atti
 
 				/* save thrust setpoint for logging */
 				_local_pos_sp_msg.data().acc_x = thrust_sp(0);
-				_local_pos_sp_msg.data().acc_x = thrust_sp(1);
-				_local_pos_sp_msg.data().acc_x = thrust_sp(2);
+				_local_pos_sp_msg.data().acc_y = thrust_sp(1);
+				_local_pos_sp_msg.data().acc_z = thrust_sp(2);
 
 				_att_sp_msg.data().timestamp = get_time_micros();