Navigating road junctions
A system for autonomously navigating a vehicle through a road junction may include at least one processor programmed to receive from an image capture device at least one image representative of an environment of the vehicle. The processor may also be configured to analyze the image to identify two or more landmarks located in the environment of the vehicle and to determine, for each of the two or more landmarks, a directional indicator relative to the vehicle. The processor may be configured to determine a current location of the vehicle relative to the road junction based on an intersection of the directional indicators a heading for the vehicle based on the directional indicators for the two or more landmarks. The processor may be configured to determine a steering angle for the vehicle by comparing the vehicle heading with a predetermined road model trajectory at the current location of the vehicle.
1. A system for autonomously navigating a vehicle through a road junction, the system comprising:
at least one processor comprising circuitry and a memory, wherein the memory includes instructions that when executed by the circuitry cause the at least one processor to:
receive at least one image acquired by an image capture device, the at least one image being representative of an environment of the vehicle;
analyze the at least one image to identify two or more landmarks located in the environment of the vehicle;
determine a first directional indicator relative to the vehicle, the first directional indicator being a vector extending from the vehicle towards a first landmark;
determine a second directional indicator relative to the vehicle, the second directional indicator being a vector extending from the vehicle towards a second landmark;
determine a current location of the vehicle relative to the road junction as an intersection point of the first directional indicator and the second directional indicator;
determine a heading for the vehicle based on the directional indicators for the two or more landmarks;
determine a direction of a predetermined road model trajectory at the current location of the vehicle, wherein the predetermined road model trajectory represents a target vehicle path along a road segment and an elevation change associated with the target vehicle path; and
determine a steering angle for the vehicle based on aligning the vehicle heading with the direction of the predetermined road model trajectory at the current location of the vehicle.
2. The system of claim 1 , wherein the predetermined road model trajectory includes a three-dimensional polynomial representation of a target trajectory along the road segment.
3. The system of claim 1 , wherein the memory includes instructions that when executed by the circuitry cause the at least one processor to determine a third directional indicator for a third landmark.
4. The system of claim 1 , wherein the memory includes instructions that when executed by the circuitry cause the at least one processor to transmit a control signal specifying the steering angle to a steering system of the vehicle.
5. The system of claim 1 , wherein the memory includes instructions that when executed by the circuitry cause the at least one processor to retrieve the predetermined road model trajectory from a database included in the vehicle.
6. The system of claim 1 , wherein the memory includes instructions that when executed by the circuitry cause the at least one processor to retrieve the predetermined road model trajectory from a database accessible to the vehicle over a wireless communications interface.
7. The system of claim 1 , wherein the image capture device is included in the vehicle.
8. The system of claim 1 , wherein the memory includes instructions that when executed by the circuitry cause the at least one processor to determine the heading for the vehicle by:
determining a previous location of the vehicle relative to the road junction based on the intersection point of the first directional indicator and the second directional indicator; and
determining the heading based on the previous location and the current location.
9. A vehicle, comprising:
a body;
at least one image capture device; and
at least one processor comprising circuitry and a memory, wherein the memory includes instructions that when executed by the circuitry cause the at least one processor to:
receive at least one image acquired by the at least one image capture device, the at least one image being representative of an environment of the vehicle;
analyze the at least one image to identify two or more landmarks located in the environment of the vehicle;
determine a first directional indicator relative to the vehicle, the first directional indicator being a vector extending from the vehicle towards a first landmark;
determine a second directional indicator relative to the vehicle, the second directional indicator being a vector extending from the vehicle towards a second landmark;
determine a current location of the vehicle relative to the road junction as an intersection point of the first directional indicator and the second directional indicator;
determine a heading for the vehicle based on the directional indicators for the two or more landmarks;
determine a direction of a predetermined road model trajectory at the current location of the vehicle, wherein the predetermined road model trajectory represents a target vehicle path along a road segment and an elevation change associated with the target vehicle path; and
determine a steering angle for the vehicle based on aligning the vehicle heading with the direction of the predetermined road model trajectory at the current location of the vehicle.
10. The vehicle of claim 9 , wherein the predetermined road model trajectory includes a three-dimensional polynomial representation of a target trajectory along the road segment.
11. The vehicle of claim 9 , wherein the memory includes instructions that when executed by the circuitry cause the at least one processor to determine a third directional indicator for a third landmark.
12. The vehicle of claim 9 , wherein the memory includes instructions that when executed by the circuitry cause the at least one processor to transmit a control signal specifying the steering angle to a steering system of the vehicle.
13. The vehicle of claim 9 , wherein the predetermined road model trajectory is retrieved from at least one of a database included in the vehicle or a database accessible to the vehicle over a wireless communications interface.
14. The vehicle of claim 9 , wherein the memory includes instructions that when executed by the circuitry cause the at least one processor to determine a heading for the vehicle by:
determining a previous location of the vehicle relative to the road junction based on the intersection point of the first directional indicator and the second directional indicator; and
determining the heading based on the previous location and the current location.
15. A method of navigating a vehicle, comprising:
receiving at least one image acquired by an image capture device, the at least one image being representative of an environment of the vehicle;
analyzing, using at least one processor, the at least one image to identify two or more landmarks located in the environment of the vehicle;
determining a first directional indicator relative to the vehicle, the first directional indicator being a vector extending from the vehicle towards a first landmark;
determining a second directional indicator relative to the vehicle, the second directional indicator being a vector extending from the vehicle towards a second landmark;
determining a current location of the vehicle relative to the road junction as an intersection point of the first directional indicator and the second directional indicator;
determining a heading for the vehicle based on the directional indicators for the two or more landmarks;
determining a direction of a predetermined road model trajectory at the current location of the vehicle, wherein the predetermined road model trajectory represents a target vehicle path along a road segment and an elevation change associated with the target vehicle path; and
determining a steering angle for the vehicle based on aligning the vehicle heading with the direction of the predetermined road model trajectory at the current location of the vehicle.
16. The method of claim 15 , wherein the predetermined road model trajectory includes a three-dimensional polynomial representation of a target trajectory along the road segment.
17. The method of claim 15 , further including retrieving the predetermined road model trajectory from at least one of a database included in the vehicle or a database accessible to the vehicle over a wireless communications interface.
18. The method of claim 15 , further including transmitting a control signal specifying the steering angle to a steering system of the vehicle.
19. The method of claim 15 , wherein determining the heading for the vehicle further includes:
determining a previous location of the vehicle relative to the road junction based on the intersection point of the first directional indicator and the second directional indicator; and
determining the heading based on the previous location and the current location.
20. A non-transitory computer readable medium containing instructions that, when executed by at least one processor, cause the at least one processor to perform operations comprising:
receiving at least one image acquired by an image capture device, the at least one image being representative of an environment of a vehicle;
analyzing the at least one image to identify two or more landmarks located in the environment of the vehicle;
determining a first directional indicator relative to the vehicle, the first directional indicator being a vector extending from the vehicle towards a first landmark;
determining a second directional indicator relative to the vehicle, the second directional indicator being a vector extending from the vehicle towards a second landmark;
determining a current location of the vehicle relative to a road junction as an intersection point of the first directional indicator and the second directional indicator;
determining a heading for the vehicle based on the directional indicators for the two or more landmarks;
determining a direction of a predetermined road model trajectory at the current location of the vehicle, wherein the predetermined road model trajectory represents a target vehicle path along a road segment and an elevation change associated with the target vehicle path; and
determining a steering angle for the vehicle based on aligning the vehicle heading with the direction of the predetermined road model trajectory at the current location of the vehicle.