More work on reflexxes
It now works with one robot, but two robots does not work because
reflexxes needs to know the curren tvelocity of the robot, which is not
set in the path.