Create poseGraph.cpp