If you see strange behavior using Attitude stabilization, try setting Accel filtering in Attitude tab.Something from 0.05 to 0.1Remove vibrations.The Yaw drift looks normal if you don't use Mag, Yaw heading only based on Gyros.