From 197d545aace59541dfcd66076f273b97826c574b Mon Sep 17 00:00:00 2001 From: Antonio Park Date: Tue, 19 Mar 2024 09:50:18 +0900 Subject: [PATCH] Update likelihood_field_model.cpp --- nav2_amcl/src/sensors/laser/likelihood_field_model.cpp | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/nav2_amcl/src/sensors/laser/likelihood_field_model.cpp b/nav2_amcl/src/sensors/laser/likelihood_field_model.cpp index 637376065a0..1148c2828db 100644 --- a/nav2_amcl/src/sensors/laser/likelihood_field_model.cpp +++ b/nav2_amcl/src/sensors/laser/likelihood_field_model.cpp @@ -56,9 +56,9 @@ LikelihoodFieldModel::sensorFunction(LaserData * data, pf_sample_set_t * set) // Pre-compute a couple of things double z_hit_denom = 2 * self->sigma_hit_ * self->sigma_hit_; double z_rand_mult = 1.0 / data->range_max; - + step = (data->range_count - 1) / (self->max_beams_ - 1); - + // Step size must be at least 1 if (step < 1) { step = 1;