An object is to provide a vehicle position determination device, a vehicle control system, a vehicle position determination method, and a vehicle position determination program capable of determining a position of a vehicle with higher accuracy. A vehicle position determination device includes a coordinates acquisition unit that acquires a position of a vehicle in a geographic coordinate system, a recognition unit that acquires lane information of a road on which the vehicle travels and recognizes the position of the vehicle on the lane, and a control unit that corrects the position acquired by the coordinates acquisition unit on the basis of the position recognized by the recognition unit, and determines the position of the vehicle in the geographic coordinate system.
Legal claims defining the scope of protection, as filed with the USPTO.
1. A vehicle position determination device, comprising: a hardware processor configured to control: a coordinates acquisition unit that acquires a position of a vehicle determined in a geographic coordinate system on the basis of information acquired from radio waves coming from a satellite; a recognition unit that acquires lane information of a road on which the vehicle travels and recognizes the position of the vehicle on the lane; and a control unit that derives a required correction amount on the basis of a comparison of the position acquired by the coordinates acquisition unit with the position recognized by the recognition unit, and corrects the position acquired by the coordinates acquisition unit on the basis of the derived required correction amount, and determines the position of the vehicle in the geographic coordinate system, wherein the control unit weights one or both of the position acquired by the coordinates acquisition unit and the position recognized by the recognition unit to derive the required correction amount on the basis of accuracy according to determination of the position acquired by the coordinates acquisition unit, wherein when the accuracy is lower than a threshold value, the control unit causes a weight of the position acquired by the coordinates acquisition unit to be greater than a weight of the position recognized by the recognition unit, wherein when the accuracy is equal to or higher than a threshold value, the control unit causes a weight of the position acquired by the coordinates acquisition unit to be smaller than a weight of the position recognized by the recognition unit, and wherein the weight of the position recognized by the recognition unit is changed by an amount corresponding to the change in the weight of the position acquired by the coordinate acquisition unit.
2. The vehicle position determination device according to claim 1 , wherein the recognition unit recognizes a division line of a road included in an image obtained by imaging the road on which the vehicle travels, and recognizes a relative position of the vehicle relative to the recognized division line, the control unit derives a first deviation between a reference position of the road of which the division line is recognized by the recognition unit and the position acquired by the coordinates acquisition unit, and a second deviation between the reference position and the position recognized by the recognition unit, and derives the required correction amount on the basis of a difference between the first deviation and the second deviation that are derived.
3. The vehicle position determination device according to claim 2 , wherein the reference position is a lane center, the first deviation is a distance from a lane center of the road of which the division line is recognized by the recognition unit to the position acquired by the coordinates acquisition unit, and the second deviation is a distance from the lane center of the road of which the division line is recognized by the recognition unit to the position recognized by the recognition unit.
4. The vehicle position determination device according to claim 3 , wherein the control unit weights one or both of the position acquired by the coordinates acquisition unit and the position recognized by the recognition unit to derive the required correction amount on the basis of accuracy according to determination of the position acquired by the coordinates acquisition unit.
5. The vehicle position determination device according to claim 2 , wherein the control unit weights one or both of the position acquired by the coordinates acquisition unit and the position recognized by the recognition unit to derive the required correction amount on the basis of accuracy according to determination of the position acquired by the coordinates acquisition unit.
6. The vehicle position determination device according to claim 1 , further comprising: a trajectory generation unit that generates a trajectory including a plurality of future target positions to be reached by the vehicle, the target positions being continuous in time series in a traveling direction of the vehicle from the position acquired by the coordinates acquisition unit, wherein the control unit derives a first deviation between a predetermined target position among the target positions included in the trajectory generated by the trajectory generation unit and the position acquired by the coordinates acquisition unit, and a second deviation between the predetermined target position and the position recognized by the recognition unit, and derives the required correction amount on the basis of a difference between the first deviation and the second deviation.
7. The vehicle position determination device according to claim 6 , wherein the first deviation is a distance that is a sum of a distance from the lane center of the road of which the division line is recognized by the recognition unit to the predetermined target position and a distance from the lane center of the road of which the division line is recognized by the recognition unit to the position acquired by the coordinates acquisition unit, and the second deviation is a distance from the predetermined target position to the position recognized by the recognition unit.
8. The vehicle position determination device according to claim 7 , wherein the control unit weights one or both of the position acquired by the coordinates acquisition unit and the position recognized by the recognition unit to derive the required correction amount on the basis of accuracy according to determination of the position acquired by the coordinates acquisition unit.
9. The vehicle position determination device according to claim 6 , wherein the control unit weights one or both of the position acquired by the coordinates acquisition unit and the position recognized by the recognition unit to derive the required correction amount on the basis of accuracy according to determination of the position acquired by the coordinates acquisition unit.
10. The vehicle position determination device according to claim 1 , wherein the control unit derives a movement amount required when the vehicle travels for a predetermined time or a predetermined distance from the position acquired by the coordinates acquisition unit, as the required correction amount.
11. The vehicle position determination device according to claim 10 , wherein the control unit repeatedly executes deriving a movement amount required when the vehicle travels for a predetermined time or a predetermined distance from the corrected position, as a required correction amount, and then further correcting the corrected position with the derived movement amount.
12. The vehicle position determination device according to claim 10 , wherein the movement amount includes some or all of a movement amount in a traveling direction of the vehicle, a movement amount in a vehicle width direction of the vehicle, and a rotational movement amount in a yaw angle direction of the vehicle.
13. The vehicle position determination device according to claim 10 , wherein the control unit weights one or both of the position acquired by the coordinates acquisition unit and the position recognized by the recognition unit to derive the required correction amount on the basis of accuracy according to determination of the position acquired by the coordinates acquisition unit.
14. A vehicle control system, comprising: a hardware processor configured to control: a coordinates acquisition unit that acquires a position of a vehicle in a geographic coordinate system; a recognition unit that acquires lane information of a road on which the vehicle travels and recognizes the position of the vehicle on the lane; a trajectory generation unit that generates a trajectory including a plurality of future target positions to be reached by the vehicle, the target positions being continuous in time series in a traveling direction of the vehicle from the position acquired by the coordinates acquisition unit, an automated drive control unit that automatically performs at least one of speed control and steering control of the vehicle on the basis of the trajectory generated by the trajectory generation unit; and a control unit that derives a required correction amount of the position acquired by the coordinates acquisition unit on the basis of one or both of the position recognized by the recognition unit and a target position included in the trajectory generated by the trajectory generation unit, and determines the position of the vehicle in the geographic coordinate system, wherein the control unit weights one or both of the position acquired by the coordinates acquisition unit and the position recognized by the recognition unit to derive the required correction amount on the basis of accuracy according to determination of the position acquired by the coordinates acquisition unit, wherein when the accuracy is lower than a threshold value, the control unit causes a weight of the position acquired by the coordinates acquisition unit to be greater than a weight of the position recognized by the recognition unit, wherein when the accuracy is equal to or higher than a threshold value, the control unit causes a weight of the position acquired by the coordinates acquisition unit to be smaller than a weight of the position recognized by the recognition unit, and wherein the weight of the position recognized by the recognition unit is changed by an amount corresponding to the change in the weight of the position acquired by the coordinate acquisition unit.
15. A vehicle position determination method, wherein a vehicle-mounted computer acquires a position of a vehicle in a geographic coordinate system, acquires lane information of a road on which the vehicle travels, recognizes the position of the vehicle on the lane, derives a required correction amount on the basis of a comparison of the position acquired unit with the position recognized, and corrects the position acquired on the basis of the derived required correction amount to determine the position of the vehicle in the geographic coordinate system, weights one or both of the position acquired and the position recognized to derive the required correction amount on the basis of accuracy according to determination of the position acquired, when the accuracy is lower than a threshold value, causes a weight of the position acquired to be greater than a weight of the position recognized, when the accuracy is equal to or higher than a threshold value, causes a weight of the position acquired to be smaller than a weight of the position recognized, and the weight of the position recognized is changed by an amount corresponding to the change in the weight of the position acquired.
16. A vehicle position determination program product comprising a non-transitory computer usable medium having control logic stored therein for causing a vehicle-mounted computer to: acquire a position of a vehicle in a geographic coordinate system, acquire lane information of a road on which the vehicle travels, recognize the position of the vehicle on the lane, derives a required correction amount on the basis of a comparison of the position acquired unit with the position recognized, and corrects the position acquired on the basis of the derived required correction amount to determine the position of the vehicle in the geographic coordinate system, weights one or both of the position acquired and the position recognized to derive the required correction amount on the basis of accuracy according to determination of the position acquired, when the accuracy is lower than a threshold value, causes a weight of the position acquired to be greater than a weight of the position recognized, when the accuracy is equal to or higher than a threshold value, causes a weight of the position acquired to be smaller than a weight of the position recognized, and the weight of the position recognized is changed by an amount corresponding to the change in the weight of the position acquired.
Cooperative Patent Classification codes for this invention. Click any code to explore related patents in that topic.
May 5, 2017
April 2, 2019
Browse 5M+ US patents with plain-English claim translations and AI-generated analysis.