Backup of Sebastian Madgwick's original LGPL licensed sensor fusion algorithm - View it on GitHub