Insert function of priority queue implemented and tests added