diff --git a/src/modules/mavlink/streams/ATTITUDE_TARGET.hpp b/src/modules/mavlink/streams/ATTITUDE_TARGET.hpp
index 02f77bf8bb..5b7886d5ab 100644
--- a/src/modules/mavlink/streams/ATTITUDE_TARGET.hpp
+++ b/src/modules/mavlink/streams/ATTITUDE_TARGET.hpp
@@ -100,7 +100,7 @@ protected:
 			msg.body_pitch_rate = att_rates_sp.pitch;
 			msg.body_yaw_rate = att_rates_sp.yaw;
 
-			msg.thrust = att_sp.thrust_body[0];
+			msg.thrust = Vector3f(att_sp.thrust_body).norm();
 
 			mavlink_msg_attitude_target_send_struct(_mavlink->get_channel(), &msg);