Fixed build with -O3 and fixed pqueue_test().