diff --git a/src/modules/mc_pos_control/mc_pos_control_main.cpp b/src/modules/mc_pos_control/mc_pos_control_main.cpp index 58d20ebef9..4910454bd9 100644 --- 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 index 40268358ad..d135eecfbb 100644 --- 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();