ROUTE-RELATIVE TRAJECTORY GENERATION AND OPTIMIZATION COMPUTATIONS INCORPORATING VEHICLE SIDESLIP

Techniques are discussed for generating and optimizing trajectories for autonomous vehicles using route-relative numerical integration relative to a reference path. A planner component of an autonomous vehicle, for example, can receive or generate a reference path corresponding to a route through an environment. The current vehicle state, sideslip, and vehicle dynamics can be represented in a system of equations, such that the planner component can substantially simultaneously solve for subsequent trajectory states in a single convergence operation. In various examples, the subsequent trajectory states can be used to evaluate and determine candidate trajectories to control the autonomous vehicle to traverse the environment.