A small, std::sort() or std::make_heap() - like utility for spatial indexing