摘要 |
A path planning unit plans a travel path to a destination based on an estimated current travel position and outputs a travel command to a travel control unit to perform travel control so as to follow the travel path. A travel position prediction unit accumulates a travel distance, which is detected by a wheel turning-angle sensor, to the estimated current travel position so as to predict the current travel position. A predictive image generating unit generates a plurality of predictive edge images which are composed of edge information and captured when a camera is virtually disposed at the predicted current travel position and candidate positions in the vicinity of it based on layout information of the environment, and an edge image generating unit generates an actual edge image from the actual image captured by the camera. A position estimation unit compares the edge image with the plurality of predictive edge images, estimates the candidate position of the predictive edge image at which the degree of similarity is the maximum, and updates the travel position of the path planning unit and the travel position prediction unit.
|