// Pathfind! With A* private Vector2 pathfindMove(Hero unit) { Vector2 d = unit.getDestination(); Vector2 p = unit.getPosition(); Pathfinder pathfinder = new Pathfinder(world.getLevel()); Node result = pathfinder.getPath(p, d); if (result == null) return null; while (result.getParent() != null && result.getParent().getParent() != null) { result = result.getParent(); } return result.getPosition(); }