maneuver reconstruction calibration sequential filter fixed interval smoother