A controller uses a Kalman filter to develop an estimated position of an implement based on a previous implement position, an implement pitch, an implement pitch rate and an estimated implement linkage velocity. The controller moves the implement to a desired position based on the estimated position of the implement.