Added RTQF optimized quaternion fusion filter