Estimating road grade for inertial measurement unit calibration in an unmapped environment
The subject disclosure relates to estimating a grade of a road and calibrating sensors of an autonomous vehicle based on the grade. A process of the disclosed technology can include effectuating an autonomous vehicle to perform one or more maneuvers that cause the autonomous vehicle to face different directions along a road, obtaining a first set of sensor measurements of an autonomous vehicle in a first pose, wherein the first set of sensor measurements includes a first measured specific force, obtaining a second set of sensor measurements of the autonomous vehicle in a second pose, wherein the second set of sensor measurements includes a second measured specific force, determining a direction of gravity based on the first measured specific force and the second measured specific force, and calibrating at least one sensor of the autonomous vehicle based on the determined direction of gravity.
1. A computer-implemented method comprising:
effectuating an autonomous vehicle to perform one or more maneuvers that cause the autonomous vehicle to face different directions along a road;
obtaining a first set of sensor measurements of the autonomous vehicle in a first pose, wherein the first set of sensor measurements includes a first measured specific force, wherein the first measured specific force is calculated as the sum of a specific force while the autonomous vehicle is stationary and an acceleration bias, wherein the specific force while the autonomous vehicle is stationary is calculated based on a gravitational constant value and an angle associated with a light detection and ranging sensor odometry pitch;
obtaining a second set of sensor measurements of the autonomous vehicle in a second pose, wherein the second set of sensor measurements includes a second measured specific force;
determining a direction of gravity based on the first measured specific force and the second measured specific force; and
calibrating at least one sensor of the autonomous vehicle based on the determined direction of gravity.
2. The computer-implemented method of claim 1 , further comprising:
determining an angle of the road in relation to the direction of gravity based on the first measured specific force and the second measured specific force.
3. The computer-implemented method of claim 1 , wherein the first pose is in a first segment of the road and the second pose is in a second segment of the road.
4. The computed-implemented method of claim 3 , further comprising:
selecting the first segment and the second segment for measuring the first set of sensor measurements and the second set of sensor measurements respectively.
5. The computer-implemented method of claim 4 , wherein the first segment and the second segment are selected based on a distance between the first segment and the second segment.
6. The computer-implemented method of claim 4 , wherein the first segment and the second segment are selected using a cost function based on distance between the first segment and the second segment and differences in direction between the first segment and the second segment.
7. The computer-implemented method of claim 4 , wherein the first segment and the second segment are selected based on directions that the autonomous vehicle is facing at the first segment and the second segment.
8. The computer-implemented method of claim 1 , wherein the autonomous vehicle faces a first direction in the first pose and the autonomous vehicle faces a second direction in the second pose.
9. The computer-implemented method of claim 1 , wherein determining the direction of gravity includes deriving a roll angle of the autonomous vehicle.
10. The computer-implemented method of claim 1 , wherein determining the direction of gravity includes deriving a pitch angle of the autonomous vehicle.
11. A non-transitory computer readable medium comprising instructions, the instructions, when executed by a computing system, cause the computing system to:
effectuate an autonomous vehicle to perform one or more maneuvers that cause the autonomous vehicle to face different directions along a road;
obtain a first set of sensor measurements of the autonomous vehicle in a first pose, wherein the first set of sensor measurements includes a first measured specific force, wherein the first measured specific force is calculated as the sum of a specific force while the autonomous vehicle is stationary and an acceleration bias, wherein the specific force while the autonomous vehicle is stationary is calculated based on a gravitational constant value and an angle associated with a road plane and a navigational plane;
obtain a second set of sensor measurements of the autonomous vehicle in a second pose, wherein the second set of sensor measurements includes a second measured specific force; and
determine a direction of gravity based on the first measured specific force and the second measured specific force.
12. The computer readable medium of claim 11 , wherein the computer readable medium further comprises instructions that, when executed by the computing system, cause the computing system to:
determine an angle of the road in relation to the direction of gravity based on the first measured specific force and the second measured specific force.
13. The computer readable medium of claim 11 , wherein the computer readable medium further comprises instructions that, when executed by the computing system, cause the computing system to:
calibrate at least one sensor of the autonomous vehicle based on the determined direction of gravity.
14. The computer readable medium of claim 11 , wherein the autonomous vehicle faces a first direction in the first pose and the autonomous vehicle faces a second direction in the second pose.
15. The computer readable medium of claim 11 , wherein determining the direction of gravity includes deriving a roll angle of the autonomous vehicle.
16. A system comprising:
a storage configured to store instructions; and
a processor configured to execute the instructions and cause the processor to:
effectuate an autonomous vehicle to perform one or more maneuvers that cause the autonomous vehicle to face different directions along a road;
obtain a first set of sensor measurements of the autonomous vehicle in a first pose, wherein the first set of sensor measurements includes a first measured specific force, wherein the first measured specific force is calculated as the sum of a specific force while the autonomous vehicle is stationary and an acceleration bias, wherein the specific force while the autonomous vehicle is stationary is calculated based on a gravitational constant value and an angle associated with a road plane and a navigational plane;
obtain a second set of sensor measurements of the autonomous vehicle in a second pose, wherein the second set of sensor measurements includes a second measured specific force;
determine a direction of gravity based on the first measured specific force and the second measured specific force; and
calibrate at least one sensor of the autonomous vehicle based on the determined direction of gravity.
17. The system of claim 16 , wherein the processor is configured to execute the instructions and cause the processor to:
determine an angle of the road in relation to the direction of gravity based on the first measured specific force and the second measured specific force.
18. The system of claim 16 , wherein the first pose is in a first segment of the road and the second pose is in a second segment of the road.
19. The system of claim 16 , wherein the autonomous vehicle faces a first direction in the first pose and the autonomous vehicle faces a second direction in the second pose.
20. The system of claim 16 , wherein determining the direction of gravity includes deriving a pitch angle of the autonomous vehicle.