Abstract: This paper introduces a novel nonlinear model predictive controller (NMPC) formulation for real-time obstacle avoidance on heavy equipment by modeling both vehicle and obstacles as convex superellipsoids. The combination ...