Update visual_odometry.cpp

[robotLearner1]

When adding landmarks to the map, Z of landmarks should be queried in the current frame instead of the reference keyframe. experiment.pdf

[gaoxiang12]

Thanks for PR!