Lidar System with Gyroscope-Aided Focus Steering
An imaging system is described for generating an estimate for a virtual horizon for a moving vehicle. The estimate is based on a lidar point cloud and on pitch rate data from a gyroscope. The lidar point cloud data estimates the horizon based on lidar scans that are updated at a first rate. The gyroscope data is updated at a second rate that is faster than the first rate and therefore can be used to augment the point cloud based horizon estimation to produce a more accurate horizon estimation when the vehicle is pitching at a high rate. The gyroscope data can also be used to correct individual point clouds, which may be distorted if the vehicle is pitching or rolling during an individual scan.
1 . A method for controlling a Light Detection and Ranging (lidar) system of a vehicle, the lidar system configured to sense an environment through which the vehicle is moving, the method comprising:
receiving lidar system data generated by the lidar system of the vehicle as the vehicle moves through the environment;
receiving a pitch rate of the vehicle generated by a pitch-rate sensor associated with the vehicle;
determining, by one or more processors, an angle of the lidar system relative to the environment through which the vehicle is moving, the lidar-system angle determined based at least in part on the lidar system data and the pitch rate of the vehicle; and
causing the lidar system to be adjusted in accordance with the determined angle of the lidar system.
2 . The method of claim 1 , wherein determining the lidar-system angle comprises:
determining an initial lidar-system angle based on the lidar system data; and
updating the initial lidar-system angle based on the pitch rate of the vehicle to determine the lidar-system angle.
3 . The method of claim 1 , wherein causing the lidar system to be adjusted comprises:
determining a location of a horizon based on the angle of the lidar system relative to the environment; and
adjusting a density of scan lines produced by the lidar system so that a peak density of the scan lines coincides with the location of the horizon.
4 . The method of claim 1 , wherein the pitch-rate sensor is a gyroscope.
5 . The method of claim 1 , further comprising determining, (i) a lower bound for a vertical region of interest (VROI) within a vertical field of regard of the lidar system, and (ii) an upper bound for the VROI within the vertical field of regard of the lidar system, and basing, in part, the lower bound and the upper bound on the pitch rate.
6 . The method of claim 1 , wherein determining the lidar-system angle comprises combining the lidar system data and the pitch rate using a Bayesian filter.
7 . The method of claim 6 , wherein determining the lidar-system angle further comprises predicting, using the Bayesian filter, the lidar-system angle for an upcoming scan to be performed by the lidar system.
8 . The method of claim 7 , further comprising: predicting a location of a horizon for the upcoming scan based on the predicted lidar-system angle for the upcoming scan.
9 . The method of claim 8 , further comprising adjusting a density of scan lines produced by the lidar system for the upcoming scan so that a peak density of the scan lines in the upcoming scan coincides with the predicted location of the horizon for the upcoming scan.
10 . The method of claim 7 , further comprising: determining, (i) a lower bound for a vertical region of interest (VROI) within a vertical field of regard of the lidar system, and (ii) an upper bound for the VROI within the vertical field of regard of the lidar system, and
basing, in part, the lower bound and the upper bound on the predicted lidar system angle for the upcoming scan.
11 . A Light Detection and Ranging (lidar) system implemented in a vehicle, the lidar system comprising:
a lidar system configured to generate lidar data as the vehicle moves through an environment;
a pitch-rate sensor associated with the vehicle; and
a controller configured to:
receive the lidar data;
receive a pitch rate of the vehicle generated by the pitch-rate sensor;
determine an angle of the lidar system relative to the environment through which the vehicle is moving, the lidar-system angle determined based at least in part on the lidar system data and the pitch rate of the vehicle; and
cause the lidar system to be adjusted in accordance with the determined angle of the lidar system.
12 . The lidar system of claim 11 , wherein the controller is further configured to:
determine an initial lidar-system angle based on the lidar system data; and
update the initial lidar-system angle based on the pitch rate of the vehicle to determine the lidar-system angle.
13 . The lidar system of claim 11 , wherein the controller is further configured to:
determine a location of a horizon based on the angle of the lidar system relative to the environment; and
adjust a density of scan lines produced by the lidar system so that a peak density of the scan lines coincides with the location of the horizon.
14 . The lidar system of claim 11 , wherein the pitch-rate sensor is a gyroscope.
15 . The lidar system of claim 11 , wherein the controller is further configured to determine, (i) a lower bound for a vertical region of interest (VROI) within a vertical field of regard of the lidar system, and (ii) an upper bound for the VROI within the vertical field of regard of the lidar system, and
base, in part, the lower bound and the upper bound on the pitch rate.
16 . The lidar system of claim 11 , wherein the controller is configured to determine the lidar-system angle by combining the lidar system data and the pitch rate using a Bayesian filter.
17 . The lidar system of claim 16 , wherein the controller is further configured to predict, using the Bayesian filter, the lidar-system angle for an upcoming scan to be performed by the lidar system.
18 . The lidar system of claim 17 , wherein the controller is further configured to further to predict a location of a horizon for the upcoming scan based on the predicted lidar-system angle for the upcoming scan.
19 . The lidar system of claim 18 , wherein the controller is further configured to adjust a density of scan lines produced by the lidar system for the upcoming scan so that a peak density of the scan lines in the upcoming scan coincides with the predicted location of the horizon for the upcoming scan.
20 . The lidar system of claim 17 , wherein the controller is further configured to determine, (i) a lower bound for a vertical region of interest (VROI) within a vertical field of regard of the lidar system, and (ii) an upper bound for the VROI within the vertical field of regard of the lidar system, and
base, in part, the lower bound and the upper bound on the predicted lidar system angle for the upcoming scan.