Use pointers for PQueue values, so the value can be updated

* Use []Position type in test implementation
* Update equalPath argument types (use just []Position)