I've not done it myself, but once when I thought I'd need such a queue I found this pseudo code and references:

http://www.cs.rochester.edu/research/synchronization/pseudoc...