SYSTEM AND METHOD FOR CALIBRATING VEHICLE DYNAMICS EXPECTATIONS FOR AUTONOMOUS VEHICLE NAVIGATION AND LOCALIZATION
A system that performs a method is disclosed. While navigating a vehicle along a path, the system determines a starting point along the driving path, and monitors a vehicle trajectory, wherein the vehicle trajectory comprises odometry information. The system calculates an expected ending point of the vehicle trajectory using the starting point, the odometry information, and vehicle dynamics expectations, and determines whether there is a difference between the ending point and the expected ending point that is greater than a threshold distance. In response to the determination: in accordance with a determination that the difference between the ending point and the expected ending point is greater than the threshold distance, the system calibrates the vehicle dynamics expectations. In accordance with a determination that the difference between the ending point and the expected ending point is not greater than the threshold distance, the system foregoes calibrating the vehicle dynamics expectations.
1 . A system comprising:
one or more sensors;
one or more processors operatively coupled to the one or more sensors; and
a memory including instructions, which when executed by the one or more processors, cause the one or more processors to perform a method comprising:
while navigating a vehicle along a driving path:
determining a first starting point along the driving path via the one or more sensors;
monitoring a first vehicle trajectory from the first starting point to a first ending point via the one or more sensors, wherein the first vehicle trajectory comprises odometry information;
calculating a first expected ending point of the first vehicle trajectory using the first starting point, the odometry information, and one or more vehicle dynamics expectations;
determining whether there is a difference between the first ending point and the first expected ending point that is greater than a threshold distance; and
in response to the determination:
in accordance with a determination that the difference between the first ending point and the first expected ending point is greater than the threshold distance, calibrating the one or more vehicle dynamics expectations; and
in accordance with a determination that the difference between the first ending point and the first expected ending point is not greater than the threshold distance, foregoing calibrating the one or more vehicle dynamics expectations.
2 . The system of claim 1 , wherein:
navigating the vehicle along the driving path comprises calculating a set of instructions for performing automated driving maneuvers for navigating the vehicle along the driving path based in part on the one or more vehicle dynamics expectations, and
the method further comprises, in accordance with the determination that the difference between the first ending point and the first expected ending point is greater than the threshold distance, updating the set of instructions for performing the automated driving maneuvers for navigating the vehicle along the driving path based in part on the calibrated one or more vehicle dynamics expectations.
3 . The system of claim 1 , wherein:
monitoring the vehicle trajectory from the first starting point to the first ending point via the one or more sensors comprises determining the location of the first ending point via one or more GPS receivers, optical cameras, ultrasound sensors, radar sensors, LIDAR sensors, cellular positioning systems, and cloud services.
4 . The system of claim 1 , wherein the method further comprises:
localizing the vehicle based on one or more of heading information, a steering angle, wheel revolutions, and a second starting point, different from the first starting point.
5 . The system of claim 4 , wherein:
the one or more sensors comprises one or more GPS receivers, and the one or more GPS receivers are unavailable.
6 . The system of claim 1 , wherein:
monitoring the vehicle trajectory from the first starting point to the first ending point via the one or more sensors comprises monitoring external information.
7 . The system of claim 6 , wherein the external information is received from one or more of another vehicle and an internet source.
8 . The system of claim 6 , wherein the external information comprises one or more of weather information and map information.
9 . The system of claim 8 , wherein calibrating the one or more vehicle dynamics expectations incorporates the one or more of weather information and map information.
10 . The system of claim 1 , wherein the method further comprises:
determining a second starting point, different from the first starting point, along the driving path via the one or more sensors;
monitoring a second vehicle trajectory from the second starting point to a second ending point, different from the first ending point, via the one or more sensors;
calculating a second expected ending point of the second vehicle trajectory using the second starting point, the odometry information, and the one or more vehicle dynamics expectations;
determining whether there is a difference between the second ending point and the second expected ending point that is greater than the threshold distance; and
in response to the determination:
in accordance with a determination that the difference between the second ending point and the second expected ending point is greater than the threshold distance, calibrating the one or more vehicle dynamics expectations; and
in accordance with a determination that the difference between the second ending point and the second expected ending point is not greater than the threshold distance, foregoing calibrating the one or more vehicle dynamics expectations.
11 . The system of claim 10 , wherein the one or more vehicle dynamics expectations have been calibrated at least once.
12 . A vehicle comprising:
one or more sensors;
one or more processors coupled to the one or more sensors; and
a memory including instructions, which when executed by the one or more processors, cause the one or more processors to perform a method comprising:
while navigating the vehicle along a driving path:
determining a first starting point along the driving path via the one or more sensors;
monitoring a first vehicle trajectory from the first starting point to a first ending point via the one or more sensors, wherein the first vehicle trajectory comprises odometry information;
calculating a first expected ending point of the first vehicle trajectory using the first starting point, the odometry information, and one or more vehicle dynamics expectations;
determining whether there is a difference between the first ending point and the first expected ending point that is greater than a threshold distance; and
in response to the determination:
in accordance with a determination that the difference between the first ending point and the first expected ending point is greater than the threshold distance, calibrating the one or more vehicle dynamics expectations; and
in accordance with a determination that the difference between the first ending point and the first expected ending point is not greater than the threshold distance, foregoing calibrating the one or more vehicle dynamics expectations.
13 . The vehicle of claim 12 , wherein:
navigating the vehicle along the driving path comprises calculating a set of instructions for performing automated driving maneuvers for navigating the vehicle along the driving path based in part on the one or more vehicle dynamics expectations, and
the method further comprises, in accordance with the determination that the difference between the first ending point and the first expected ending point is greater than the threshold distance, updating the set of instructions for performing the automated driving maneuvers for navigating the vehicle along the driving path based in part on the calibrated one or more vehicle dynamics expectations.
14 . A method comprising:
while navigating a vehicle along a driving path:
determining a first starting point along the driving path via one or more sensors;
monitoring a first vehicle trajectory from the first starting point to a first ending point via the one or more sensors, wherein the first vehicle trajectory comprises odometry information;
calculating a first expected ending point of the first vehicle trajectory using the first starting point, the odometry information, and one or more vehicle dynamics expectations;
determining whether there is a difference between the first ending point and the first expected ending point that is greater than a threshold distance; and
in response to the determination:
in accordance with a determination that the difference between the first ending point and the first expected ending point is greater than the threshold distance, calibrating the one or more vehicle dynamics expectations; and
in accordance with a determination that the difference between the first ending point and the first expected ending point is not greater than the threshold distance, foregoing calibrating the one or more vehicle dynamics expectations.
15 . The method of claim 14 , wherein:
navigating the vehicle along the driving path comprises calculating a set of instructions for performing automated driving maneuvers for navigating the vehicle along the driving path based in part on the one or more vehicle dynamics expectations, and
the method further comprises, in accordance with the determination that the difference between the first ending point and the first expected ending point is greater than the threshold distance, updating the set of instructions for performing the automated driving maneuvers for navigating the vehicle along the driving path based in part on the calibrated one or more vehicle dynamics expectations.