SYSTEMS AND METHODS FOR CONTROLLING SPEED OF AN AUTONOMOUS VEHICLE

Systems and methods for generating a trajectory of a vehicle are disclosed. The methods include generating a spatial domain speed profile for a path represented as a sequence of poses of a vehicle between a first point and a second point. Generation of the spatial domain speed profile uses a longitudinal problem while excluding a derate interval on the path when speed of the vehicle cannot exceed a threshold. The methods further include generating a derate profile using the spatial domain speed profile and the derate interval, and transforming the derate interval to a temporal derate interval. The temporal derate interval may include time steps at which the speed of the vehicle cannot exceed the threshold while traversing the path, and may be used as an input to the longitudinal problem for generating a trajectory of the vehicle for navigating between the first point and the second point.