diff --git a/src/ui/HSIDisplay.cc b/src/ui/HSIDisplay.cc
index 6b61807d51e4009f3653c8a41c6f1d5cad04379e..7aed0c220f2d3781823c7e0398c8915e66de3134 100644
--- a/src/ui/HSIDisplay.cc
+++ b/src/ui/HSIDisplay.cc
@@ -910,13 +910,7 @@ void HSIDisplay::sendBodySetPointCoordinates()
     // Send the coordinates to the MAV
     if (uas)
     {
-        double dx = uiXSetCoordinate - uas->getLocalX();
-        double dy = uiYSetCoordinate - uas->getLocalY();
-        double dz = uiZSetCoordinate - uas->getLocalZ();
-        bool valid = (sqrt(dx*dx + dy*dy + dz*dz) < 200.0);//UASManager::instance()->isInLocalNEDSafetyLimits(uiXSetCoordinate, uiYSetCoordinate, uiZSetCoordinate);
-//        if (valid)
-//        {
-            uas->setLocalPositionSetpoint(uiXSetCoordinate, uiYSetCoordinate, uiZSetCoordinate, uiYawSet);
+        uas->setLocalPositionSetpoint(uiXSetCoordinate, uiYSetCoordinate, uiZSetCoordinate, uiYawSet);
     }
 }