Befor implementing priorty queue first time
Implemented priorty queue but with bad heuristic