diff --git a/src/uas/UASWaypointManager.cc b/src/uas/UASWaypointManager.cc
index 5e7a3d6447027fc820bcb27e2d0a7ac5aabe2aba..09ebd9c5cde63bac116f848a835f4d3c4eda9e7b 100644
--- a/src/uas/UASWaypointManager.cc
+++ b/src/uas/UASWaypointManager.cc
@@ -346,7 +346,7 @@ void UASWaypointManager::sendWaypointClearAll()
 
     mavlink_msg_waypoint_clear_all_encode(uas.mavlink->getSystemId(), uas.mavlink->getComponentId(), &message, &wpca);
     uas.sendMessage(message);
-    usleep(PROTOCOL_DELAY_MS * 1000);
+    MG::SLEEP::usleep(PROTOCOL_DELAY_MS * 1000);
 
     qDebug() << "sent waypoint clear all to ID " << wpca.target_system;
 }
@@ -365,7 +365,7 @@ void UASWaypointManager::sendWaypointSetCurrent(quint16 seq)
 
     mavlink_msg_waypoint_set_current_encode(uas.mavlink->getSystemId(), uas.mavlink->getComponentId(), &message, &wpsc);
     uas.sendMessage(message);
-    usleep(PROTOCOL_DELAY_MS * 1000);
+    MG::SLEEP::usleep(PROTOCOL_DELAY_MS * 1000);
 
     qDebug() << "sent waypoint set current (" << wpsc.seq << ") to ID " << wpsc.target_system;
 }
@@ -384,7 +384,7 @@ void UASWaypointManager::sendWaypointCount()
 
     mavlink_msg_waypoint_count_encode(uas.mavlink->getSystemId(), uas.mavlink->getComponentId(), &message, &wpc);
     uas.sendMessage(message);
-    usleep(PROTOCOL_DELAY_MS * 1000);
+    MG::SLEEP::usleep(PROTOCOL_DELAY_MS * 1000);
 
     qDebug() << "sent waypoint count (" << wpc.count << ") to ID " << wpc.target_system;
 }
@@ -402,7 +402,7 @@ void UASWaypointManager::sendWaypointRequestList()
 
     mavlink_msg_waypoint_request_list_encode(uas.mavlink->getSystemId(), uas.mavlink->getComponentId(), &message, &wprl);
     uas.sendMessage(message);
-    usleep(PROTOCOL_DELAY_MS * 1000);
+    MG::SLEEP::usleep(PROTOCOL_DELAY_MS * 1000);
 
     qDebug() << "sent waypoint list request to ID " << wprl.target_system;
 }
@@ -421,7 +421,7 @@ void UASWaypointManager::sendWaypointRequest(quint16 seq)
 
     mavlink_msg_waypoint_request_encode(uas.mavlink->getSystemId(), uas.mavlink->getComponentId(), &message, &wpr);
     uas.sendMessage(message);
-    usleep(PROTOCOL_DELAY_MS * 1000);
+    MG::SLEEP::usleep(PROTOCOL_DELAY_MS * 1000);
 
     qDebug() << "sent waypoint request (" << wpr.seq << ") to ID " << wpr.target_system;
 }
@@ -443,7 +443,7 @@ void UASWaypointManager::sendWaypoint(quint16 seq)
 
         mavlink_msg_waypoint_encode(uas.mavlink->getSystemId(), uas.mavlink->getComponentId(), &message, wp);
         uas.sendMessage(message);
-        usleep(PROTOCOL_DELAY_MS * 1000);
+        MG::SLEEP::usleep(PROTOCOL_DELAY_MS * 1000);
 
         qDebug() << "sent waypoint (" << wp->seq << ") to ID " << wp->target_system;
     }
@@ -460,7 +460,7 @@ void UASWaypointManager::sendWaypointAck(quint8 type)
 
     mavlink_msg_waypoint_ack_encode(uas.mavlink->getSystemId(), uas.mavlink->getComponentId(), &message, &wpa);
     uas.sendMessage(message);
-    usleep(PROTOCOL_DELAY_MS * 1000);
+    MG::SLEEP::usleep(PROTOCOL_DELAY_MS * 1000);
 
     qDebug() << "sent waypoint ack (" << wpa.type << ") to ID " << wpa.target_system;
 }