add pose graph unit test for save/load vertex