Improved testing
Initial prioq implementation