increase the P term for yaw
add ema to the point that we found
turn off realtime navdata