updated route search & util

a*search fCost needs to be edited--i think we shouldn't be using
distance as a cost, since it's a constraint.