Minor cleanup
Added unit test for addCostToEdge
Merge branch 'Agent/iilTranslation' of https://github.com/jannickj/nabf into Agent/iilTranslation