using priority queue for openlist -> provided example now working but having problems on 2x2