public void checkReachedNode()//Check if reached next Pathnode { Vector3 curDestination = GetComponent <CorvoPathFinder>().getDestination(); //if (GetComponent<CorvoPathFinder>().getDestination().Equals(transform.position) ) if (Vector3Util.IsXZAlmostEquals(transform.position, curDestination)) { if (Mathf.Abs(transform.position.y - curDestination.y) < 0.1f) { GetComponent <CorvoPathFinder>().nextNode(); } } //was last node? if (GetComponent <CorvoPathFinder>().foundPath == null) { if (Vector3Util.IsXZAlmostEquals(transform.position, destination)) { stop(); } else { //not arrived yet updatePath(); } } }