Fixed errors in CostFunction

Nu werkt getDemandByCost en zijn er nog wat andere fouten uit de
CostFunction klasse gehaald. Verder heb ik een kleine test klasse
gemaakt.