12345qiupeng
/
Fast-Lio
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

[Fix] Crashes when fed empty pointcloud 

Checks if before doing the backward propagation step there are actually points in the pointcloud
main
Andreu Huguet 2021-11-12 19:57:48 +08:00 committed by Cris.Wei
parent d0a877db69
commit 2a70778fd6
1 changed files with 1 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

1
src/IMU_Processing.hpp
View File

@ -297,6 +297,7 @@ void ImuProcess::UndistortPcl(const MeasureGroup &meas, esekfom::esekf<state_ikf
last_lidar_end_time_ = pcl_end_time; last_lidar_end_time_ = pcl_end_time;
/*** undistort each lidar point (backward propagation) ***/ /*** undistort each lidar point (backward propagation) ***/
if (pcl_out.points.begin() == pcl_out.points.end()) return;
auto it_pcl = pcl_out.points.end() - 1; auto it_pcl = pcl_out.points.end() - 1;
for (auto it_kp = IMUpose.end() - 1; it_kp != IMUpose.begin(); it_kp--) for (auto it_kp = IMUpose.end() - 1; it_kp != IMUpose.begin(); it_kp--)
{ {