Project for Introduction to Sensing and Estimation in Robotics - View it on GitHub