Update poseGraph.h