Fix floating point precision issues in findStraigtPath see recastnavigation/recastnavigation#515 & recastnavigation/recastnavigation#735