Add safe_peek and safe_pop in all pqueue modules

Hi,

Yesterday we rewrote the modules in pqueue with @filliatr, I just realized some safe_peek and safe_pop were missing, so I just added them.