Robot motion planning and control (MIT Pr., 1982)