Trajectory Interpolation for Parametrized Maneuvering and Flexible Motion Planning of Autonomous Vehicles

This paper describes a method of generating continuously parametrized maneuver classes based on a finite number of user-provided examples motions. A trajectory interpolation algorithm performs a smooth transformation of vehicle maneuvers across a continuous range of boundary conditions while enforcing nonlinear system equations of motion as well as nonlinear equality and inequality constraints. The scheme is particularly useful for describing motions that deviate widely from the range of linearized dynamics and where satisfactory examples may be found from off-line nonlinear programming solutions or human pilot motion capture. The interpolation algorithm is computationally efficient, making it a suitable alternative for near real-time maneuver synthesis, particularly when used in concert with a vehicle motion planner. Experimental application to a three degree-of-freedom rotorcraft test bed demonstrates the essential features of system and trajectory modeling, maneuver example selection, maneuver class synthesis, and integration into a hybrid system path planner.