AC: Nav system rework

Made circle mode vector field based
re-arranged Nav functions into basic modules that are more flexible to use
Added rate based loiter repositioning
Not flight tested yet.