planning for robot motion 1355478