1 parent 2e3a537 commit ab10db6Copy full SHA for ab10db6
1 file changed
src/basho/localization/mcl.cpp
@@ -323,7 +323,7 @@ void MCL::resample_particles_low_variance()
323
int num_inject_goalpost = 0.1 * num_particles;
324
325
if (compute_goalpost_pose_hypothesis(goalpost_hypothesis)) {
326
- for (int i = num_random + num_inject_odom; i < num_random + num_inject_goalpost + num_inject_goalpost; ++i) {
+ for (int i = num_random + num_inject_odom; i < num_random + num_inject_odom + num_inject_goalpost; ++i) {
327
int idx = num_particles - 1 - i;
328
329
new_particles[idx].position.x = goalpost_hypothesis.x + noise_x(rand_gen);
0 commit comments