Update B.cpp

Improved constant on updateDistanceAndAddUpdatedNodesToQueue; now it only does a single lower_bound call.