pr2eus/test/pr2-ri-test-simple.l: add (send *ri* :wait-interpolation)…

… before (send *ri* :angle-vector-duration (send *ri* :state :potentio-vector) (send *pr2* :angle-vector) 5 1.0)
jsk-ros-pkg · Nov 17, 2021 · 37e44f7 · 37e44f7
1 parent 266b27d
commit 37e44f7
Showing 1 changed file with 1 addition and 0 deletions.
diff --git a/pr2eus/test/pr2-ri-test-simple.l b/pr2eus/test/pr2-ri-test-simple.l
@@ -40,6 +40,7 @@
     (setq *ri* (instance pr2-interface :init))
     (assert (send *pr2* :reset-pose))
     (assert (send *ri* :angle-vector (send *pr2* :angle-vector)))
+    (send *ri* :wait-interpolation)
     (assert (= (send *ri* :angle-vector-duration (send *ri* :state :potentio-vector) (send *pr2* :angle-vector) 5 1.0) 1))
     (send *pr2* :larm :shoulder-p :joint-angle 0)
     (setq tm (send *ri* :angle-vector-duration (send *ri* :state :potentio-vector) (send *pr2* :angle-vector) 5 1.0 :larm-controller))