Lighten the code. Fix an unreproductible bug.

A lot of code is removed since the MPU measurements FIFO should not store old values.
The bug which made all the measurements corrupted after X seconds of execution has been corrected. Some traces remain (some isolated measures still glitching).