Robot motion planning and control - Brady, Michael 1945- (MIT Press, 1982)