implements transferFunction.
experiment set 1
Merge branch 'master' into follow_leader_policy

Conflicts:
	multi_agent_planner/config/config.yaml
	multi_agent_planner/src/Environment.cpp
	multi_agent_planner/src/PathPostProcessor.cpp
added collision for no visibility