Artificial Intelligence for Robotics, Problem Set 1: Localization program