FIX pathfinding

+ Fixed float rounding bug in Release.