6d slam - 3d mapping outdoor environments .
Approximate nearest neighbor queries in fixed dimensions