diff --git a/src/comm/MAVLinkSimulationMAV.cc b/src/comm/MAVLinkSimulationMAV.cc
index f86a50e307402c0ed32550289a618e770ac242cb..a5dac00ec6461ca6cd6b65958a3c441ebcd80307 100644
--- a/src/comm/MAVLinkSimulationMAV.cc
+++ b/src/comm/MAVLinkSimulationMAV.cc
@@ -147,7 +147,7 @@ void MAVLinkSimulationMAV::mainloop()
         attitude.usec = 0;
         attitude.roll = 0.0f;
         attitude.pitch = 0.0f;
-        attitude.yaw = yaw-M_PI_2;
+        attitude.yaw = yaw-(M_PI/2.0);
         attitude.rollspeed = 0.0f;
         attitude.pitchspeed = 0.0f;
         attitude.yawspeed = 0.0f;