Copter: only start delay timer after reaching wp location and altitude