A method of navigating an agricultural vehicle, which is equipped with a 3D imaging device for imaging surroundings of the vehicle, and an image processing device, includes obtaining from the 3D imaging device frames imaging at least a part of the surroundings of the vehicle at different points of time while the vehicle is moving thus providing a chronological sequence of frames, analysing the frames, and establishing a change of pose of the vehicle using results of the analysis of at least two chronologically different frames.