GPS has its weaknesses in reality. This paper introduces vision measurement for the GPS system. Through feature detection, stereo matching, feature tracking and motion estimation to 3D drawings, GPS is able to get an accurate location and an estimation of direction with less error. Experiment has proved that vision measurement can be applied into navigation in the steep and rugged terrain. The improved GPS system is more accurate and can be put into practice in vaster areas. © 2016 SERSC.