adding path finding tests + benchmark