lisp softewere for robot motion planning