Codes from course "Artificial Intelligence for Robotics" from http://www.udacity.com