Search papers, labs, and topics across Lattice.
This paper introduces the Polygonal Signed Distance Function (PSDF), a novel approach for real-time collision avoidance in complex environments, which efficiently evaluates collision-avoidance constraints using GPU acceleration. By embedding the PSDF into a model predictive control framework, the authors achieve significant computational efficiency while maintaining geometric fidelity, allowing for effective navigation in obstacle-dense scenarios. Experimental results indicate that the PSDF-MPC outperforms traditional optimization-based methods, demonstrating robust performance in both simulated and real-world settings.
Real-time collision avoidance in dense environments is revolutionized by a GPU-accelerated method that maintains geometric precision while significantly reducing computational overhead.
Optimization-based local planning and control require high-rate collision-avoidance constraint evaluation over a prediction horizon. In obstacle-dense environments, where feasible space is limited and the constraints become increasingly complex, the computational workload often dominates the control-cycle runtime. The resulting bottleneck motivates collision-avoidance constraints that combine computational efficiency with geometric fidelity. The proposed Polygonal Signed Distance Function (PSDF) is a geometry-exact signed distance function between a convex polygonal robot footprint and obstacles represented by their boundary edges. It is implemented as a weight-free, branch-free tensorized geometric pipeline enabling batched GPU execution and automatic differentiation. The PSDF is embedded into model predictive control by locally linearizing the stage-wise safety constraints within a sequential quadratic programming-based real-time iteration scheme, yielding the PSDF-embedded model predictive controller (PSDF-MPC). The design separates CPU/GPU computation so that the GPU evaluates batched PSDF values and gradients while the CPU solves a sparse quadratic program whose dimension is determined by system dimensions and horizon length, not by obstacle features. Microbenchmarks show that PSDF scales favorably against signed-distance query baselines. Closed-loop simulated and real-world navigation experiments, including comparisons with optimization-based baselines, demonstrate that PSDF-MPC maintains real-time feasibility and robust collision avoidance in dense polygonal environments.
