remembering current nav waypoint

Arducopter 3.1.1 (and earlier) versions would re-initialize the current
nav waypoint whenever AUTO mode was entered.  This is detrimental to
switching between STABILIZED and AUTO repeatedly during a flight.

This version has removed that initialization and instead put it when the
motors are armed.