Deduplicate destination points
This was causing all sorts of trama and wrist motion since destinations
are referenced by position.
Change-Id: Id09f7923e788ed82f840012300c05d32fea35a35
Signed-off-by: Austin Schuh <austin.linux@gmail.com>
diff --git a/y2023/control_loops/python/graph_paths.py b/y2023/control_loops/python/graph_paths.py
index 6c74a74..f7571a6 100644
--- a/y2023/control_loops/python/graph_paths.py
+++ b/y2023/control_loops/python/graph_paths.py
@@ -298,7 +298,7 @@
))
points['ScoreBackLowCube'] = to_theta_with_circular_index_and_roll(
- -1.102, 0.30, -np.pi / 2.0, circular_index=1)
+ -1.102, 0.3212121, -np.pi / 2.0, circular_index=1)
named_segments.append(
ThetaSplineSegment(