✨

selflocalization/camera.py

@@ -309,10 +309,7 @@ class Camera(object):
 
 
         if not isinstance(self.ids, type(None)):
-            dists = np.zeros(len(self.tvects), dtype=self.tvecs.dtype)
-            for i, tvec in enumerate(self.tvecs):
-                dists[i] = np.sqrt(tvec[0][0]**2 + tvec[0][2]**2)
-
+            dists = np.linalg.norm(self.tvecs, axis=len(self.tvecs.shape) - 1) * 100
             # Make sure we always return properly shaped arrays
             dists = dists.reshape((dists.shape[0],))
             ids = self.ids.reshape((self.ids.shape[0],))