Implementation of Factor Graph Slam for Class Project - View it on GitHub