Speed up the edgewise cost stuff

[jdmoorman]

This is one of many bottlenecks. We should be able to use numba for this when we get around to doing the precomputed edge costs.