UnderwaterSlam Currently implements: Graph Slam Hierachical Graph Slam Hilbert Maps Scan Matching(PCL based) ROW Major Order (i,j,k) = [k + 27 * (j + 12 * i)] for 5 × 12 × 27