I had a similar problem, turned out that I had mounted the NAZA with velcro and it was shifting and getting too much vibration. Is your naza mounted firmly in the center of the Quad facing forward? Also take a look at the gps location in the software, the positive and negative values throw...