摘要 |
PURPOSE:To enable map matching which is tolerant to local disturbance by extracting track data which are obtained from a vehicle speed sensor and an azimuth sensor by a quantity corresponding to a vehicle speed, performing the final-stage arithmetic of DP matching with candidate courses according to road data, and selecting and displaying an estimated travel position with small uncertainty. CONSTITUTION:A travel azimuth angle is found from the data from the vehicle speed sensor 9 and azimuth sensor 10 and inputted to a DP(Dynamic Programming) arithmetic means 15, and the current coordinates are inputted to an equal- interval road azimuth calculating means 12 at the same time. The equal-interval road azimuth calculating means 12 reads a road table 6 to find the point closest to the input current position coordinates on a road as travel start point coordinates. Then the equal-interval road azimuth calculating means 12 finds the road azimuth angle of each point at an equal distance and sends it to a road azimuth data file 13, and also sends the coordinates of points at the equal distance to a road coordinate data file 14. The DP arithmetic means 15 finds the lowest cost and outputs it to a minimum cost file 16. Consequently, the map matching which is tolerant to local disturbance is performed. |