UNIVERSITY OF WATERLOO · ROBOTICS LAB DEVELOPMENT

Lab 2 — AMCL Localization
& Particle-Filter Analysis

Development, validation, and instruction of a mobile-robot localization laboratory examining particle-filter behavior, sensor uncertainty, particle count, pose estimation, and computational trade-offs.

Lab Overview

From successful localization to understanding why it works

Lab 2 extended the localization component of the previous robotics laboratory into a dedicated experiment using Adaptive Monte Carlo Localization with a simulated TurtleBot.

AMCL Particle-filter localization
MATLAB Implementation & analysis
ROS LiDAR, odometry & control
60 Filter updates per experiment
Laboratory Design

Connecting probabilistic robotics theory to experiments

Students first established a working AMCL implementation using a known map, odometry, and range measurements. The baseline system was then deliberately modified to examine how individual model parameters affected localization performance.

The laboratory was designed to move beyond simply obtaining a successful pose estimate. Students were required to interpret particle distributions, estimated trajectories, covariance, localization error, and computation time using particle-filter theory.

Experimental scope

  • Known occupancy-grid map
  • Odometry motion model
  • Likelihood-field sensor model
  • LiDAR measurement processing
  • Particle propagation
  • Measurement weighting
  • Particle resampling
  • Pose and covariance estimation
  • Parameter sensitivity experiments
  • Computation-time analysis
Localization Principle

Motion, sensing, weighting, and resampling

The laboratory followed the fundamental particle-filter cycle used by Monte Carlo Localization.

01 Motion Update
→
02 LiDAR Measurement
→
03 Particle Weighting
→
04 Resampling
→
05 Pose Estimate
System Configuration

MATLAB localization connected to a ROS robot simulation

The Gazebo TurtleBot environment supplied robot motion, odometry, and laser-scan measurements through ROS. MATLAB received those measurements and executed the AMCL localization procedure.

Coordinate transformations were used to express sensor measurements relative to the robot base, while motion and likelihood-field models represented uncertainty in the robot motion and range observations.

Baseline configuration

  • Binary occupancy-grid map
  • Differential-drive motion model
  • Odometry noise: 0.2 baseline
  • Likelihood-field sensor model
  • LiDAR range: 0.12–3.5 m
  • ROS /scan subscription
  • ROS /odom subscription
  • Velocity-command publisher
  • Sensor-to-base coordinate transform
  • Movement-triggered AMCL updates
Scenario 01 · Baseline

Successful localization under nominal conditions

The baseline experiment established the reference localization performance used for comparison with the modified parameter scenarios.

Baseline AMCL experiment showing particle distribution, actual and estimated trajectory, and covariance
Baseline AMCL result after 60 updates. The estimated trajectory closely follows the reference pose while the localization covariance decreases as the particle filter converges.
Dynamic Demonstration

AMCL particle evolution during robot motion

The dynamic experiment shows the localization process as particles evolve and the estimated pose is updated while the simulated TurtleBot moves through the environment.

Parameter Sensitivity

Deliberately degrading the localization model

Each experiment modified a single parameter relative to the baseline so that its influence on localization could be isolated and interpreted.

SCENARIO 01

Baseline

Default AMCL configuration used as the reference localization condition.

SCENARIO 02

Reduced Measurement Weight

Expected measurement weight was reduced to 0.2 to investigate localization behavior when sensor observations are assigned less confidence.

SCENARIO 03

Reduced Particle Count

The particle limit was reduced to only 50 particles to investigate insufficient sampling of the robot's belief distribution.

SCENARIO 04

Increased Measurement Noise

Measurement noise was increased to 2.0 to examine localization behavior under degraded sensing.

Particle Representation

Too few particles can prevent reliable localization

Reducing the number of particles limits how well the probability distribution over possible robot poses can be represented.

AMCL comparison between 5000 particles and 50 particles at multiple filter updates
Comparison between the 5,000-particle baseline and the 50-particle experiment at multiple filter updates. The reduced particle set provides an insufficient representation of the pose belief and produces degraded localization behavior.
Measurement Uncertainty

Higher sensor noise weakens particle convergence

Increasing measurement uncertainty makes sensor observations less informative when evaluating candidate robot poses.

AMCL comparison between baseline measurement noise and high measurement noise
Particle-filter evolution with baseline measurement noise and increased measurement noise. Greater measurement uncertainty produces a broader and less stable particle distribution.
Extended Experiment

Particle count versus computational cost

Additional testing extended the particle-count study beyond the required laboratory scenarios by comparing 50, 5,000, and 50,000 particles.

Particle Count Time for 60 Updates Interpretation
50 0.4455 s Lowest computation time, but insufficient particle representation produced poor localization accuracy.
5,000 1.0499 s Baseline configuration providing a practical balance between localization performance and computation.
50,000 4.1961 s Dense particle representation with substantially increased computation time.
AMCL pose error and computation time comparison for 50, 5000, and 50000 particles
Extended particle-count experiment comparing localization error and computation time for 50, 5,000, and 50,000 particles over 60 AMCL updates.
Engineering Interpretation

Localization quality is a system-level trade-off

The experiments demonstrated that localization performance depends on the interaction between motion uncertainty, sensor-model quality, particle representation, and computational resources.

More particles can improve the representation of the probability distribution, but increasing particle count also increases computation. Conversely, too few particles may execute quickly while failing to represent the belief distribution adequately.

Key observations

  • Particle count controls belief resolution
  • Too few particles can degrade pose estimation
  • Higher sensor uncertainty weakens localization
  • Reduced measurement confidence affects convergence
  • Higher particle counts increase computation
  • Localization requires an accuracy–cost trade-off
Teaching & Assessment

Students had to explain why localization degraded

The laboratory report required students to connect experimental observations to particle-filter theory rather than simply demonstrate that the software executed.

Students documented the localization methodology, presented their simulation results, explained the causes of degraded performance, and discussed limitations that could negatively affect AMCL.

Assessment focus

  • Particle-filter theory
  • AMCL implementation
  • Experimental results
  • Pose estimation behavior
  • Covariance interpretation
  • Localization degradation
  • Model limitations
  • Technical reporting
My Role

Laboratory development, validation, instruction, and analysis

I developed and revised the laboratory material, validated the AMCL workflow in the virtual TurtleBot environment, prepared instructional and experimental analysis material, supported students during implementation and troubleshooting, and participated in assessment and grading.

The laboratory was structured to connect theoretical probabilistic localization with observable robot behavior, quantitative results, and engineering interpretation.

Responsibilities

  • Lab manual redevelopment
  • AMCL workflow validation
  • MATLAB / ROS integration testing
  • Experimental scenario development
  • Live laboratory instruction
  • Student troubleshooting
  • Results analysis
  • Grading and technical feedback
Laboratory Sequence

Next: sampling-based path planning

Lab 3 moved from localization into sampling-based path planning using RRT and RRT*, followed by path execution using Pure Pursuit.

NEXT · LAB 03

RRT / RRT* Path Planning

Sampling-based path planning, robot motion constraints, obstacle inflation, planning-quality comparison, and trajectory tracking.

← Back to Waterloo Research & Work