MAV_CMD_SWARM_WAYPOINT to support quickly changing the current waypoint.

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.