Tracking down gps ekf bug, not enough precision for GPS in rad.