The application discloses a stable domain constraint
trajectory planning and control method for a modular distributed
electric drive heavy load vehicle, comprising the following steps: constructing a nonlinear dynamics model of the modular distributed
electric drive heavy load vehicle, fitting a tire lateral force model through a
rational polynomial, and establishing a vehicle
system state space expression based on the
rational polynomial form; adopting a sum of squares
planning method to estimate the stable domain of the vehicle under different vehicle speeds, road adhesion coefficients and front, middle and rear wheel turning angles, and analyzing the influence of each state quantity on the shape and boundary of the stable domain; embedding the stable domain constraint into a
trajectory planning layer based on a quintic polynomial to generate an
obstacle avoidance trajectory meeting the dynamics stability; designing a multi-axle proportional steering strategy based on a
steady state assumption, and combining a
nonlinear model predictive controller to realize trajectory tracking control, so that the stability and control feasibility of the vehicle in a high-speed dynamic
obstacle avoidance process are ensured. Through construction of a high-speed dynamic
obstacle avoidance simulation scene, the effectiveness, stability and control feasibility of the stable domain constraint
trajectory planning and control framework are verified.