Cubicle 1.1.2 documentation and source : Iheap.insert

let insert cmp s n =
  if not (in_heap s n) then 
    begin
      Vec.set s.indices n (Vec.size s.heap);
      Vec.push s.heap n;
      percolate_up cmp s (Vec.get s.indices n)
    end