From 7f8e478d71f04c9d925928f46ac3fbd041dd617b Mon Sep 17 00:00:00 2001
From: Johannes Mey <johannes.mey@tu-dresden.de>
Date: Thu, 13 May 2021 12:29:03 +0200
Subject: [PATCH] fix reachability again

---
 src/DummyConnector.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/src/DummyConnector.cpp b/src/DummyConnector.cpp
index 3bbe84a..2c98451 100644
--- a/src/DummyConnector.cpp
+++ b/src/DummyConnector.cpp
@@ -40,7 +40,7 @@ bool DummyConnector::reachableObject(const Object &robot, const Object &object)
     }
 
     // if the location is more than 750mm away from the robot base it is too far away
-    if (std::sqrt(dx*dx + dy*dy + dz+dz) > 0.75) {
+    if (std::sqrt(dx*dx + dy*dy + dz*dz) > 0.75) {
         return false;
     }
 
-- 
GitLab