Start working on fix math.
Implement atan and atan2 for fix math.
Start implement fix point estimator
Accelerate the i2c communication
Fix bug at fix_sqrt
Add acc factor and magneto to the angle estimator.
Very good angle estimation
increase the period