Madgwick code for real time imu processing, all of it is shit for w/e
reason. Mag Angle stuff works but meh, not useful