Raise error if joints goals list for goto_joints does not have the ri…

…ght size.
pollen-robotics · Dec 19, 2023 · 6774545 · 6774545
1 parent 24eedff
commit 6774545
Showing 1 changed file with 3 additions and 0 deletions.
diff --git a/src/reachy2_sdk/arm.py b/src/reachy2_sdk/arm.py
@@ -405,6 +405,9 @@ def goto_joints(
         Given a list of joint positions (exactly 7 joint positions),
         it will move the arm to that position.
         """
+        if len(positions) != 7:
+            raise ValueError(f"positions should be length 7 (got {len(positions)} instead)!")
+
         arm_pos = self._list_to_arm_position(positions, degrees)
         request = GoToRequest(
             joints_goal=JointsGoal(