correct lpf for d term
renormalize vect (is that required or the real cause of the gyro
headfree?)