Made code multitemporal

matdb/mat/cost.cpp

@@ -73,7 +73,10 @@ double getCost(threadDB* thread_db, const CSourcePath* path)
 
 	// TODO: This cost function makes our DFS nearly pointless!!!
 	int srcIdx = path->src_index();
-	double totalCost = 3*calcFullCellDist(thread_db, path->indices[srcIdx], path->indices[srcIdx+1]);
+	double totalCost = 0.0;
+	for ( int idx = path->startIdx; idx < path->endIdx-1; ++idx  )
+		totalCost += calcFullCellDist(thread_db, path->indices[idx], path->indices[idx +1]);
+
 	if (totalCost == dbltype::infinity() )
 		return dbltype::infinity();