Vehicle position estimation device and vehicle position estimation method
An object of the present invention is to obtain a host vehicle position estimation device capable of estimating a highly reliable traveling road. The present invention relates to a host vehicle position estimation device ( 100 ) that estimates a position on a map of a host vehicle using information of an autonomous navigation position calculated based on vehicle information ( 102 ) and output of an inertial sensor ( 101 ), and information of a positioning position acquired from a positioning satellite, and corrects the autonomous navigation position to a position of a road on the map at predetermined travel distance intervals when the information of the positioning position is unavailable. The host vehicle position estimation device ( 100 ) includes a correction determination unit ( 12 ) that determines whether or not to perform the correction based on a position and an orientation of the host vehicle traveling on the road.
1. A vehicle comprising:
a map;
one or more sensors configured to generate information associated with a vehicle position of the vehicle on the map; and
one or more processors coupled to the one or more sensors, the one or more processors configured to:
combine the information from the one or more sensors to determine first sensor information indicative of a change in behavior of the vehicle,
receive second sensor information from the one or more sensors indicative of an absolute position of the vehicle, wherein the information comprises the second sensor information,
combine the information from the one or more sensors to determine third sensor information indicative of a traveling state of the vehicle with respect to a traveling lane, the vehicle traveling on the traveling lane,
determine map information from the map, the map information indicative of a road on which the vehicle is travelling,
after determining that the second sensor information is available, estimate the vehicle position on the map using the first sensor information, the second sensor information, and the map information, and
after determining that the second sensor information is unavailable, determine whether a correction condition of the vehicle is satisfied,
after determining that the correction condition is satisfied:
calculate a quadratic function indicating a change in a shape of lane markings of the traveling lane using the third sensor information,
calculate an amount of lateral parallel deviation of the vehicle from a center line of the traveling lane using the third sensor information,
calculate a difference between a traveling direction of the traveling lane and a traveling direction of the vehicle using the third sensor information,
correct the vehicle position and traveling direction on the map based on the quadratic function, the amount of lateral parallel deviation, and the difference, and
estimate the vehicle position on the map using the corrected vehicle position, the first sensor information, and the third sensor information,
after determining that the correction condition is not satisfied, estimate the vehicle position on the map using at least the first sensor information and the third sensor information,
generate a travel route using at least the estimated vehicle position on the map, and
control the vehicle to travel along the generated travel route.
2. A vehicle position estimation method comprising:
combining, by one or more processors, information from one or more sensors to determine first sensor information indicative of a change in behavior of the vehicle;
receiving, by the one or more processors, second sensor information from the one or more sensors indicative of an absolute position of a vehicle;
combining, by one or more processors, information from the one or more sensors to determine third sensor information indicative of a traveling state of the vehicle with respect to a traveling lane, the vehicle traveling on the traveling lane;
determining, by the one or more processors, map information from a map stored by the vehicle, the map information indicative of a road on which the vehicle is traveling;
after determining that the second sensor information is available, estimating, by the one or more processors, a vehicle position on the map using the first sensor information, the second sensor information, and the map information;
after determining that the second sensor information is unavailable, determining, by the one or more processors, whether a correction condition of the vehicle is satisfied;
after determining that the correction condition is satisfied:
calculating, by the one or more processors a quadratic function indicating a change in a shape of lane markings of the traveling lane using the third sensor information,
calculating, by the one or more processors, an amount of lateral parallel deviation of the vehicle from a center line of the traveling lane using the third sensor information,
calculating, by the one or more processors, a difference between a traveling direction of the traveling lane and a traveling direction of the vehicle using the third sensor information,
correcting, by the one or more processors, the vehicle position and traveling direction on the map based on the quadratic function, the amount of lateral parallel deviation, and the difference, and
estimating, by the one or more processors, the vehicle position on the map using the corrected vehicle position, the first sensor information, and the third sensor information,
after determining that the correction condition is not satisfied, estimating, by the one or more processors, the vehicle position on the map using at least the first sensor information and the third sensor information;
generating, by the one or more processors, a travel route using at least the estimated vehicle position on the map; and
controlling, by the one or more processors, the vehicle to travel along the generated travel route.