Start of priority queue in C and testing