diff --git a/pr2eus/test/pr2-ri-test.l b/pr2eus/test/pr2-ri-test.l index 140d1ffd7..9d0a6d161 100644 --- a/pr2eus/test/pr2-ri-test.l +++ b/pr2eus/test/pr2-ri-test.l @@ -1,13 +1,17 @@ (require :unittest "lib/llib/unittest.l") (load "package://pr2eus/pr2-interface.l") -(init-unit-test) - (setq *pr2* (pr2)) (while (or (not (boundp '*ri*)) (send *ri* :simulation-modep)) (setq *ri* (instance pr2-interface :init))) +(when (send *ri* :simulation-modep) + (ros::ros-warn "*ri* is running with simulation mode, something goes wrong ....") + (sys::exit 1)) + +(init-unit-test) + (deftest test-wait-interpolation (ros::ros-info "send reset-pose and wait-interpolation") (assert (send *pr2* :reset-pose))