fix broadcasting bug for scalar/vector case

petercorke · petercorke · commit 02255240bb45 · 2023-03-28T21:07:04.000+10:00
diff --git a/spatialmath/base/vectors.py b/spatialmath/base/vectors.py
@@ -645,7 +645,7 @@ def angdiff(a, b=None):
     a = getvector(a)
     if b is not None:
         b = getvector(b)
-        a -= b
+        a = a - b  # cannot use -= here, numpy wont broadcast
 
     return np.mod(a + math.pi, 2 * math.pi) - math.pi
 
