Skip to content

Commit

Permalink
[Fix] Prevent LiDAR map propagation before having enough number of cl…
Browse files Browse the repository at this point in the history
…ones.

Address issue: #5
Note: If ```use_imu_res: true```, we used CPI to perform interpolation no matter what enabling interpolation at any time.
  • Loading branch information
WoosikLee2510 committed Oct 12, 2023
1 parent f6bd1ad commit 00ea422
Showing 1 changed file with 2 additions and 2 deletions.
4 changes: 2 additions & 2 deletions mins/src/update/lidar/UpdaterLidar.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -150,8 +150,8 @@ void UpdaterLidar::propagate_map_frame() {
if (!ikd_data.at(i)->tree->initialized())
continue;

// Skip if we have less than 2 clones
if (state->clones.size() < 2)
// Skip if we do not have enough clones to perform propagation
if (state->clones.size() < state->op->intr_order + 1)
continue;

if (ikd_data.at(i)->time + state->lidar_dt.at(i)->value()(0) <= state->oldest_3rd_clone_time())
Expand Down

0 comments on commit 00ea422

Please sign in to comment.