Added a cost function for a path