Trajectory control of a vehicle

A method of trajectory control for a vehicle includes obtaining an initial trajectory; presenting the initial trajectory as a current trajectory on an I/O device, the current trajectory presented overlaying terrain; initiating travel of the vehicle along the current trajectory; updating the current trajectory and the terrain in real time as the vehicle travels along the current trajectory; determining if change in the current trajectory is required; changing the current trajectory to an altered trajectory in response to determining change in the current trajectory is required; and presenting the altered trajectory on the I/O device, the altered trajectory presented overlaying the terrain.