Add acc factor and magneto to the angle estimator.
Very good angle estimation
increase the period