Path cost is now double rather than float; Added Node unit tests