A method of vehicle control, in which a global target trajectory is tracked by successively calculating an optimum local trajectory in 4D output space to approach the global trajectory and observe vehicle performance limits and surrounding obstacle clearance. A receding horizon framework is proposed which successively updates the optimum local trajectory according to the current state of the vehicle. Processing overheads can be kept to a minimum by calculating performance limits offline, and optimisation is simplified by using a cost function approach.