missionlib: waypoint yaw fixed