A vehicle, and a system a method of navigating a vehicle. The system includes a trajectory planning module and a trajectory tracking module. The trajectory planning module operates at a processor of the vehicle to generate a trajectory for the vehicle. The trajectory tracking module operates at the processor to track the trajectory to navigate the vehicle. The trajectory planning module and the trajectory tracking module run asynchronously from each other.