Swarm wp

Needed a command to immediately change waypoints without touching the mission in ardupilot.  Couldn't use other waypoint commands as they don't do quite what I want in ArduPlane code.