add main class for slam
complete run with no optimization
graph optimization