Finished factor graphs, started writing about gtsam