Systems and methods for a vehicle controller robust to time delays

Abstract

Systems and methods are directed to compensating for time delays. In one example, a system includes one or more processors and memory including instructions that, when executed by the one or more processors, cause the one or more processors to perform operations. The operations include obtaining first pose data indicative of a pose of a vehicle; obtaining first control data indicative of a first vehicle control command that has yet to affect control of the vehicle; determining, based at least partially on the first pose data and the first control data, predicted pose data indicative of an estimate of a pose of the vehicle that will result after the vehicle control command affects control of the vehicle; and generating, based at least partially on the predicted pose data, second control data indicative of a second vehicle control command to be applied subsequent to the first vehicle control command.