End of Lab commit, begun to develop mapping and navigation