Algorithmic foundations of robotics - Goldberg, Ken (A.K. Peters, 1995)