EXACT-MPPI: Exact Signed-Distance Navigation for Arbitrary-Footprint Robots from Point Clouds via Path Integral Control

Chen Peng1,2, Zhikang Ge1, Wenwu Lu1, Haiming Gao1,2, Stavros Vougioukas3, Peng Wei3
1ZJU-Hangzhou Global Scientific and Technological Innovation Center, Zhejiang University
2College of Biosystems Engineering and Food Science, Zhejiang University
3Department of Biological and Agricultural Engineering, University of California, Davis
Overview of the EXACT-MPPI framework

EXACT-MPPI maps local point-cloud observations and weak waypoint guidance directly to motion commands, combining exact signed-distance evaluation for arbitrary 2D footprints with GPU-parallel MPPI control.

Abstract

Ground robots often carry payloads, implements, or other attachments that turn their effective footprint into complex, non-convex shapes. Navigating safely through clutter then requires reasoning about this true geometry, yet most local planners simplify it with convex or inflated proxies and rasterize sensor data into occupancy grids or distance fields. Both choices eliminate feasible motions when clearance is comparable to the footprint geometry. We present EXACT-MPPI, a training-free local navigation framework that maps local point-cloud observations and sparse guidance directly to motion commands, without any intermediate map representation. The framework embeds an analytic, exact signed-distance evaluator into a Model Predictive Path Integral (MPPI) controller. The footprint is represented as a simple polygon for general convex or concave planar shapes, with a rectangle-cover specialization for faster evaluation of rectilinear footprints, enabling footprint-aware collision costs without convex decomposition, inflation, or learned encoders. During each MPPI rollout, observed obstacle points are transformed into the predicted body frame and evaluated against the footprint. All operations are batched in JAX, leveraging GPU parallelism for real-time receding-horizon control. Experiments show that EXACT-MPPI accelerates batched distance evaluation over a learned point-to-robot baseline, preserves feasible motion where convex-footprint planners fail, and remains robust under dense static and moving obstacles. The same framework deploys on differential-drive, Ackermann, omnidirectional, and hybrid-mode platforms by changing only the footprint description and motion model without per-platform training. Pairing exact footprint geometry with sampling-based predictive control thus offers a practical, training-free path to footprint-aware local navigation across diverse robots.

Method Overview

EXACT-MPPI system pipeline

System architecture of EXACT-MPPI. Local obstacle points and sparse guidance are evaluated inside a footprint-aware MPPI rollout loop, avoiding occupancy grids, signed-distance fields, and learned encoders.

  • Direct point-cloud navigation: observed obstacle points are consumed in the robot-centric control loop without rasterizing them into a map.
  • Exact footprint geometry: simple polygons handle convex and concave footprints, while rectangle covers accelerate rectilinear robot shapes.
  • GPU-parallel receding horizon control: JAX batches rollout samples, horizon steps, obstacle points, and footprint edges for real-time MPPI updates.
  • Cross-platform deployment: the same collision-evaluation and MPPI structure transfers across differential-drive, Ackermann, omnidirectional, and hybrid-mode robots.

Exact Signed-Distance Evaluation

Rectangle-cover and polygon-edge distance evaluation

Distance evaluation for an orthogonal footprint: rectangle cover versus polygon edges.

Signed-distance fields for representative simple polygons

Representative signed-distance fields for rectilinear, convex, and non-convex footprints.

Simulation Results

Cluttered corridor navigation demonstration

Cluttered corridor with a T-shaped footprint.

Dynamic obstacle navigation demonstration

F-shaped footprint with moving obstacles.

Narrow-gap navigation demonstration

Narrow-gap navigation near clearance limits.

Cross-Platform Hardware Deployment

Hardware platforms used in the experiments

The hardware experiments include an AgileX Ranger mini, a differential-drive dual-arm robot, and a Unitree Go2 quadrupedal robot carrying an elongated object.

Differential-drive dual-arm robot deployment

Differential-drive transportation in indoor narrow spaces.

Ranger mini parallel-motion trap scenario

Ranger mini trap scenario under parallel motion.

Ranger mini dual-Ackermann trap scenario

Ranger mini trap scenario under dual-Ackermann steering.

Unitree Go2 narrow-passage comparison

Unitree Go2 narrow-passage comparison with a carried bar.

Hybrid-Mode Navigation

Hybrid-mode navigation on AgileX Ranger mini

Hybrid-mode navigation on AgileX Ranger mini, with local planning details showing point-cloud input, reference trajectory, sampled candidate paths, and the selected MPPI trajectory.

Trajectory and commanded velocities for hybrid and dual-Ackermann operation

Trajectory and commanded velocities for hybrid-mode operation and dual-Ackermann-only operation.

Video Presentation

Deployment on a differential-drive robot.

Deployment on a swerve-control robot.

Deployment on a quadrupedal robot.

Citation

If you find this work useful, please cite:

@misc{peng2026exactmppiexactsigneddistancenavigation,
      title={EXACT-MPPI: Exact Signed-Distance Navigation for Arbitrary-Footprint Robots from Point Clouds via Path Integral Control},
      author={Chen Peng and Zhikang Ge and Wenwu Lu and Haiming Gao and Stavros Vougioukas and Peng Wei},
      year={2026},
      eprint={2605.29663},
      archivePrefix={arXiv},
      primaryClass={cs.RO},
      url={https://arxiv.org/abs/2605.29663},
}

For any technical issues or commercial inquiries, please contact Chen Peng, Zhikang Ge or Peng Wei.