Duplicate first wp, follows up.
Improved NavMesh precision