diff --git a/src/comm/MAVLinkSimulationMAV.cc b/src/comm/MAVLinkSimulationMAV.cc
index 1ce3887e49b8a3d4bc515ed89a54eeebee9fd941..e980718984b1b7aa8f85811a299e7791d74d4907 100644
--- a/src/comm/MAVLinkSimulationMAV.cc
+++ b/src/comm/MAVLinkSimulationMAV.cc
@@ -158,6 +158,7 @@ void MAVLinkSimulationMAV::mainloop()
         // The message container to be used for sending
         mavlink_message_t ret;
 
+        #ifdef MAVLINK_ENABLED_PIXHAWK
         // Send which controllers are active
         mavlink_control_status_t control_status;
         control_status.control_att = 1;
@@ -169,6 +170,7 @@ void MAVLinkSimulationMAV::mainloop()
         control_status.vision_fix = 0;     // no fix from vision system
         mavlink_msg_control_status_encode(systemid, MAV_COMP_ID_IMU, &ret, &control_status);
         link->sendMAVLinkMessage(&ret);
+        #endif //MAVLINK_ENABLED_PIXHAWK
 
         // Send actual controller outputs
         // This message just shows the direction
diff --git a/src/uas/UAS.cc b/src/uas/UAS.cc
index d080906047e97be8a98e92a4efe9c06fd8da4b42..6877babf344bcceab4696b8c5cc1248cd86ec9e0 100644
--- a/src/uas/UAS.cc
+++ b/src/uas/UAS.cc
@@ -349,6 +349,8 @@ void UAS::receiveMessage(LinkInterface* link, mavlink_message_t message)
                 }
             }
             break;
+
+        #ifdef MAVLINK_ENABLED_PIXHAWK
         case MAVLINK_MSG_ID_CONTROL_STATUS:
             {
                 mavlink_control_status_t status;
@@ -365,6 +367,7 @@ void UAS::receiveMessage(LinkInterface* link, mavlink_message_t message)
                 emit gpsLocalizationChanged(this, status.gps_fix);
             }
             break;
+		#endif // PIXHAWK 
         case MAVLINK_MSG_ID_RAW_IMU:
             {
                 mavlink_raw_imu_t raw;