@Test
public void testFindPath() {

      PolygonGraphPath path=new PolygonGraphPath();
      navMesh.findPath(new Vector3(104, 138), new Vector3(212.0f,232.0f), path);
      if(path.nodes!=null) {
          path.nodes.stream().filter(p->p!=null).forEach(p->{
              PolygonEdge polygonEdge=(PolygonEdge)p;
              System.err.println(polygonEdge.fromNode.index);
          });
      }
    PolygonPointPath pointPath=new PolygonPointPath();
    List<Vector3> paths = navMesh.findPath(new Vector3(168.7f,25.3f, 197.4f), new Vector3(159.7f,25.4f,199.2f), pointPath);
    if(paths!=null) {
        paths.forEach(p->System.out.println(p.toString()));
    }
}