:wait-interpolation-smooth returns results of :interpolatingp of cont…

…rollers on real robot

pr2eus/robot-interface.l

@@ -644,7 +644,8 @@ Return value is a list of interpolatingp for all controllers, so (null (some #'i
           (send self :spin-once) ;; need to wait for feedback
           (send self :ros-wait 0.005))))
     (while (null (send self :interpolating-smoothp time-to-finish ctype))
-      (send self :ros-wait 0.005)))
+      (send self :ros-wait 0.005))
+    (send-all controller-actions :interpolatingp))
   (:interpolating-smoothp (time-to-finish &optional (ctype)) ;; controller-type
 "Check if the last sent motion will stop for next time-to-finish [msec]"
    (when (send self :simulation-modep)