Navigator: set loiter WP correctly

This fixes #650.