AP_Mission: Updates to allow nested do_jump commands