Computational Principles of Mobile Robotics. Gregory Dudek, Michael Jenkin