Fix agents with disabled avoidance getting added to avoidance simulation

Fixes that agents with disabled avoidance were getting added to avoidance simulation.

(cherry picked from commit 64ce93cee9eba8b700b236f22199ee2ffd755444)

modules/navigation/nav_map.cpp

@@ -894,9 +894,9 @@ void NavMap::sync() {
 	if (agents_dirty) {
 		// cannot use LocalVector here as RVO library expects std::vector to build KdTree
 		std::vector<RVO::Agent *> raw_agents;
-		raw_agents.reserve(agents.size());
-		for (NavAgent *agent : agents) {
-			raw_agents.push_back(agent->get_agent());
+		raw_agents.reserve(controlled_agents.size());
+		for (NavAgent *controlled_agent : controlled_agents) {
+			raw_agents.push_back(controlled_agent->get_agent());
 		}
 		rvo.buildAgentTree(raw_agents);
 	}