Particle Filter based 3D Position Tracking for Terrain Rovers using Laser Point Clouds

Difficult conditions on outdoor terrains make outdoor autonomy for rovers, a challenging task. The conventional wheel odometry method uses orientation measurements to assume a momentary plane to apply wheel encoder readings. On uneven terrains, this method often gives poor results for position tracking, and therefore rarely used. To improve the conventional odometry motion model, immediate terrain data can be used. This paper proposes a novel state variable extension (SVE) method to establish a connection between state space variables of a terrain rover by combining terrain point clouds with rover kinematics. The simulation results show that when the 2D state variables (x, y, yaw) are known, the 2D state can be extended to its 3D state (x, y, z, roll, pitch, yaw) with minimal error. The proposed SVE method is employed in a particle filter to determine the 2D state variables, which in turn results in achieving the full 3D position tracking of the rover.