Method top

src/simulator/local_sensing/include/ikd-Tree/ikd_Tree.cpp:1363–1365

}
        
PointType_CMP MANUAL_HEAP::top(){
    return heap[0];
}
        
void MANUAL_HEAP::push(PointType_CMP point){
    if (heap_size >= cap) return;