Did you reload new firmware? if not load new firmware go into mission planner and do a mag and compass calibration.
open