Introduction to AI robotics - Murphy, Robin R. (MIT Press, 2000)