Nonplanar Model Predictive Control for Autonomous Vehicles with Recursive Sparse Gaussian Process Dynamics

Non-Planar Racing

This paper proposes a nonplanar model predictive control (MPC) framework for autonomous vehicles operating on nonplanar terrain. To approximate complex vehicle dynamics in such environments, we develop a geometry-aware modeling approach that learns a residual Gaussian Process (GP). By utilizing a recursive sparse GP, the framework enables real-time adaptation to varying terrain geometry. The effectiveness of the learned model is demonstrated in a reference-tracking task using a Model Predictive Path Integral (MPPI) controller. Validation within a custom Isaac Sim environment confirms the framework’s capability to maintain high tracking accuracy on challenging 3D surfaces.

Isaac Sim environment view

System Structure

The control framework combines a nominal single-track vehicle model with a sparse GP residual that is learned online to capture time-varying surface geometry. The learned dynamics model is embedded in a model predictive control formulation, and MPPI is used to solve the resulting nonlinear optimal control problem.

System Flow Diagram

Results

We validate the performance of the proposed control framework in a custom Isaac Sim environment on a nonplanar track. The trajectory plot below shows the vehicle’s path using the recursive GP, the regular MPC, and the reference centerline.

3D Trajectory on Nonplanar Track

Contributors

Ahmad Amine, Kabir Puri, Viet-Anh Le, Rahul Mangharam

Latest Posts

Nonplanar Model Predictive Control for Autonomous Vehicles with Recursive Sparse Gaussian Process Dynamics
Nonplanar Model Predictive Control for Autonomous Vehicles with Recursive Sparse Gaussian Process Dynamics

A geometry-aware MPC framework for autonomous vehicles on nonplanar terrain, using recursive sparse Gaussian Processes for real-time adaptation and improved tracking.

AI Coaching
AI Coaching

AI Coaching for Drone Racing

Learning to Optimize, Control, and Adapt
Learning to Optimize, Control, and Adapt

A project aiming at developing Learning to Optimize, Control, and Adapt frameworks and their applications in control systems.