Fix positioning for waypoints and wander_area
Merge pull request #816 from dorkster/float_fixes

Fix positioning for waypoints and wander_area