Fixed minor bugs, all unit tests pass EXCEPT for the one relying on edgecost being part of the pathcost (right now, the number of steps required is the only factor)