Path endpoint termination

This fixes a bug between PathPlanner and the VTOL and Ground path followers.  When using endpoint navigation mode, there was no check for when they hit the waypoint.  This was fine when simply doing PH/RTH but for navigation that meant it would never move to the next waypoint.

This adds a setting for each defining the radius to consider a waypoint "hit" and adds the check in the follower code to deal with this.  This problem does not apply to the fixed wing follower and it does not use the endpoint mode.