"Eherm ... I would try to define a kind of maxvalue for the drift comp vector you are calculating ... Making it more agressiv but without making it unstable ... !?"