Switch from utility-function defined penalties for blocked paths, to agent-defined ones
Apparently working version of the interteam coordination!
Merge with upstream