Skip to content

Commit 61fcb47

Browse files
authored
Update in observation time comparison (#308)
* last_updated_ is now not updated on reset(), and observation staleness is now determined by comparison to clock_->now() instead of the last observation. * Readded the observation buffer update on reset. * Used correct whitespace again
1 parent 0b76e8d commit 61fcb47

File tree

1 file changed

+1
-1
lines changed

1 file changed

+1
-1
lines changed

spatio_temporal_voxel_layer/src/measurement_buffer.cpp

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -218,7 +218,7 @@ void MeasurementBuffer::RemoveStaleObservations(void)
218218
}
219219

220220
for (it = _observation_list.begin(); it != _observation_list.end(); ++it) {
221-
const rclcpp::Duration time_diff = _last_updated - it->_cloud->header.stamp;
221+
const rclcpp::Duration time_diff = clock_->now() - it->_cloud->header.stamp;
222222

223223
if (time_diff > _observation_keep_time) {
224224
_observation_list.erase(it, _observation_list.end());

0 commit comments

Comments
 (0)