Miscellaneous VTOL fixes

This is a collection of patches I've been using for tweaking the EKF and navigation performance.  This is heavily tested and flies well in my experience.