A method for controlling an actuator of a vehicle comprises providing a dynamic condition sensor generating a vehicle movement signal and a position sensor for generating a reported position. A processor is coupled to the inertial sensor and the position sensor and comprises an estimator, a position measurement predictor having a filter, a comparator and a control shaping block, said estimator generating a vehicle position based upon the dynamic condition sensor, said position measurement predictor generating an estimated position measurement in response to the reported vehicle position and a matched frequency response to the movement signal, said control shaping block generating an actuator control signal in response to a comparison of the estimated position measurement and the reported vehicle position.