Navigator: set loiter WP correctly
Merge pull request #666 from PX4/fix_loiter

Navigator: set loiter WP correctly