Quaternion interpretation of pitch roll ported from someone c sources that used FreeIMU algorithm (as I understood)