jumping bug and first priority navpoint callback