Using Point3 where it should be Pose3

[JasonGibson274]

estimation/src/FactorGraphEstimatorLib/FactorGraphEstimator.cpp

Line 957 in e45f7a9

current_state_guess_->insert(G(index_), Point3(E,N,U));