Calibrate your IMU first.
And I suggest you to hold your aircraft by hands and round a figure of eight course both vertically and horizontally. That is another way to calibrate your compass.
Btw, I find that the vibration of your bird is quiet heavy in the video you post. What happened?