Self-localization estimation device
A self-localization estimation device includes: a map-information acquisition unit that acquires map information including lane information for specifying lanes in which vehicles are enabled to travel; a position calculation unit that calculates an own-vehicle absolute position being an absolute position of an own vehicle in response to navigation signals received from a plurality of navigation satellites, the position calculation unit including a self-location measurement unit, a vehicle-momentum measurement unit, and dead reckoning unit; and a position estimation unit that estimates, based on the map information and the own-vehicle absolute position, a corrected own-vehicle position being a corrected position of the own vehicle. The position estimation unit estimates the corrected own-vehicle position by superimposing a reliability of the map information and a reliability of the own-vehicle absolute position on each other.
1. A self-localization estimation device comprising:
a map-information acquisition unit that acquires map information including lane information for specifying lanes in which vehicles are enabled to travel;
a position calculation unit that calculates an own-vehicle absolute position being an absolute position of an own vehicle; and
a position estimation unit that estimates, based on the map information and the own-vehicle absolute position, a corrected own-vehicle position being a corrected position of the own vehicle,
wherein:
the position estimation unit estimates the corrected own-vehicle position by comparing a reliability of the map information with a reliability of the own-vehicle absolute position.
2. The self-localization estimation device according to claim 1 , wherein the position estimation unit is configured to:
vary at least one of the reliability of the map information and the reliability of the own-vehicle absolute position to thereby change relative weights assigned to the respective map information and own-vehicle absolute position; and
estimate the corrected own-vehicle position based on the map information and the own-vehicle absolute position respectively having the changed relative weights.
3. The self-localization estimation device according to claim 2 , wherein
the position estimation unit is configured to vary the reliability of the map information by using a lane-change probability, the lane-change probability being a probability indicating a likelihood that the own vehicle moves from a current lane in which the own vehicle is currently travelling to another lane.
4. The self-localization estimation device according to claim 3 , wherein the position estimation unit is configured to:
maintain or reduce the reliability of the map information when the lane-change probability increases; and
increase the reliability of the map information when the lane-change probability decreases.
5. The self-localization estimation device according to claim 3 , wherein
the position estimation unit is configured to calculate the lane-change probability based on a lane divergence amount, the lane divergence amount being an amount of divergence of a travelling condition of the own vehicle with respect to information about how the current lane extends.
6. The self-localization estimation device according to claim 5 , wherein
the position estimation unit is configured to calculate the lane divergence amount based on at least one of:
an azimuth deviation being a difference between an azimuth of the current lane and an azimuth of a travelling direction of the own vehicle;
a yaw rate of the own vehicle;
a yaw angle of the own vehicle;
a steering angle of the own vehicle; and
Surrounding-environment information about a place where the own vehicle is currently travelling.
7. The self-localization estimation device according to claim 1 , wherein
the reliability of the map information is represented by a map-information probability distribution;
the reliability of the own-vehicle absolute position is represented by an own-vehicle-position probability distribution; and
the position estimation unit is configured to estimate the corrected own-vehicle position by comparing the map-information probability distribution with the own-vehicle-position probability distribution.
8. The self-localization estimation device according to claim 7 , wherein
the map-information probability distribution includes a probability distribution of a current lane in which the own vehicle is currently travelling or a lane center position.
9. The self-localization estimation device according to claim 1 , wherein
the position estimation unit is configured to:
obtain line-pattern information about at least one marking line acquired by a camera; and
reflect the line-pattern information on the estimation of the corrected own-vehicle position.
10. The self-localization estimation device according to claim 1 , wherein
the position estimation unit is configured to:
obtain surrounding-environment information item acquired by a camera; and
reflect the surrounding-environment information on the estimation of the corrected own-vehicle position.
11. The self-localization estimation device according to claim 1 , wherein
the position estimation unit is configured to reflect turn-signal information item on the estimation of the corrected own-vehicle position.
12. The self-localization estimation device according to claim 1 , wherein
the position estimation unit is configured to reflect a condition of a driver on the estimation of the corrected own-vehicle position.
13. The self-localization estimation device according to claim 1 , wherein
the position estimation unit is configured to reflect an operation by a driver on the estimation of the corrected own-vehicle position.
14. The self-localization estimation device according to claim 1 , wherein
the position estimation unit is configured to perform confidence-level adjustment control to reduce a confidence level of the corrected own-vehicle position in accordance with a correction amount by which the own-vehicle absolute position is corrected to the corrected own-vehicle position.
15. The self-localization estimation device according to claim 14 , wherein
the position estimation unit is configured to reduce the confidence level of the corrected own-vehicle position in accordance with a correction-amount integrated value that is the sum of previously used correction amounts.
16. The self-localization estimation device according to claim 15 , wherein
the position estimation unit is configured to initialize the correction-amount integrated value when the correction-amount integrated value does not exceed an integration threshold that is set in accordance with a predetermined elapsed time period.
17. The self-localization estimation device according to claim 15 , wherein
the position calculation unit is configured to:
calculate, as the own-vehicle absolute position used in the confidence-level adjustment control, a first own-vehicle absolute position using a first calculation method; and
calculate a second own-vehicle absolute position using a second calculation method different from the first calculation method; and
the position estimation unit is configured to initialize the correction-amount integrated value when the second own-vehicle absolute position and an own-vehicle position are different from each other,
the own-vehicle position being specified from the corrected own-vehicle position and from a predetermined confidence level around the corrected own-vehicle position.
18. The self-localization estimation device according to claim 14 , wherein
the position estimation unit is configured to maintain, in the confidence-level adjustment control:
a first corrected own-vehicle position that is set by correcting the own-vehicle absolute position by a first correction amount based on a first hypothesis; and
a second corrected own-vehicle position that is set by correcting the own-vehicle absolute position by a second correction amount based on a second hypothesis different from the first hypothesis.
19. The self-localization estimation device according to claim 18 , wherein
the position estimation unit is configured to reject the first corrected own-vehicle position or the second corrected own-vehicle position when a difference in a lateral direction between the first corrected own-vehicle position and the second corrected own-vehicle position does not exceed a lateral-direction threshold.
20. The self-localization estimation device according to claim 18 , wherein
the position calculation unit is configured to:
calculate, as the own-vehicle absolute position used in the confidence-level adjustment control, a first own-vehicle absolute position using a first calculation method; and
calculate a second own-vehicle absolute position using a second calculation method different from the first calculation method; and
the position estimation unit is configured to:
reject the first corrected own-vehicle position when the second own-vehicle absolute position and a first own-vehicle position are different from each other,
the first own-vehicle position being specified from the first corrected own-vehicle position and from a predetermined confidence level around the first corrected own-vehicle position; and
reject the second corrected own-vehicle position when the second own-vehicle absolute position and a second own-vehicle position are different from each other,
the second own-vehicle position being specified from the second corrected own-vehicle position and from a predetermined confidence level around the second corrected own-vehicle position.
21. The self-localization estimation device according to claim 18 , wherein
the position estimation unit is configured to start the confidence-level adjustment control when a lane-change probability exceeds a predetermined probability,
the lane-change probability being a probability indicating a likelihood that the own vehicle moves from a lane in which the own vehicle is currently travelling to another lane.