Fixed bug in remove_at_priority in priority_queue.c.
Also added ability to only print test messages when only DEBUG_1 is defined.