Computational Principles Of Mobile Robotics by Gregory Dudek