Survey (Grid) Imperial Support, + random clean-up.

Still have to set altitude in meters, although it will add WP's in feet.
Merge pull request #565 from tristannovak/master

Survey (Grid) Imperial Support, + random clean-up. Issue: #541