From 61ce180e0cd88c0eccc5c5e1051b02d0e1e9294b Mon Sep 17 00:00:00 2001
From: ll7 <sailingmaster92@gmx.de>
Date: Mon, 25 Mar 2024 19:26:45 +0100
Subject: [PATCH] Refactor pyreverse.md to use code block for command

---
 docs/pyreverse.md     |   4 +-
 robot_sf/classes.svg  | 150 +++++++---------
 robot_sf/packages.svg | 408 +++++++++++++++++++++++++-----------------
 3 files changed, 309 insertions(+), 253 deletions(-)

diff --git a/docs/pyreverse.md b/docs/pyreverse.md
index 437b6fb..1cc4d91 100644
--- a/docs/pyreverse.md
+++ b/docs/pyreverse.md
@@ -1,3 +1,5 @@
 # pyreverse
 
-`pyreverse -o svg --colorized .`
\ No newline at end of file
+```shell
+pyreverse -o svg --colorized .
+```
\ No newline at end of file
diff --git a/robot_sf/classes.svg b/robot_sf/classes.svg
index 2cf75cc..56f5288 100644
--- a/robot_sf/classes.svg
+++ b/robot_sf/classes.svg
@@ -4,11 +4,11 @@
 <!-- Generated by graphviz version 2.43.0 (0)
  -->
 <!-- Title: classes Pages: 1 -->
-<svg width="8288pt" height="1085pt"
- viewBox="0.00 0.00 8287.58 1085.00" xmlns="http://www.w3.org/2000/svg" xmlns:xlink="http://www.w3.org/1999/xlink">
+<svg width="8049pt" height="1085pt"
+ viewBox="0.00 0.00 8048.58 1085.00" xmlns="http://www.w3.org/2000/svg" xmlns:xlink="http://www.w3.org/1999/xlink">
 <g id="graph0" class="graph" transform="scale(1 1) rotate(0) translate(4 1081)">
 <title>classes</title>
-<polygon fill="white" stroke="transparent" points="-4,4 -4,-1081 8283.58,-1081 8283.58,4 -4,4"/>
+<polygon fill="white" stroke="transparent" points="-4,4 -4,-1081 8044.58,-1081 8044.58,4 -4,4"/>
 <!-- robot_sf.robot.bicycle_drive.BicycleDriveRobot -->
 <g id="node1" class="node">
 <title>robot_sf.robot.bicycle_drive.BicycleDriveRobot</title>
@@ -328,9 +328,9 @@
 <text text-anchor="start" x="1345.58" y="-873.3" font-family="Times,serif" font-size="14.00">respawn_group_at_start(gid: int)</text>
 <text text-anchor="start" x="1345.58" y="-859.3" font-family="Times,serif" font-size="14.00">step()</text>
 </g>
-<!-- robot_sf.nav.map_config.GlobalRoute -->
+<!-- robot_sf.nav.gloabal_route.GlobalRoute -->
 <g id="node16" class="node">
-<title>robot_sf.nav.map_config.GlobalRoute</title>
+<title>robot_sf.nav.gloabal_route.GlobalRoute</title>
 <polygon fill="#99ddff" stroke="#99ddff" points="4748.08,-75.5 4748.08,-264.5 4933.08,-264.5 4933.08,-75.5 4748.08,-75.5"/>
 <text text-anchor="start" x="4796.58" y="-249.3" font-family="Times,serif" font-size="14.00">GlobalRoute</text>
 <polyline fill="none" stroke="#99ddff" points="4748.08,-241.5 4933.08,-241.5 "/>
@@ -385,7 +385,7 @@
 <text text-anchor="start" x="2377.58" y="-429.3" font-family="Times,serif" font-size="14.00">find_route(spawn_id: int, goal_id: int): Union[GlobalRoute, None]</text>
 </g>
 <!-- robot_sf.sim.simulator.Simulator -->
-<g id="node34" class="node">
+<g id="node33" class="node">
 <title>robot_sf.sim.simulator.Simulator</title>
 <polygon fill="#eedd88" stroke="#eedd88" points="1660.58,-782.5 1660.58,-1076.5 1978.58,-1076.5 1978.58,-782.5 1660.58,-782.5"/>
 <text text-anchor="start" x="1784.08" y="-1061.3" font-family="Times,serif" font-size="14.00">Simulator</text>
@@ -422,14 +422,14 @@
 <polygon fill="#99ddff" stroke="#99ddff" points="5178.08,-128 5178.08,-212 5463.08,-212 5463.08,-128 5178.08,-128"/>
 <text text-anchor="start" x="5254.58" y="-196.8" font-family="Times,serif" font-size="14.00">MapDefinitionPool</text>
 <polyline fill="none" stroke="#99ddff" points="5178.08,-189 5463.08,-189 "/>
-<text text-anchor="start" x="5210.58" y="-173.8" font-family="Times,serif" font-size="14.00">map_defs : List[MapDefinition]</text>
-<text text-anchor="start" x="5210.58" y="-158.8" font-family="Times,serif" font-size="14.00">maps_folder : str</text>
+<text text-anchor="start" x="5195.58" y="-173.8" font-family="Times,serif" font-size="14.00">map_defs : Dict[str, MapDefinition]</text>
+<text text-anchor="start" x="5195.58" y="-158.8" font-family="Times,serif" font-size="14.00">maps_folder : str</text>
 <polyline fill="none" stroke="#99ddff" points="5178.08,-151 5463.08,-151 "/>
 <text text-anchor="start" x="5186.08" y="-135.8" font-family="Times,serif" font-size="14.00">choose_random_map(): MapDefinition</text>
 </g>
-<!-- robot_sf.nav.map_config.Obstacle -->
+<!-- robot_sf.nav.obstacle.Obstacle -->
 <g id="node20" class="node">
-<title>robot_sf.nav.map_config.Obstacle</title>
+<title>robot_sf.nav.obstacle.Obstacle</title>
 <polygon fill="#99ddff" stroke="#99ddff" points="5481.58,-120.5 5481.58,-219.5 5651.58,-219.5 5651.58,-120.5 5481.58,-120.5"/>
 <text text-anchor="start" x="5535.08" y="-204.3" font-family="Times,serif" font-size="14.00">Obstacle</text>
 <polyline fill="none" stroke="#99ddff" points="5481.58,-196.5 5651.58,-196.5 "/>
@@ -473,7 +473,7 @@
 <text text-anchor="middle" x="2200.08" y="-361.8" font-family="Times,serif" font-size="14.00" fill="green">config</text>
 </g>
 <!-- robot_sf.sim.sim_config.SimulationSettings -->
-<g id="node32" class="node">
+<g id="node31" class="node">
 <title>robot_sf.sim.sim_config.SimulationSettings</title>
 <polygon fill="#eedd88" stroke="#eedd88" points="1791.58,-436.5 1791.58,-685.5 2069.58,-685.5 2069.58,-436.5 1791.58,-436.5"/>
 <text text-anchor="start" x="1861.58" y="-670.3" font-family="Times,serif" font-size="14.00">SimulationSettings</text>
@@ -663,24 +663,6 @@
 <polygon fill="black" stroke="black" points="1047.93,-417.47 1047.18,-424.64 1040.27,-426.7 1041.02,-419.53 1047.93,-417.47"/>
 <text text-anchor="middle" x="1119.08" y="-361.8" font-family="Times,serif" font-size="14.00" fill="green">sensors</text>
 </g>
-<!-- robot_sf.simple_robot_env.SimpleRobotEnv -->
-<g id="node31" class="node">
-<title>robot_sf.simple_robot_env.SimpleRobotEnv</title>
-<polygon fill="#77aadd" stroke="#77aadd" points="6550.08,-100 6550.08,-240 6771.08,-240 6771.08,-100 6550.08,-100"/>
-<text text-anchor="start" x="6600.58" y="-224.8" font-family="Times,serif" font-size="14.00">SimpleRobotEnv</text>
-<polyline fill="none" stroke="#77aadd" points="6550.08,-217 6771.08,-217 "/>
-<text text-anchor="start" x="6558.08" y="-201.8" font-family="Times,serif" font-size="14.00">action_space : Discrete</text>
-<text text-anchor="start" x="6558.08" y="-186.8" font-family="Times,serif" font-size="14.00">info : dict</text>
-<text text-anchor="start" x="6558.08" y="-171.8" font-family="Times,serif" font-size="14.00">observation_space : Discrete</text>
-<polyline fill="none" stroke="#77aadd" points="6550.08,-164 6771.08,-164 "/>
-<text text-anchor="start" x="6611.08" y="-149.8" font-family="Times,serif" font-style="italic" font-size="14.00">close</text>
-<text text-anchor="start" x="6648.08" y="-149.8" font-family="Times,serif" font-size="14.00">()</text>
-<text text-anchor="start" x="6611.08" y="-135.8" font-family="Times,serif" font-style="italic" font-size="14.00">render</text>
-<text text-anchor="start" x="6660.08" y="-135.8" font-family="Times,serif" font-size="14.00">(mode)</text>
-<text text-anchor="start" x="6611.08" y="-121.8" font-family="Times,serif" font-size="14.00">reset(seed)</text>
-<text text-anchor="start" x="6611.08" y="-107.8" font-family="Times,serif" font-style="italic" font-size="14.00">step</text>
-<text text-anchor="start" x="6642.08" y="-107.8" font-family="Times,serif" font-size="14.00">(action)</text>
-</g>
 <!-- robot_sf.sim.sim_config.SimulationSettings&#45;&gt;robot_sf.sim.simulator.Simulator -->
 <g id="edge20" class="edge">
 <title>robot_sf.sim.sim_config.SimulationSettings&#45;&gt;robot_sf.sim.simulator.Simulator</title>
@@ -689,35 +671,35 @@
 <text text-anchor="middle" x="1894.08" y="-752.8" font-family="Times,serif" font-size="14.00" fill="green">config</text>
 </g>
 <!-- robot_sf.sim.sim_view.SimulationView -->
-<g id="node33" class="node">
+<g id="node32" class="node">
 <title>robot_sf.sim.sim_view.SimulationView</title>
-<polygon fill="#eedd88" stroke="#eedd88" points="6789.58,-0.5 6789.58,-339.5 7093.58,-339.5 7093.58,-0.5 6789.58,-0.5"/>
-<text text-anchor="start" x="6885.58" y="-324.3" font-family="Times,serif" font-size="14.00">SimulationView</text>
-<polyline fill="none" stroke="#eedd88" points="6789.58,-316.5 7093.58,-316.5 "/>
-<text text-anchor="start" x="6840.58" y="-301.3" font-family="Times,serif" font-size="14.00">font : Font</text>
-<text text-anchor="start" x="6840.58" y="-286.3" font-family="Times,serif" font-size="14.00">goal_radius : float</text>
-<text text-anchor="start" x="6840.58" y="-271.3" font-family="Times,serif" font-size="14.00">height : float</text>
-<text text-anchor="start" x="6840.58" y="-256.3" font-family="Times,serif" font-size="14.00">is_abortion_requested : bool</text>
-<text text-anchor="start" x="6840.58" y="-241.3" font-family="Times,serif" font-size="14.00">is_exit_requested : bool</text>
-<text text-anchor="start" x="6840.58" y="-226.3" font-family="Times,serif" font-size="14.00">obstacles : List[Obstacle]</text>
-<text text-anchor="start" x="6840.58" y="-211.3" font-family="Times,serif" font-size="14.00">ped_radius : float</text>
-<text text-anchor="start" x="6840.58" y="-196.3" font-family="Times,serif" font-size="14.00">robot_radius : float</text>
-<text text-anchor="start" x="6840.58" y="-181.3" font-family="Times,serif" font-size="14.00">scaling : float</text>
-<text text-anchor="start" x="6840.58" y="-166.3" font-family="Times,serif" font-size="14.00">screen</text>
-<text text-anchor="start" x="6840.58" y="-151.3" font-family="Times,serif" font-size="14.00">size_changed : bool</text>
-<text text-anchor="start" x="6840.58" y="-136.3" font-family="Times,serif" font-size="14.00">surface_obstacles</text>
-<text text-anchor="start" x="6840.58" y="-121.3" font-family="Times,serif" font-size="14.00">timestep_text_pos</text>
-<text text-anchor="start" x="6840.58" y="-106.3" font-family="Times,serif" font-size="14.00">ui_events_thread : Thread</text>
-<text text-anchor="start" x="6840.58" y="-91.3" font-family="Times,serif" font-size="14.00">width : float</text>
-<polyline fill="none" stroke="#eedd88" points="6789.58,-83.5 7093.58,-83.5 "/>
-<text text-anchor="start" x="6797.58" y="-68.3" font-family="Times,serif" font-size="14.00">clear()</text>
-<text text-anchor="start" x="6797.58" y="-53.3" font-family="Times,serif" font-size="14.00">exit()</text>
-<text text-anchor="start" x="6797.58" y="-38.3" font-family="Times,serif" font-size="14.00">preprocess_obstacles(): pygame.Surface</text>
-<text text-anchor="start" x="6797.58" y="-23.3" font-family="Times,serif" font-size="14.00">render(state: VisualizableSimState)</text>
-<text text-anchor="start" x="6797.58" y="-8.3" font-family="Times,serif" font-size="14.00">show()</text>
+<polygon fill="#eedd88" stroke="#eedd88" points="6550.58,-0.5 6550.58,-339.5 6854.58,-339.5 6854.58,-0.5 6550.58,-0.5"/>
+<text text-anchor="start" x="6646.58" y="-324.3" font-family="Times,serif" font-size="14.00">SimulationView</text>
+<polyline fill="none" stroke="#eedd88" points="6550.58,-316.5 6854.58,-316.5 "/>
+<text text-anchor="start" x="6601.58" y="-301.3" font-family="Times,serif" font-size="14.00">font : Font</text>
+<text text-anchor="start" x="6601.58" y="-286.3" font-family="Times,serif" font-size="14.00">goal_radius : float</text>
+<text text-anchor="start" x="6601.58" y="-271.3" font-family="Times,serif" font-size="14.00">height : float</text>
+<text text-anchor="start" x="6601.58" y="-256.3" font-family="Times,serif" font-size="14.00">is_abortion_requested : bool</text>
+<text text-anchor="start" x="6601.58" y="-241.3" font-family="Times,serif" font-size="14.00">is_exit_requested : bool</text>
+<text text-anchor="start" x="6601.58" y="-226.3" font-family="Times,serif" font-size="14.00">obstacles : List[Obstacle]</text>
+<text text-anchor="start" x="6601.58" y="-211.3" font-family="Times,serif" font-size="14.00">ped_radius : float</text>
+<text text-anchor="start" x="6601.58" y="-196.3" font-family="Times,serif" font-size="14.00">robot_radius : float</text>
+<text text-anchor="start" x="6601.58" y="-181.3" font-family="Times,serif" font-size="14.00">scaling : float</text>
+<text text-anchor="start" x="6601.58" y="-166.3" font-family="Times,serif" font-size="14.00">screen</text>
+<text text-anchor="start" x="6601.58" y="-151.3" font-family="Times,serif" font-size="14.00">size_changed : bool</text>
+<text text-anchor="start" x="6601.58" y="-136.3" font-family="Times,serif" font-size="14.00">surface_obstacles</text>
+<text text-anchor="start" x="6601.58" y="-121.3" font-family="Times,serif" font-size="14.00">timestep_text_pos</text>
+<text text-anchor="start" x="6601.58" y="-106.3" font-family="Times,serif" font-size="14.00">ui_events_thread : Thread</text>
+<text text-anchor="start" x="6601.58" y="-91.3" font-family="Times,serif" font-size="14.00">width : float</text>
+<polyline fill="none" stroke="#eedd88" points="6550.58,-83.5 6854.58,-83.5 "/>
+<text text-anchor="start" x="6558.58" y="-68.3" font-family="Times,serif" font-size="14.00">clear()</text>
+<text text-anchor="start" x="6558.58" y="-53.3" font-family="Times,serif" font-size="14.00">exit()</text>
+<text text-anchor="start" x="6558.58" y="-38.3" font-family="Times,serif" font-size="14.00">preprocess_obstacles(): pygame.Surface</text>
+<text text-anchor="start" x="6558.58" y="-23.3" font-family="Times,serif" font-size="14.00">render(state: VisualizableSimState)</text>
+<text text-anchor="start" x="6558.58" y="-8.3" font-family="Times,serif" font-size="14.00">show()</text>
 </g>
 <!-- robot_sf.eval.VecEnvMetrics -->
-<g id="node35" class="node">
+<g id="node34" class="node">
 <title>robot_sf.eval.VecEnvMetrics</title>
 <polygon fill="#77aadd" stroke="#77aadd" points="3723.08,-98 3723.08,-242 3946.08,-242 3946.08,-98 3723.08,-98"/>
 <text text-anchor="start" x="3780.58" y="-226.8" font-family="Times,serif" font-size="14.00">VecEnvMetrics</text>
@@ -739,42 +721,42 @@
 <text text-anchor="middle" x="3862.08" y="-361.8" font-family="Times,serif" font-size="14.00" fill="green">metrics</text>
 </g>
 <!-- robot_sf.sim.sim_view.VisualizableAction -->
-<g id="node36" class="node">
+<g id="node35" class="node">
 <title>robot_sf.sim.sim_view.VisualizableAction</title>
-<polygon fill="#eedd88" stroke="#eedd88" points="7111.58,-120.5 7111.58,-219.5 7553.58,-219.5 7553.58,-120.5 7111.58,-120.5"/>
-<text text-anchor="start" x="7267.08" y="-204.3" font-family="Times,serif" font-size="14.00">VisualizableAction</text>
-<polyline fill="none" stroke="#eedd88" points="7111.58,-196.5 7553.58,-196.5 "/>
-<text text-anchor="start" x="7119.58" y="-181.3" font-family="Times,serif" font-size="14.00">robot_action : Union[DifferentialDriveAction, BicycleAction]</text>
-<text text-anchor="start" x="7119.58" y="-166.3" font-family="Times,serif" font-size="14.00">robot_goal : Tuple</text>
-<text text-anchor="start" x="7119.58" y="-151.3" font-family="Times,serif" font-size="14.00">robot_pose : Tuple</text>
-<polyline fill="none" stroke="#eedd88" points="7111.58,-143.5 7553.58,-143.5 "/>
-<text text-anchor="start" x="7330.08" y="-128.3" font-family="Times,serif" font-size="14.00"> </text>
+<polygon fill="#eedd88" stroke="#eedd88" points="6872.58,-120.5 6872.58,-219.5 7314.58,-219.5 7314.58,-120.5 6872.58,-120.5"/>
+<text text-anchor="start" x="7028.08" y="-204.3" font-family="Times,serif" font-size="14.00">VisualizableAction</text>
+<polyline fill="none" stroke="#eedd88" points="6872.58,-196.5 7314.58,-196.5 "/>
+<text text-anchor="start" x="6880.58" y="-181.3" font-family="Times,serif" font-size="14.00">robot_action : Union[DifferentialDriveAction, BicycleAction]</text>
+<text text-anchor="start" x="6880.58" y="-166.3" font-family="Times,serif" font-size="14.00">robot_goal : Tuple</text>
+<text text-anchor="start" x="6880.58" y="-151.3" font-family="Times,serif" font-size="14.00">robot_pose : Tuple</text>
+<polyline fill="none" stroke="#eedd88" points="6872.58,-143.5 7314.58,-143.5 "/>
+<text text-anchor="start" x="7091.08" y="-128.3" font-family="Times,serif" font-size="14.00"> </text>
 </g>
 <!-- robot_sf.sim.sim_view.VisualizableSimState -->
-<g id="node37" class="node">
+<g id="node36" class="node">
 <title>robot_sf.sim.sim_view.VisualizableSimState</title>
-<polygon fill="#eedd88" stroke="#eedd88" points="7571.58,-98 7571.58,-242 7875.58,-242 7875.58,-98 7571.58,-98"/>
-<text text-anchor="start" x="7647.58" y="-226.8" font-family="Times,serif" font-size="14.00">VisualizableSimState</text>
-<polyline fill="none" stroke="#eedd88" points="7571.58,-219 7875.58,-219 "/>
-<text text-anchor="start" x="7579.58" y="-203.8" font-family="Times,serif" font-size="14.00">action : Union[VisualizableAction, None]</text>
-<text text-anchor="start" x="7579.58" y="-188.8" font-family="Times,serif" font-size="14.00">ped_actions : ndarray</text>
-<text text-anchor="start" x="7579.58" y="-173.8" font-family="Times,serif" font-size="14.00">pedestrian_positions : ndarray</text>
-<text text-anchor="start" x="7579.58" y="-158.8" font-family="Times,serif" font-size="14.00">ray_vecs : ndarray</text>
-<text text-anchor="start" x="7579.58" y="-143.8" font-family="Times,serif" font-size="14.00">robot_pose : Tuple</text>
-<text text-anchor="start" x="7579.58" y="-128.8" font-family="Times,serif" font-size="14.00">timestep : int</text>
-<polyline fill="none" stroke="#eedd88" points="7571.58,-121 7875.58,-121 "/>
-<text text-anchor="start" x="7721.08" y="-105.8" font-family="Times,serif" font-size="14.00"> </text>
+<polygon fill="#eedd88" stroke="#eedd88" points="7332.58,-98 7332.58,-242 7636.58,-242 7636.58,-98 7332.58,-98"/>
+<text text-anchor="start" x="7408.58" y="-226.8" font-family="Times,serif" font-size="14.00">VisualizableSimState</text>
+<polyline fill="none" stroke="#eedd88" points="7332.58,-219 7636.58,-219 "/>
+<text text-anchor="start" x="7340.58" y="-203.8" font-family="Times,serif" font-size="14.00">action : Union[VisualizableAction, None]</text>
+<text text-anchor="start" x="7340.58" y="-188.8" font-family="Times,serif" font-size="14.00">ped_actions : ndarray</text>
+<text text-anchor="start" x="7340.58" y="-173.8" font-family="Times,serif" font-size="14.00">pedestrian_positions : ndarray</text>
+<text text-anchor="start" x="7340.58" y="-158.8" font-family="Times,serif" font-size="14.00">ray_vecs : ndarray</text>
+<text text-anchor="start" x="7340.58" y="-143.8" font-family="Times,serif" font-size="14.00">robot_pose : Tuple</text>
+<text text-anchor="start" x="7340.58" y="-128.8" font-family="Times,serif" font-size="14.00">timestep : int</text>
+<polyline fill="none" stroke="#eedd88" points="7332.58,-121 7636.58,-121 "/>
+<text text-anchor="start" x="7482.08" y="-105.8" font-family="Times,serif" font-size="14.00"> </text>
 </g>
 <!-- robot_sf.ped_npc.ped_population.ZonePointsGenerator -->
-<g id="node38" class="node">
+<g id="node37" class="node">
 <title>robot_sf.ped_npc.ped_population.ZonePointsGenerator</title>
-<polygon fill="#44bb99" stroke="#44bb99" points="7893.58,-128 7893.58,-212 8279.58,-212 8279.58,-128 7893.58,-128"/>
-<text text-anchor="start" x="8010.08" y="-196.8" font-family="Times,serif" font-size="14.00">ZonePointsGenerator</text>
-<polyline fill="none" stroke="#44bb99" points="7893.58,-189 8279.58,-189 "/>
-<text text-anchor="start" x="8005.58" y="-173.8" font-family="Times,serif" font-size="14.00">zone_areas : List[float]</text>
-<text text-anchor="start" x="8005.58" y="-158.8" font-family="Times,serif" font-size="14.00">zones : List[Zone]</text>
-<polyline fill="none" stroke="#44bb99" points="7893.58,-151 8279.58,-151 "/>
-<text text-anchor="start" x="7901.58" y="-135.8" font-family="Times,serif" font-size="14.00">generate(num_samples: int): Tuple[List[Vec2D], int]</text>
+<polygon fill="#44bb99" stroke="#44bb99" points="7654.58,-128 7654.58,-212 8040.58,-212 8040.58,-128 7654.58,-128"/>
+<text text-anchor="start" x="7771.08" y="-196.8" font-family="Times,serif" font-size="14.00">ZonePointsGenerator</text>
+<polyline fill="none" stroke="#44bb99" points="7654.58,-189 8040.58,-189 "/>
+<text text-anchor="start" x="7766.58" y="-173.8" font-family="Times,serif" font-size="14.00">zone_areas : List[float]</text>
+<text text-anchor="start" x="7766.58" y="-158.8" font-family="Times,serif" font-size="14.00">zones : List[Zone]</text>
+<polyline fill="none" stroke="#44bb99" points="7654.58,-151 8040.58,-151 "/>
+<text text-anchor="start" x="7662.58" y="-135.8" font-family="Times,serif" font-size="14.00">generate(num_samples: int): Tuple[List[Vec2D], int]</text>
 </g>
 </g>
 </svg>
diff --git a/robot_sf/packages.svg b/robot_sf/packages.svg
index de66af5..f2182ce 100644
--- a/robot_sf/packages.svg
+++ b/robot_sf/packages.svg
@@ -4,334 +4,406 @@
 <!-- Generated by graphviz version 2.43.0 (0)
  -->
 <!-- Title: packages Pages: 1 -->
-<svg width="2621pt" height="332pt"
- viewBox="0.00 0.00 2620.50 332.00" xmlns="http://www.w3.org/2000/svg" xmlns:xlink="http://www.w3.org/1999/xlink">
-<g id="graph0" class="graph" transform="scale(1 1) rotate(0) translate(4 328)">
+<svg width="2908pt" height="476pt"
+ viewBox="0.00 0.00 2907.50 476.00" xmlns="http://www.w3.org/2000/svg" xmlns:xlink="http://www.w3.org/1999/xlink">
+<g id="graph0" class="graph" transform="scale(1 1) rotate(0) translate(4 472)">
 <title>packages</title>
-<polygon fill="white" stroke="transparent" points="-4,4 -4,-328 2616.5,-328 2616.5,4 -4,4"/>
+<polygon fill="white" stroke="transparent" points="-4,4 -4,-472 2903.5,-472 2903.5,4 -4,4"/>
 <!-- robot_sf -->
 <g id="node1" class="node">
 <title>robot_sf</title>
-<polygon fill="#77aadd" stroke="#77aadd" points="74,-36 0,-36 0,0 74,0 74,-36"/>
-<text text-anchor="middle" x="37" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf</text>
+<polygon fill="#77aadd" stroke="#77aadd" points="515.5,-36 441.5,-36 441.5,0 515.5,0 515.5,-36"/>
+<text text-anchor="middle" x="478.5" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf</text>
 </g>
 <!-- robot_sf.eval -->
 <g id="node2" class="node">
 <title>robot_sf.eval</title>
-<polygon fill="#77aadd" stroke="#77aadd" points="222.5,-108 115.5,-108 115.5,-72 222.5,-72 222.5,-108"/>
-<text text-anchor="middle" x="169" y="-86.3" font-family="Times,serif" font-size="14.00">robot_sf.eval</text>
+<polygon fill="#77aadd" stroke="#77aadd" points="664,-108 557,-108 557,-72 664,-72 664,-108"/>
+<text text-anchor="middle" x="610.5" y="-86.3" font-family="Times,serif" font-size="14.00">robot_sf.eval</text>
 </g>
 <!-- robot_sf.feature_extractor -->
 <g id="node3" class="node">
 <title>robot_sf.feature_extractor</title>
-<polygon fill="#77aadd" stroke="#77aadd" points="495.5,-36 292.5,-36 292.5,0 495.5,0 495.5,-36"/>
-<text text-anchor="middle" x="394" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.feature_extractor</text>
+<polygon fill="#77aadd" stroke="#77aadd" points="203,-180 0,-180 0,-144 203,-144 203,-180"/>
+<text text-anchor="middle" x="101.5" y="-158.3" font-family="Times,serif" font-size="14.00">robot_sf.feature_extractor</text>
+</g>
+<!-- robot_sf.sensor.sensor_fusion -->
+<g id="node24" class="node">
+<title>robot_sf.sensor.sensor_fusion</title>
+<polygon fill="#aaaa00" stroke="#aaaa00" points="294.5,-252 68.5,-252 68.5,-216 294.5,-216 294.5,-252"/>
+<text text-anchor="middle" x="181.5" y="-230.3" font-family="Times,serif" font-size="14.00">robot_sf.sensor.sensor_fusion</text>
+</g>
+<!-- robot_sf.feature_extractor&#45;&gt;robot_sf.sensor.sensor_fusion -->
+<g id="edge1" class="edge">
+<title>robot_sf.feature_extractor&#45;&gt;robot_sf.sensor.sensor_fusion</title>
+<path fill="none" stroke="black" d="M121.28,-180.3C131.25,-189.03 143.51,-199.76 154.36,-209.25"/>
+<polygon fill="black" stroke="black" points="161.95,-215.9 151.46,-212.7 158.19,-212.6 154.43,-209.31 154.43,-209.31 154.43,-209.31 158.19,-212.6 157.39,-205.92 161.95,-215.9 161.95,-215.9"/>
 </g>
 <!-- robot_sf.nav -->
 <g id="node4" class="node">
 <title>robot_sf.nav</title>
-<polygon fill="#99ddff" stroke="#99ddff" points="676,-36 572,-36 572,0 676,0 676,-36"/>
-<text text-anchor="middle" x="624" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.nav</text>
+<polygon fill="#99ddff" stroke="#99ddff" points="2113.5,-36 2009.5,-36 2009.5,0 2113.5,0 2113.5,-36"/>
+<text text-anchor="middle" x="2061.5" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.nav</text>
 </g>
-<!-- robot_sf.nav.map_config -->
+<!-- robot_sf.nav.gloabal_route -->
 <g id="node5" class="node">
+<title>robot_sf.nav.gloabal_route</title>
+<polygon fill="#99ddff" stroke="#99ddff" points="1268,-396 1065,-396 1065,-360 1268,-360 1268,-396"/>
+<text text-anchor="middle" x="1166.5" y="-374.3" font-family="Times,serif" font-size="14.00">robot_sf.nav.gloabal_route</text>
+</g>
+<!-- robot_sf.nav.nav_types -->
+<g id="node7" class="node">
+<title>robot_sf.nav.nav_types</title>
+<polygon fill="#99ddff" stroke="#99ddff" points="1053,-468 876,-468 876,-432 1053,-432 1053,-468"/>
+<text text-anchor="middle" x="964.5" y="-446.3" font-family="Times,serif" font-size="14.00">robot_sf.nav.nav_types</text>
+</g>
+<!-- robot_sf.nav.gloabal_route&#45;&gt;robot_sf.nav.nav_types -->
+<g id="edge2" class="edge">
+<title>robot_sf.nav.gloabal_route&#45;&gt;robot_sf.nav.nav_types</title>
+<path fill="none" stroke="black" d="M1117.34,-396.03C1089,-405.86 1053.18,-418.27 1023.34,-428.61"/>
+<polygon fill="black" stroke="black" points="1013.88,-431.89 1021.85,-424.36 1018.6,-430.25 1023.33,-428.61 1023.33,-428.61 1023.33,-428.61 1018.6,-430.25 1024.8,-432.87 1013.88,-431.89 1013.88,-431.89"/>
+</g>
+<!-- robot_sf.nav.map_config -->
+<g id="node6" class="node">
 <title>robot_sf.nav.map_config</title>
-<polygon fill="#99ddff" stroke="#99ddff" points="933,-324 747,-324 747,-288 933,-288 933,-324"/>
-<text text-anchor="middle" x="840" y="-302.3" font-family="Times,serif" font-size="14.00">robot_sf.nav.map_config</text>
+<polygon fill="#99ddff" stroke="#99ddff" points="1274.5,-324 1088.5,-324 1088.5,-288 1274.5,-288 1274.5,-324"/>
+<text text-anchor="middle" x="1181.5" y="-302.3" font-family="Times,serif" font-size="14.00">robot_sf.nav.map_config</text>
+</g>
+<!-- robot_sf.nav.map_config&#45;&gt;robot_sf.nav.gloabal_route -->
+<g id="edge3" class="edge">
+<title>robot_sf.nav.map_config&#45;&gt;robot_sf.nav.gloabal_route</title>
+<path fill="none" stroke="black" d="M1177.79,-324.3C1176.14,-332.02 1174.15,-341.29 1172.31,-349.89"/>
+<polygon fill="black" stroke="black" points="1170.17,-359.9 1167.86,-349.17 1171.21,-355.01 1172.26,-350.12 1172.26,-350.12 1172.26,-350.12 1171.21,-355.01 1176.66,-351.06 1170.17,-359.9 1170.17,-359.9"/>
+</g>
+<!-- robot_sf.nav.map_config&#45;&gt;robot_sf.nav.nav_types -->
+<g id="edge4" class="edge">
+<title>robot_sf.nav.map_config&#45;&gt;robot_sf.nav.nav_types</title>
+<path fill="none" stroke="black" d="M1234.72,-324.04C1251.39,-332.16 1267.92,-343.77 1277.5,-360 1285.63,-373.78 1287.83,-383.78 1277.5,-396 1250.38,-428.1 1144.53,-440.76 1063.35,-445.75"/>
+<polygon fill="black" stroke="black" points="1053.08,-446.35 1062.8,-441.28 1058.07,-446.06 1063.06,-445.77 1063.06,-445.77 1063.06,-445.77 1058.07,-446.06 1063.32,-450.26 1053.08,-446.35 1053.08,-446.35"/>
+</g>
+<!-- robot_sf.nav.obstacle -->
+<g id="node9" class="node">
+<title>robot_sf.nav.obstacle</title>
+<polygon fill="#99ddff" stroke="#99ddff" points="1047,-396 882,-396 882,-360 1047,-360 1047,-396"/>
+<text text-anchor="middle" x="964.5" y="-374.3" font-family="Times,serif" font-size="14.00">robot_sf.nav.obstacle</text>
+</g>
+<!-- robot_sf.nav.map_config&#45;&gt;robot_sf.nav.obstacle -->
+<g id="edge5" class="edge">
+<title>robot_sf.nav.map_config&#45;&gt;robot_sf.nav.obstacle</title>
+<path fill="none" stroke="black" d="M1128.69,-324.03C1098.11,-333.9 1059.43,-346.38 1027.29,-356.75"/>
+<polygon fill="black" stroke="black" points="1017.54,-359.89 1025.68,-352.54 1022.3,-358.35 1027.06,-356.82 1027.06,-356.82 1027.06,-356.82 1022.3,-358.35 1028.44,-361.1 1017.54,-359.89 1017.54,-359.89"/>
 </g>
 <!-- robot_sf.nav.navigation -->
-<g id="node6" class="node">
+<g id="node8" class="node">
 <title>robot_sf.nav.navigation</title>
-<polygon fill="#99ddff" stroke="#99ddff" points="901.5,-252 720.5,-252 720.5,-216 901.5,-216 901.5,-252"/>
-<text text-anchor="middle" x="811" y="-230.3" font-family="Times,serif" font-size="14.00">robot_sf.nav.navigation</text>
+<polygon fill="#99ddff" stroke="#99ddff" points="772,-252 591,-252 591,-216 772,-216 772,-252"/>
+<text text-anchor="middle" x="681.5" y="-230.3" font-family="Times,serif" font-size="14.00">robot_sf.nav.navigation</text>
 </g>
 <!-- robot_sf.nav.navigation&#45;&gt;robot_sf.nav.map_config -->
-<g id="edge1" class="edge">
+<g id="edge6" class="edge">
 <title>robot_sf.nav.navigation&#45;&gt;robot_sf.nav.map_config</title>
-<path fill="none" stroke="black" d="M818.17,-252.3C821.43,-260.19 825.37,-269.7 829,-278.45"/>
-<polygon fill="black" stroke="black" points="832.91,-287.9 824.93,-280.38 831,-283.28 829.09,-278.66 829.09,-278.66 829.09,-278.66 831,-283.28 833.24,-276.93 832.91,-287.9 832.91,-287.9"/>
+<path fill="none" stroke="black" d="M772.05,-247.68C858.3,-259.75 988.03,-277.91 1078.26,-290.55"/>
+<polygon fill="black" stroke="black" points="1088.24,-291.94 1077.71,-295.01 1083.29,-291.25 1078.33,-290.56 1078.33,-290.56 1078.33,-290.56 1083.29,-291.25 1078.96,-286.1 1088.24,-291.94 1088.24,-291.94"/>
+</g>
+<!-- robot_sf.nav.navigation&#45;&gt;robot_sf.nav.nav_types -->
+<g id="edge7" class="edge">
+<title>robot_sf.nav.navigation&#45;&gt;robot_sf.nav.nav_types</title>
+<path fill="none" stroke="black" d="M644.99,-252.08C630.9,-260.71 616.32,-272.65 608.5,-288 601.23,-302.25 599.57,-310.72 608.5,-324 664.54,-407.3 781.09,-435.66 865.6,-445.01"/>
+<polygon fill="black" stroke="black" points="875.74,-446.06 865.33,-449.51 870.77,-445.54 865.8,-445.03 865.8,-445.03 865.8,-445.03 870.77,-445.54 866.26,-440.55 875.74,-446.06 875.74,-446.06"/>
 </g>
 <!-- robot_sf.ped_npc.ped_zone -->
-<g id="node13" class="node">
+<g id="node16" class="node">
 <title>robot_sf.ped_npc.ped_zone</title>
-<polygon fill="#44bb99" stroke="#44bb99" points="728.5,-324 521.5,-324 521.5,-288 728.5,-288 728.5,-324"/>
-<text text-anchor="middle" x="625" y="-302.3" font-family="Times,serif" font-size="14.00">robot_sf.ped_npc.ped_zone</text>
+<polygon fill="#44bb99" stroke="#44bb99" points="825,-324 618,-324 618,-288 825,-288 825,-324"/>
+<text text-anchor="middle" x="721.5" y="-302.3" font-family="Times,serif" font-size="14.00">robot_sf.ped_npc.ped_zone</text>
 </g>
 <!-- robot_sf.nav.navigation&#45;&gt;robot_sf.ped_npc.ped_zone -->
-<g id="edge2" class="edge">
+<g id="edge8" class="edge">
 <title>robot_sf.nav.navigation&#45;&gt;robot_sf.ped_npc.ped_zone</title>
-<path fill="none" stroke="black" d="M765.5,-252.12C739.62,-261.86 707.03,-274.13 679.76,-284.39"/>
-<polygon fill="black" stroke="black" points="670.35,-287.93 678.13,-280.2 675.03,-286.17 679.71,-284.41 679.71,-284.41 679.71,-284.41 675.03,-286.17 681.3,-288.62 670.35,-287.93 670.35,-287.93"/>
+<path fill="none" stroke="black" d="M691.39,-252.3C695.99,-260.36 701.56,-270.11 706.65,-279.02"/>
+<polygon fill="black" stroke="black" points="711.73,-287.9 702.86,-281.45 709.25,-283.55 706.76,-279.21 706.76,-279.21 706.76,-279.21 709.25,-283.55 710.67,-276.98 711.73,-287.9 711.73,-287.9"/>
+</g>
+<!-- robot_sf.nav.obstacle&#45;&gt;robot_sf.nav.nav_types -->
+<g id="edge9" class="edge">
+<title>robot_sf.nav.obstacle&#45;&gt;robot_sf.nav.nav_types</title>
+<path fill="none" stroke="black" d="M964.5,-396.3C964.5,-404.02 964.5,-413.29 964.5,-421.89"/>
+<polygon fill="black" stroke="black" points="964.5,-431.9 960,-421.9 964.5,-426.9 964.5,-421.9 964.5,-421.9 964.5,-421.9 964.5,-426.9 969,-421.9 964.5,-431.9 964.5,-431.9"/>
 </g>
 <!-- robot_sf.nav.occupancy -->
-<g id="node7" class="node">
+<g id="node10" class="node">
 <title>robot_sf.nav.occupancy</title>
-<polygon fill="#99ddff" stroke="#99ddff" points="2111,-252 1931,-252 1931,-216 2111,-216 2111,-252"/>
-<text text-anchor="middle" x="2021" y="-230.3" font-family="Times,serif" font-size="14.00">robot_sf.nav.occupancy</text>
+<polygon fill="#99ddff" stroke="#99ddff" points="497.5,-252 317.5,-252 317.5,-216 497.5,-216 497.5,-252"/>
+<text text-anchor="middle" x="407.5" y="-230.3" font-family="Times,serif" font-size="14.00">robot_sf.nav.occupancy</text>
 </g>
 <!-- robot_sf.ped_npc -->
-<g id="node8" class="node">
+<g id="node11" class="node">
 <title>robot_sf.ped_npc</title>
-<polygon fill="#44bb99" stroke="#44bb99" points="1760.5,-36 1623.5,-36 1623.5,0 1760.5,0 1760.5,-36"/>
-<text text-anchor="middle" x="1692" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.ped_npc</text>
+<polygon fill="#44bb99" stroke="#44bb99" points="2269,-36 2132,-36 2132,0 2269,0 2269,-36"/>
+<text text-anchor="middle" x="2200.5" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.ped_npc</text>
 </g>
 <!-- robot_sf.ped_npc.ped_behavior -->
-<g id="node9" class="node">
+<g id="node12" class="node">
 <title>robot_sf.ped_npc.ped_behavior</title>
-<polygon fill="#44bb99" stroke="#44bb99" points="783,-180 547,-180 547,-144 783,-144 783,-180"/>
-<text text-anchor="middle" x="665" y="-158.3" font-family="Times,serif" font-size="14.00">robot_sf.ped_npc.ped_behavior</text>
+<polygon fill="#44bb99" stroke="#44bb99" points="956.5,-180 720.5,-180 720.5,-144 956.5,-144 956.5,-180"/>
+<text text-anchor="middle" x="838.5" y="-158.3" font-family="Times,serif" font-size="14.00">robot_sf.ped_npc.ped_behavior</text>
 </g>
 <!-- robot_sf.ped_npc.ped_behavior&#45;&gt;robot_sf.nav.map_config -->
-<g id="edge3" class="edge">
+<g id="edge10" class="edge">
 <title>robot_sf.ped_npc.ped_behavior&#45;&gt;robot_sf.nav.map_config</title>
-<path fill="none" stroke="black" d="M669.93,-180.32C676.38,-200.1 689.46,-232.26 711,-252 726.12,-265.85 745.35,-276.34 764.32,-284.17"/>
-<polygon fill="black" stroke="black" points="773.9,-287.92 762.94,-288.47 769.24,-286.1 764.58,-284.28 764.58,-284.28 764.58,-284.28 769.24,-286.1 766.22,-280.09 773.9,-287.92 773.9,-287.92"/>
+<path fill="none" stroke="black" d="M844.76,-180.13C853.2,-200.66 870.27,-234.49 896.5,-252 925.97,-271.67 1009.26,-285.74 1078.24,-294.42"/>
+<polygon fill="black" stroke="black" points="1088.31,-295.66 1077.83,-298.9 1083.34,-295.04 1078.38,-294.43 1078.38,-294.43 1078.38,-294.43 1083.34,-295.04 1078.93,-289.97 1088.31,-295.66 1088.31,-295.66"/>
+</g>
+<!-- robot_sf.ped_npc.ped_behavior&#45;&gt;robot_sf.nav.nav_types -->
+<g id="edge11" class="edge">
+<title>robot_sf.ped_npc.ped_behavior&#45;&gt;robot_sf.nav.nav_types</title>
+<path fill="none" stroke="black" d="M836.24,-180.3C831.79,-221.59 826,-327.52 872.5,-396 881.33,-409.01 894.5,-419.23 908.12,-427.09"/>
+<polygon fill="black" stroke="black" points="917.1,-431.91 906.16,-431.14 912.7,-429.54 908.29,-427.18 908.29,-427.18 908.29,-427.18 912.7,-429.54 910.42,-423.21 917.1,-431.91 917.1,-431.91"/>
 </g>
 <!-- robot_sf.ped_npc.ped_behavior&#45;&gt;robot_sf.nav.navigation -->
-<g id="edge4" class="edge">
+<g id="edge12" class="edge">
 <title>robot_sf.ped_npc.ped_behavior&#45;&gt;robot_sf.nav.navigation</title>
-<path fill="none" stroke="black" d="M700.72,-180.12C720.5,-189.61 745.27,-201.49 766.33,-211.58"/>
-<polygon fill="black" stroke="black" points="775.4,-215.93 764.44,-215.67 770.89,-213.77 766.38,-211.61 766.38,-211.61 766.38,-211.61 770.89,-213.77 768.33,-207.55 775.4,-215.93 775.4,-215.93"/>
+<path fill="none" stroke="black" d="M800.09,-180.12C778.63,-189.69 751.7,-201.7 728.93,-211.85"/>
+<polygon fill="black" stroke="black" points="719.78,-215.93 727.08,-207.75 724.35,-213.9 728.92,-211.86 728.92,-211.86 728.92,-211.86 724.35,-213.9 730.75,-215.97 719.78,-215.93 719.78,-215.93"/>
 </g>
 <!-- robot_sf.ped_npc.ped_grouping -->
-<g id="node10" class="node">
+<g id="node13" class="node">
 <title>robot_sf.ped_npc.ped_grouping</title>
-<polygon fill="#44bb99" stroke="#44bb99" points="625.5,-252 386.5,-252 386.5,-216 625.5,-216 625.5,-252"/>
-<text text-anchor="middle" x="506" y="-230.3" font-family="Times,serif" font-size="14.00">robot_sf.ped_npc.ped_grouping</text>
+<polygon fill="#44bb99" stroke="#44bb99" points="1144,-252 905,-252 905,-216 1144,-216 1144,-252"/>
+<text text-anchor="middle" x="1024.5" y="-230.3" font-family="Times,serif" font-size="14.00">robot_sf.ped_npc.ped_grouping</text>
 </g>
 <!-- robot_sf.ped_npc.ped_behavior&#45;&gt;robot_sf.ped_npc.ped_grouping -->
-<g id="edge5" class="edge">
+<g id="edge13" class="edge">
 <title>robot_sf.ped_npc.ped_behavior&#45;&gt;robot_sf.ped_npc.ped_grouping</title>
-<path fill="none" stroke="black" d="M626.1,-180.12C604.37,-189.69 577.1,-201.7 554.04,-211.85"/>
-<polygon fill="black" stroke="black" points="544.77,-215.93 552.11,-207.78 549.35,-213.92 553.92,-211.9 553.92,-211.9 553.92,-211.9 549.35,-213.92 555.73,-216.02 544.77,-215.93 544.77,-215.93"/>
+<path fill="none" stroke="black" d="M884,-180.12C909.88,-189.86 942.47,-202.13 969.74,-212.39"/>
+<polygon fill="black" stroke="black" points="979.15,-215.93 968.2,-216.62 974.47,-214.17 969.79,-212.41 969.79,-212.41 969.79,-212.41 974.47,-214.17 971.37,-208.2 979.15,-215.93 979.15,-215.93"/>
 </g>
 <!-- robot_sf.ped_npc.ped_behavior&#45;&gt;robot_sf.ped_npc.ped_zone -->
-<g id="edge6" class="edge">
+<g id="edge14" class="edge">
 <title>robot_sf.ped_npc.ped_behavior&#45;&gt;robot_sf.ped_npc.ped_zone</title>
-<path fill="none" stroke="black" d="M660.18,-180.13C653.33,-204.44 640.72,-249.18 632.61,-277.99"/>
-<polygon fill="black" stroke="black" points="629.84,-287.81 628.22,-276.97 631.2,-283 632.55,-278.19 632.55,-278.19 632.55,-278.19 631.2,-283 636.88,-279.41 629.84,-287.81 629.84,-287.81"/>
+<path fill="none" stroke="black" d="M829.03,-180.32C818.44,-198.96 800.18,-229.03 780.5,-252 771.67,-262.31 760.88,-272.55 750.96,-281.23"/>
+<polygon fill="black" stroke="black" points="743.24,-287.84 747.91,-277.92 747.04,-284.59 750.84,-281.34 750.84,-281.34 750.84,-281.34 747.04,-284.59 753.77,-284.75 743.24,-287.84 743.24,-287.84"/>
 </g>
 <!-- robot_sf.ped_npc.ped_population -->
-<g id="node11" class="node">
+<g id="node14" class="node">
 <title>robot_sf.ped_npc.ped_population</title>
-<polygon fill="#44bb99" stroke="#44bb99" points="491,-108 241,-108 241,-72 491,-72 491,-108"/>
-<text text-anchor="middle" x="366" y="-86.3" font-family="Times,serif" font-size="14.00">robot_sf.ped_npc.ped_population</text>
+<polygon fill="#44bb99" stroke="#44bb99" points="1220.5,-108 970.5,-108 970.5,-72 1220.5,-72 1220.5,-108"/>
+<text text-anchor="middle" x="1095.5" y="-86.3" font-family="Times,serif" font-size="14.00">robot_sf.ped_npc.ped_population</text>
 </g>
 <!-- robot_sf.ped_npc.ped_population&#45;&gt;robot_sf.nav.map_config -->
-<g id="edge7" class="edge">
+<g id="edge15" class="edge">
 <title>robot_sf.ped_npc.ped_population&#45;&gt;robot_sf.nav.map_config</title>
-<path fill="none" stroke="black" d="M360.9,-108.14C352.29,-141.01 339.27,-213.07 377,-252 430.93,-307.65 641.3,-279.66 736.62,-288.23"/>
-<polygon fill="black" stroke="black" points="746.84,-289.35 736.41,-292.73 741.87,-288.8 736.9,-288.26 736.9,-288.26 736.9,-288.26 741.87,-288.8 737.39,-283.78 746.84,-289.35 746.84,-289.35"/>
+<path fill="none" stroke="black" d="M1145.06,-108.15C1161.19,-116.36 1177.3,-127.99 1186.5,-144 1210.5,-185.75 1199.95,-244.17 1190.47,-277.95"/>
+<polygon fill="black" stroke="black" points="1187.61,-287.6 1186.14,-276.73 1189.03,-282.81 1190.46,-278.01 1190.46,-278.01 1190.46,-278.01 1189.03,-282.81 1194.77,-279.3 1187.61,-287.6 1187.61,-287.6"/>
+</g>
+<!-- robot_sf.ped_npc.ped_population&#45;&gt;robot_sf.nav.nav_types -->
+<g id="edge16" class="edge">
+<title>robot_sf.ped_npc.ped_population&#45;&gt;robot_sf.nav.nav_types</title>
+<path fill="none" stroke="black" d="M1220.51,-105.6C1488.16,-137.28 2092.5,-211.22 2092.5,-233 2092.5,-233 2092.5,-233 2092.5,-307 2092.5,-410.28 1338.44,-439.6 1063.38,-446.86"/>
+<polygon fill="black" stroke="black" points="1053.01,-447.13 1062.89,-442.37 1058.01,-447 1063.01,-446.87 1063.01,-446.87 1063.01,-446.87 1058.01,-447 1063.13,-451.37 1053.01,-447.13 1053.01,-447.13"/>
 </g>
 <!-- robot_sf.ped_npc.ped_population&#45;&gt;robot_sf.ped_npc.ped_behavior -->
-<g id="edge8" class="edge">
+<g id="edge17" class="edge">
 <title>robot_sf.ped_npc.ped_population&#45;&gt;robot_sf.ped_npc.ped_behavior</title>
-<path fill="none" stroke="black" d="M438.76,-108.03C482.16,-118.2 537.4,-131.13 582.43,-141.67"/>
-<polygon fill="black" stroke="black" points="592.17,-143.95 581.41,-146.05 587.3,-142.81 582.44,-141.67 582.44,-141.67 582.44,-141.67 587.3,-142.81 583.46,-137.29 592.17,-143.95 592.17,-143.95"/>
+<path fill="none" stroke="black" d="M1032.96,-108.03C996.27,-118.03 949.74,-130.7 911.39,-141.15"/>
+<polygon fill="black" stroke="black" points="901.32,-143.89 909.79,-136.92 906.15,-142.58 910.97,-141.26 910.97,-141.26 910.97,-141.26 906.15,-142.58 912.15,-145.6 901.32,-143.89 901.32,-143.89"/>
 </g>
 <!-- robot_sf.ped_npc.ped_population&#45;&gt;robot_sf.ped_npc.ped_grouping -->
-<g id="edge9" class="edge">
+<g id="edge18" class="edge">
 <title>robot_sf.ped_npc.ped_population&#45;&gt;robot_sf.ped_npc.ped_grouping</title>
-<path fill="none" stroke="black" d="M382.89,-108.13C407.59,-133.18 453.7,-179.95 481.94,-208.59"/>
-<polygon fill="black" stroke="black" points="489.05,-215.81 478.83,-211.85 485.54,-212.25 482.03,-208.69 482.03,-208.69 482.03,-208.69 485.54,-212.25 485.24,-205.53 489.05,-215.81 489.05,-215.81"/>
+<path fill="none" stroke="black" d="M1086.94,-108.13C1074.68,-132.65 1052.02,-177.97 1037.63,-206.74"/>
+<polygon fill="black" stroke="black" points="1033.09,-215.81 1033.54,-204.85 1035.33,-211.34 1037.57,-206.87 1037.57,-206.87 1037.57,-206.87 1035.33,-211.34 1041.59,-208.88 1033.09,-215.81 1033.09,-215.81"/>
 </g>
 <!-- robot_sf.ped_npc.ped_population&#45;&gt;robot_sf.ped_npc.ped_zone -->
-<g id="edge10" class="edge">
+<g id="edge19" class="edge">
 <title>robot_sf.ped_npc.ped_population&#45;&gt;robot_sf.ped_npc.ped_zone</title>
-<path fill="none" stroke="black" d="M356.08,-108.34C339.09,-140.59 309.43,-210.3 344,-252 365.48,-277.91 443.03,-291.24 511.23,-298.05"/>
-<polygon fill="black" stroke="black" points="521.21,-299.01 510.83,-302.53 516.24,-298.53 511.26,-298.05 511.26,-298.05 511.26,-298.05 516.24,-298.53 511.69,-293.57 521.21,-299.01 521.21,-299.01"/>
+<path fill="none" stroke="black" d="M1111.65,-108.15C1139.77,-140.08 1191.3,-209.28 1153.5,-252 1132.65,-275.57 956.04,-290.9 835.2,-298.74"/>
+<polygon fill="black" stroke="black" points="825.14,-299.39 834.83,-294.26 830.13,-299.07 835.12,-298.75 835.12,-298.75 835.12,-298.75 830.13,-299.07 835.41,-303.24 825.14,-299.39 825.14,-299.39"/>
 </g>
 <!-- robot_sf.ped_npc.ped_robot_force -->
-<g id="node12" class="node">
+<g id="node15" class="node">
 <title>robot_sf.ped_npc.ped_robot_force</title>
-<polygon fill="#44bb99" stroke="#44bb99" points="1132.5,-108 877.5,-108 877.5,-72 1132.5,-72 1132.5,-108"/>
-<text text-anchor="middle" x="1005" y="-86.3" font-family="Times,serif" font-size="14.00">robot_sf.ped_npc.ped_robot_force</text>
+<polygon fill="#44bb99" stroke="#44bb99" points="1532,-108 1277,-108 1277,-72 1532,-72 1532,-108"/>
+<text text-anchor="middle" x="1404.5" y="-86.3" font-family="Times,serif" font-size="14.00">robot_sf.ped_npc.ped_robot_force</text>
+</g>
+<!-- robot_sf.ped_npc.ped_zone&#45;&gt;robot_sf.nav.nav_types -->
+<g id="edge20" class="edge">
+<title>robot_sf.ped_npc.ped_zone&#45;&gt;robot_sf.nav.nav_types</title>
+<path fill="none" stroke="black" d="M740.91,-324.02C763.48,-343.23 802.39,-374.57 839.5,-396 860.84,-408.32 885.59,-419.42 907.41,-428.23"/>
+<polygon fill="black" stroke="black" points="916.89,-431.99 905.93,-432.49 912.24,-430.15 907.59,-428.3 907.59,-428.3 907.59,-428.3 912.24,-430.15 909.25,-424.12 916.89,-431.99 916.89,-431.99"/>
 </g>
 <!-- robot_sf.robot -->
-<g id="node14" class="node">
+<g id="node17" class="node">
 <title>robot_sf.robot</title>
-<polygon fill="#bbcc33" stroke="#bbcc33" points="1895,-36 1779,-36 1779,0 1895,0 1895,-36"/>
-<text text-anchor="middle" x="1837" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.robot</text>
+<polygon fill="#bbcc33" stroke="#bbcc33" points="2403.5,-36 2287.5,-36 2287.5,0 2403.5,0 2403.5,-36"/>
+<text text-anchor="middle" x="2345.5" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.robot</text>
 </g>
 <!-- robot_sf.robot.bicycle_drive -->
-<g id="node15" class="node">
+<g id="node18" class="node">
 <title>robot_sf.robot.bicycle_drive</title>
-<polygon fill="#bbcc33" stroke="#bbcc33" points="1626,-108 1412,-108 1412,-72 1626,-72 1626,-108"/>
-<text text-anchor="middle" x="1519" y="-86.3" font-family="Times,serif" font-size="14.00">robot_sf.robot.bicycle_drive</text>
+<polygon fill="#bbcc33" stroke="#bbcc33" points="1764.5,-108 1550.5,-108 1550.5,-72 1764.5,-72 1764.5,-108"/>
+<text text-anchor="middle" x="1657.5" y="-86.3" font-family="Times,serif" font-size="14.00">robot_sf.robot.bicycle_drive</text>
 </g>
 <!-- robot_sf.robot.differential_drive -->
-<g id="node16" class="node">
+<g id="node19" class="node">
 <title>robot_sf.robot.differential_drive</title>
-<polygon fill="#bbcc33" stroke="#bbcc33" points="1393.5,-108 1150.5,-108 1150.5,-72 1393.5,-72 1393.5,-108"/>
-<text text-anchor="middle" x="1272" y="-86.3" font-family="Times,serif" font-size="14.00">robot_sf.robot.differential_drive</text>
+<polygon fill="#bbcc33" stroke="#bbcc33" points="2026,-108 1783,-108 1783,-72 2026,-72 2026,-108"/>
+<text text-anchor="middle" x="1904.5" y="-86.3" font-family="Times,serif" font-size="14.00">robot_sf.robot.differential_drive</text>
 </g>
 <!-- robot_sf.robot.robot_state -->
-<g id="node17" class="node">
+<g id="node20" class="node">
 <title>robot_sf.robot.robot_state</title>
-<polygon fill="#bbcc33" stroke="#bbcc33" points="1893,-180 1691,-180 1691,-144 1893,-144 1893,-180"/>
-<text text-anchor="middle" x="1792" y="-158.3" font-family="Times,serif" font-size="14.00">robot_sf.robot.robot_state</text>
+<polygon fill="#bbcc33" stroke="#bbcc33" points="664.5,-180 462.5,-180 462.5,-144 664.5,-144 664.5,-180"/>
+<text text-anchor="middle" x="563.5" y="-158.3" font-family="Times,serif" font-size="14.00">robot_sf.robot.robot_state</text>
 </g>
 <!-- robot_sf.robot.robot_state&#45;&gt;robot_sf.nav.navigation -->
-<g id="edge11" class="edge">
+<g id="edge21" class="edge">
 <title>robot_sf.robot.robot_state&#45;&gt;robot_sf.nav.navigation</title>
-<path fill="none" stroke="black" d="M1690.71,-170.23C1502.28,-183.67 1099.96,-212.38 911.86,-225.8"/>
-<polygon fill="black" stroke="black" points="901.7,-226.53 911.35,-221.33 906.68,-226.17 911.67,-225.82 911.67,-225.82 911.67,-225.82 906.68,-226.17 911.99,-230.31 901.7,-226.53 901.7,-226.53"/>
+<path fill="none" stroke="black" d="M592.37,-180.12C607.79,-189.28 626.98,-200.66 643.6,-210.52"/>
+<polygon fill="black" stroke="black" points="652.52,-215.81 641.63,-214.58 648.22,-213.26 643.92,-210.71 643.92,-210.71 643.92,-210.71 648.22,-213.26 646.22,-206.84 652.52,-215.81 652.52,-215.81"/>
 </g>
 <!-- robot_sf.robot.robot_state&#45;&gt;robot_sf.nav.occupancy -->
-<g id="edge12" class="edge">
+<g id="edge22" class="edge">
 <title>robot_sf.robot.robot_state&#45;&gt;robot_sf.nav.occupancy</title>
-<path fill="none" stroke="black" d="M1847.73,-180.03C1880.14,-189.94 1921.18,-202.49 1955.18,-212.88"/>
-<polygon fill="black" stroke="black" points="1965.02,-215.89 1954.14,-217.27 1960.24,-214.43 1955.46,-212.97 1955.46,-212.97 1955.46,-212.97 1960.24,-214.43 1956.78,-208.66 1965.02,-215.89 1965.02,-215.89"/>
-</g>
-<!-- robot_sf.sensor.sensor_fusion -->
-<g id="node21" class="node">
-<title>robot_sf.sensor.sensor_fusion</title>
-<polygon fill="#aaaa00" stroke="#aaaa00" points="1908,-252 1682,-252 1682,-216 1908,-216 1908,-252"/>
-<text text-anchor="middle" x="1795" y="-230.3" font-family="Times,serif" font-size="14.00">robot_sf.sensor.sensor_fusion</text>
+<path fill="none" stroke="black" d="M525.34,-180.12C504.11,-189.65 477.49,-201.59 454.93,-211.72"/>
+<polygon fill="black" stroke="black" points="445.54,-215.93 452.82,-207.73 450.1,-213.88 454.66,-211.84 454.66,-211.84 454.66,-211.84 450.1,-213.88 456.5,-215.94 445.54,-215.93 445.54,-215.93"/>
 </g>
 <!-- robot_sf.robot.robot_state&#45;&gt;robot_sf.sensor.sensor_fusion -->
-<g id="edge13" class="edge">
+<g id="edge23" class="edge">
 <title>robot_sf.robot.robot_state&#45;&gt;robot_sf.sensor.sensor_fusion</title>
-<path fill="none" stroke="black" d="M1792.74,-180.3C1793.07,-188.02 1793.47,-197.29 1793.84,-205.89"/>
-<polygon fill="black" stroke="black" points="1794.27,-215.9 1789.34,-206.1 1794.05,-210.9 1793.84,-205.9 1793.84,-205.9 1793.84,-205.9 1794.05,-210.9 1798.33,-205.71 1794.27,-215.9 1794.27,-215.9"/>
+<path fill="none" stroke="black" d="M470.54,-180.03C414.28,-190.34 342.44,-203.51 284.46,-214.13"/>
+<polygon fill="black" stroke="black" points="274.54,-215.95 283.57,-209.72 279.46,-215.05 284.38,-214.15 284.38,-214.15 284.38,-214.15 279.46,-215.05 285.19,-218.57 274.54,-215.95 274.54,-215.95"/>
 </g>
 <!-- robot_sf.sensor -->
-<g id="node18" class="node">
+<g id="node21" class="node">
 <title>robot_sf.sensor</title>
-<polygon fill="#aaaa00" stroke="#aaaa00" points="2038.5,-36 1913.5,-36 1913.5,0 2038.5,0 2038.5,-36"/>
-<text text-anchor="middle" x="1976" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.sensor</text>
+<polygon fill="#aaaa00" stroke="#aaaa00" points="2547,-36 2422,-36 2422,0 2547,0 2547,-36"/>
+<text text-anchor="middle" x="2484.5" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.sensor</text>
 </g>
 <!-- robot_sf.sensor.goal_sensor -->
-<g id="node19" class="node">
+<g id="node22" class="node">
 <title>robot_sf.sensor.goal_sensor</title>
-<polygon fill="#aaaa00" stroke="#aaaa00" points="2269,-36 2057,-36 2057,0 2269,0 2269,-36"/>
-<text text-anchor="middle" x="2163" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.sensor.goal_sensor</text>
+<polygon fill="#aaaa00" stroke="#aaaa00" points="2777.5,-36 2565.5,-36 2565.5,0 2777.5,0 2777.5,-36"/>
+<text text-anchor="middle" x="2671.5" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.sensor.goal_sensor</text>
 </g>
 <!-- robot_sf.sensor.range_sensor -->
-<g id="node20" class="node">
+<g id="node23" class="node">
 <title>robot_sf.sensor.range_sensor</title>
-<polygon fill="#aaaa00" stroke="#aaaa00" points="2135,-180 1911,-180 1911,-144 2135,-144 2135,-180"/>
-<text text-anchor="middle" x="2023" y="-158.3" font-family="Times,serif" font-size="14.00">robot_sf.sensor.range_sensor</text>
+<polygon fill="#aaaa00" stroke="#aaaa00" points="444.5,-180 220.5,-180 220.5,-144 444.5,-144 444.5,-180"/>
+<text text-anchor="middle" x="332.5" y="-158.3" font-family="Times,serif" font-size="14.00">robot_sf.sensor.range_sensor</text>
 </g>
 <!-- robot_sf.sensor.range_sensor&#45;&gt;robot_sf.nav.occupancy -->
-<g id="edge14" class="edge">
+<g id="edge24" class="edge">
 <title>robot_sf.sensor.range_sensor&#45;&gt;robot_sf.nav.occupancy</title>
-<path fill="none" stroke="black" d="M2022.51,-180.3C2022.29,-188.02 2022.02,-197.29 2021.77,-205.89"/>
-<polygon fill="black" stroke="black" points="2021.49,-215.9 2017.28,-205.77 2021.63,-210.9 2021.77,-205.9 2021.77,-205.9 2021.77,-205.9 2021.63,-210.9 2026.27,-206.03 2021.49,-215.9 2021.49,-215.9"/>
+<path fill="none" stroke="black" d="M351.04,-180.3C360.3,-188.95 371.66,-199.55 381.76,-208.97"/>
+<polygon fill="black" stroke="black" points="389.17,-215.9 378.79,-212.36 385.52,-212.48 381.86,-209.07 381.86,-209.07 381.86,-209.07 385.52,-212.48 384.93,-205.78 389.17,-215.9 389.17,-215.9"/>
 </g>
 <!-- robot_sf.sim -->
-<g id="node22" class="node">
+<g id="node25" class="node">
 <title>robot_sf.sim</title>
-<polygon fill="#eedd88" stroke="#eedd88" points="2391,-36 2287,-36 2287,0 2391,0 2391,-36"/>
-<text text-anchor="middle" x="2339" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.sim</text>
+<polygon fill="#eedd88" stroke="#eedd88" points="2899.5,-36 2795.5,-36 2795.5,0 2899.5,0 2899.5,-36"/>
+<text text-anchor="middle" x="2847.5" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.sim</text>
 </g>
 <!-- robot_sf.sim.sim_config -->
-<g id="node23" class="node">
+<g id="node26" class="node">
 <title>robot_sf.sim.sim_config</title>
-<polygon fill="#eedd88" stroke="#eedd88" points="1100.5,-36 917.5,-36 917.5,0 1100.5,0 1100.5,-36"/>
-<text text-anchor="middle" x="1009" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.sim.sim_config</text>
+<polygon fill="#eedd88" stroke="#eedd88" points="1496,-36 1313,-36 1313,0 1496,0 1496,-36"/>
+<text text-anchor="middle" x="1404.5" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.sim.sim_config</text>
 </g>
 <!-- robot_sf.sim.sim_config&#45;&gt;robot_sf.ped_npc.ped_robot_force -->
-<g id="edge15" class="edge">
+<g id="edge25" class="edge">
 <title>robot_sf.sim.sim_config&#45;&gt;robot_sf.ped_npc.ped_robot_force</title>
-<path fill="none" stroke="black" d="M1008.01,-36.3C1007.57,-44.02 1007.04,-53.29 1006.55,-61.89"/>
-<polygon fill="black" stroke="black" points="1005.98,-71.9 1002.06,-61.66 1006.26,-66.9 1006.55,-61.91 1006.55,-61.91 1006.55,-61.91 1006.26,-66.9 1011.04,-62.17 1005.98,-71.9 1005.98,-71.9"/>
+<path fill="none" stroke="black" d="M1404.5,-36.3C1404.5,-44.02 1404.5,-53.29 1404.5,-61.89"/>
+<polygon fill="black" stroke="black" points="1404.5,-71.9 1400,-61.9 1404.5,-66.9 1404.5,-61.9 1404.5,-61.9 1404.5,-61.9 1404.5,-66.9 1409,-61.9 1404.5,-71.9 1404.5,-71.9"/>
 </g>
 <!-- robot_sf.sim.sim_view -->
-<g id="node24" class="node">
+<g id="node27" class="node">
 <title>robot_sf.sim.sim_view</title>
-<polygon fill="#eedd88" stroke="#eedd88" points="1605.5,-36 1432.5,-36 1432.5,0 1605.5,0 1605.5,-36"/>
-<text text-anchor="middle" x="1519" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.sim.sim_view</text>
+<polygon fill="#eedd88" stroke="#eedd88" points="1991,-36 1818,-36 1818,0 1991,0 1991,-36"/>
+<text text-anchor="middle" x="1904.5" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.sim.sim_view</text>
 </g>
 <!-- robot_sf.sim.sim_view&#45;&gt;robot_sf.nav.map_config -->
-<g id="edge16" class="edge">
+<g id="edge26" class="edge">
 <title>robot_sf.sim.sim_view&#45;&gt;robot_sf.nav.map_config</title>
-<path fill="none" stroke="black" d="M1589.09,-36.07C1607.08,-43.96 1624.35,-55.42 1635,-72 1643.65,-85.46 1644.86,-95.4 1635,-108 1550.11,-216.49 1138.31,-273.61 943.08,-294.97"/>
-<polygon fill="black" stroke="black" points="933.1,-296.05 942.56,-290.5 938.07,-295.51 943.04,-294.97 943.04,-294.97 943.04,-294.97 938.07,-295.51 943.53,-299.44 933.1,-296.05 933.1,-296.05"/>
+<path fill="none" stroke="black" d="M1988.2,-36.05C2006.77,-43.89 2024.25,-55.32 2035.5,-72 2044.44,-85.27 2045.46,-95.48 2035.5,-108 1942.63,-224.73 1491.08,-278.21 1284.74,-296.86"/>
+<polygon fill="black" stroke="black" points="1274.5,-297.77 1284.06,-292.4 1279.48,-297.33 1284.46,-296.88 1284.46,-296.88 1284.46,-296.88 1279.48,-297.33 1284.86,-301.36 1274.5,-297.77 1274.5,-297.77"/>
 </g>
 <!-- robot_sf.sim.sim_view&#45;&gt;robot_sf.robot.bicycle_drive -->
-<g id="edge17" class="edge">
+<g id="edge27" class="edge">
 <title>robot_sf.sim.sim_view&#45;&gt;robot_sf.robot.bicycle_drive</title>
-<path fill="none" stroke="black" d="M1519,-36.3C1519,-44.02 1519,-53.29 1519,-61.89"/>
-<polygon fill="black" stroke="black" points="1519,-71.9 1514.5,-61.9 1519,-66.9 1519,-61.9 1519,-61.9 1519,-61.9 1519,-66.9 1523.5,-61.9 1519,-71.9 1519,-71.9"/>
+<path fill="none" stroke="black" d="M1844.39,-36.03C1809.13,-46.03 1764.41,-58.7 1727.56,-69.15"/>
+<polygon fill="black" stroke="black" points="1717.88,-71.89 1726.27,-64.83 1722.69,-70.53 1727.5,-69.16 1727.5,-69.16 1727.5,-69.16 1722.69,-70.53 1728.72,-73.49 1717.88,-71.89 1717.88,-71.89"/>
 </g>
 <!-- robot_sf.sim.sim_view&#45;&gt;robot_sf.robot.differential_drive -->
-<g id="edge18" class="edge">
+<g id="edge28" class="edge">
 <title>robot_sf.sim.sim_view&#45;&gt;robot_sf.robot.differential_drive</title>
-<path fill="none" stroke="black" d="M1458.89,-36.03C1423.63,-46.03 1378.91,-58.7 1342.06,-69.15"/>
-<polygon fill="black" stroke="black" points="1332.38,-71.89 1340.77,-64.83 1337.19,-70.53 1342,-69.16 1342,-69.16 1342,-69.16 1337.19,-70.53 1343.22,-73.49 1332.38,-71.89 1332.38,-71.89"/>
+<path fill="none" stroke="black" d="M1904.5,-36.3C1904.5,-44.02 1904.5,-53.29 1904.5,-61.89"/>
+<polygon fill="black" stroke="black" points="1904.5,-71.9 1900,-61.9 1904.5,-66.9 1904.5,-61.9 1904.5,-61.9 1904.5,-61.9 1904.5,-66.9 1909,-61.9 1904.5,-71.9 1904.5,-71.9"/>
 </g>
 <!-- robot_sf.sim.simulator -->
-<g id="node25" class="node">
+<g id="node28" class="node">
 <title>robot_sf.sim.simulator</title>
-<polygon fill="#eedd88" stroke="#eedd88" points="899,-36 723,-36 723,0 899,0 899,-36"/>
-<text text-anchor="middle" x="811" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.sim.simulator</text>
+<polygon fill="#eedd88" stroke="#eedd88" points="1238.5,-36 1062.5,-36 1062.5,0 1238.5,0 1238.5,-36"/>
+<text text-anchor="middle" x="1150.5" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.sim.simulator</text>
 </g>
 <!-- robot_sf.sim.simulator&#45;&gt;robot_sf.nav.map_config -->
-<g id="edge19" class="edge">
+<g id="edge29" class="edge">
 <title>robot_sf.sim.simulator&#45;&gt;robot_sf.nav.map_config</title>
-<path fill="none" stroke="black" d="M823.11,-36.12C845.59,-69.04 893,-144.3 910,-216 913.69,-231.57 917.12,-237.67 910,-252 904,-264.07 893.79,-274.13 882.99,-282.12"/>
-<polygon fill="black" stroke="black" points="874.68,-287.83 880.38,-278.46 878.8,-285 882.92,-282.17 882.92,-282.17 882.92,-282.17 878.8,-285 885.47,-285.88 874.68,-287.83 874.68,-287.83"/>
+<path fill="none" stroke="black" d="M1191.18,-36.12C1206.02,-44.59 1221.18,-56.41 1229.5,-72 1245.76,-102.49 1253.45,-129.8 1212.5,-252 1209.37,-261.35 1204.45,-270.87 1199.44,-279.21"/>
+<polygon fill="black" stroke="black" points="1194.06,-287.73 1195.6,-276.87 1196.73,-283.5 1199.4,-279.28 1199.4,-279.28 1199.4,-279.28 1196.73,-283.5 1203.21,-281.68 1194.06,-287.73 1194.06,-287.73"/>
 </g>
 <!-- robot_sf.sim.simulator&#45;&gt;robot_sf.nav.navigation -->
-<g id="edge20" class="edge">
+<g id="edge30" class="edge">
 <title>robot_sf.sim.simulator&#45;&gt;robot_sf.nav.navigation</title>
-<path fill="none" stroke="black" d="M811,-36.15C811,-73.17 811,-160.82 811,-205.61"/>
-<polygon fill="black" stroke="black" points="811,-215.77 806.5,-205.77 811,-210.77 811,-205.77 811,-205.77 811,-205.77 811,-210.77 815.5,-205.77 811,-215.77 811,-215.77"/>
+<path fill="none" stroke="black" d="M1062.09,-33.1C948.09,-53.07 758.85,-92.94 711.5,-144 695.79,-160.95 688.28,-186.42 684.7,-205.77"/>
+<polygon fill="black" stroke="black" points="683.1,-215.8 680.23,-205.22 683.89,-210.86 684.68,-205.93 684.68,-205.93 684.68,-205.93 683.89,-210.86 689.12,-206.64 683.1,-215.8 683.1,-215.8"/>
 </g>
 <!-- robot_sf.sim.simulator&#45;&gt;robot_sf.ped_npc.ped_behavior -->
-<g id="edge21" class="edge">
+<g id="edge31" class="edge">
 <title>robot_sf.sim.simulator&#45;&gt;robot_sf.ped_npc.ped_behavior</title>
-<path fill="none" stroke="black" d="M793.39,-36.13C767.63,-61.18 719.55,-107.95 690.09,-136.59"/>
-<polygon fill="black" stroke="black" points="682.67,-143.81 686.7,-133.61 686.26,-140.32 689.84,-136.84 689.84,-136.84 689.84,-136.84 686.26,-140.32 692.98,-140.06 682.67,-143.81 682.67,-143.81"/>
+<path fill="none" stroke="black" d="M1062.42,-28.76C1019.95,-36.2 969.46,-49.25 928.5,-72 899.8,-87.94 873.94,-115.59 857.39,-135.85"/>
+<polygon fill="black" stroke="black" points="851.09,-143.76 853.8,-133.13 854.21,-139.85 857.32,-135.94 857.32,-135.94 857.32,-135.94 854.21,-139.85 860.84,-138.74 851.09,-143.76 851.09,-143.76"/>
 </g>
 <!-- robot_sf.sim.simulator&#45;&gt;robot_sf.ped_npc.ped_grouping -->
-<g id="edge22" class="edge">
+<g id="edge32" class="edge">
 <title>robot_sf.sim.simulator&#45;&gt;robot_sf.ped_npc.ped_grouping</title>
-<path fill="none" stroke="black" d="M736.26,-36.02C675.26,-53.52 590.83,-86.53 538,-144 522.25,-161.14 514.13,-186.58 510.02,-205.88"/>
-<polygon fill="black" stroke="black" points="508.13,-215.88 505.57,-205.22 509.06,-210.97 509.99,-206.05 509.99,-206.05 509.99,-206.05 509.06,-210.97 514.41,-206.89 508.13,-215.88 508.13,-215.88"/>
+<path fill="none" stroke="black" d="M1062.27,-33.21C1019.37,-42.1 974.32,-55.1 961.5,-72 944.8,-94.02 984.73,-167.67 1008.45,-207.28"/>
+<polygon fill="black" stroke="black" points="1013.67,-215.87 1004.63,-209.66 1011.08,-211.6 1008.48,-207.33 1008.48,-207.33 1008.48,-207.33 1011.08,-211.6 1012.33,-204.99 1013.67,-215.87 1013.67,-215.87"/>
 </g>
 <!-- robot_sf.sim.simulator&#45;&gt;robot_sf.ped_npc.ped_population -->
-<g id="edge23" class="edge">
+<g id="edge33" class="edge">
 <title>robot_sf.sim.simulator&#45;&gt;robot_sf.ped_npc.ped_population</title>
-<path fill="none" stroke="black" d="M722.82,-32.87C654.55,-43.61 559.34,-58.59 484.43,-70.37"/>
-<polygon fill="black" stroke="black" points="474.47,-71.94 483.65,-65.94 479.41,-71.16 484.35,-70.38 484.35,-70.38 484.35,-70.38 479.41,-71.16 485.05,-74.83 474.47,-71.94 474.47,-71.94"/>
+<path fill="none" stroke="black" d="M1136.9,-36.3C1130.38,-44.61 1122.43,-54.72 1115.25,-63.86"/>
+<polygon fill="black" stroke="black" points="1108.94,-71.9 1111.58,-61.25 1112.03,-67.96 1115.12,-64.03 1115.12,-64.03 1115.12,-64.03 1112.03,-67.96 1118.66,-66.81 1108.94,-71.9 1108.94,-71.9"/>
 </g>
 <!-- robot_sf.sim.simulator&#45;&gt;robot_sf.ped_npc.ped_robot_force -->
-<g id="edge24" class="edge">
+<g id="edge34" class="edge">
 <title>robot_sf.sim.simulator&#45;&gt;robot_sf.ped_npc.ped_robot_force</title>
-<path fill="none" stroke="black" d="M858.46,-36.12C885.57,-45.91 919.74,-58.23 948.26,-68.53"/>
-<polygon fill="black" stroke="black" points="957.7,-71.93 946.76,-72.77 952.99,-70.23 948.29,-68.54 948.29,-68.54 948.29,-68.54 952.99,-70.23 949.82,-64.3 957.7,-71.93 957.7,-71.93"/>
+<path fill="none" stroke="black" d="M1212.31,-36.03C1248.57,-46.03 1294.56,-58.7 1332.46,-69.15"/>
+<polygon fill="black" stroke="black" points="1342.41,-71.89 1331.58,-73.57 1337.59,-70.56 1332.77,-69.23 1332.77,-69.23 1332.77,-69.23 1337.59,-70.56 1333.97,-64.89 1342.41,-71.89 1342.41,-71.89"/>
 </g>
 <!-- robot_sf.sim.simulator&#45;&gt;robot_sf.robot.bicycle_drive -->
-<g id="edge25" class="edge">
+<g id="edge35" class="edge">
 <title>robot_sf.sim.simulator&#45;&gt;robot_sf.robot.bicycle_drive</title>
-<path fill="none" stroke="black" d="M899.23,-34.85C902.19,-35.26 905.12,-35.64 908,-36 1123.27,-62.64 1181.46,-48.58 1401.98,-72.06"/>
-<polygon fill="black" stroke="black" points="1411.92,-73.13 1401.5,-76.53 1406.95,-72.59 1401.98,-72.06 1401.98,-72.06 1401.98,-72.06 1406.95,-72.59 1402.46,-67.58 1411.92,-73.13 1411.92,-73.13"/>
+<path fill="none" stroke="black" d="M1238.66,-30.67C1315.61,-40.93 1430.57,-56.4 1540.44,-71.86"/>
+<polygon fill="black" stroke="black" points="1550.38,-73.26 1539.85,-76.32 1545.43,-72.56 1540.47,-71.86 1540.47,-71.86 1540.47,-71.86 1545.43,-72.56 1541.1,-67.41 1550.38,-73.26 1550.38,-73.26"/>
 </g>
 <!-- robot_sf.sim.simulator&#45;&gt;robot_sf.robot.differential_drive -->
-<g id="edge26" class="edge">
+<g id="edge36" class="edge">
 <title>robot_sf.sim.simulator&#45;&gt;robot_sf.robot.differential_drive</title>
-<path fill="none" stroke="black" d="M899.01,-34.54C902.04,-35.04 905.05,-35.53 908,-36 984.78,-48.31 1070.86,-60.9 1140.04,-70.72"/>
-<polygon fill="black" stroke="black" points="1150.12,-72.15 1139.59,-75.2 1145.17,-71.45 1140.22,-70.75 1140.22,-70.75 1140.22,-70.75 1145.17,-71.45 1140.85,-66.29 1150.12,-72.15 1150.12,-72.15"/>
-</g>
-<!-- robot_sf.simple_robot_env -->
-<g id="node26" class="node">
-<title>robot_sf.simple_robot_env</title>
-<polygon fill="#77aadd" stroke="#77aadd" points="2612.5,-36 2409.5,-36 2409.5,0 2612.5,0 2612.5,-36"/>
-<text text-anchor="middle" x="2511" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.simple_robot_env</text>
+<path fill="none" stroke="black" d="M1238.81,-29.26C1260.29,-31.61 1283.21,-34.01 1304.5,-36 1509.4,-55.17 1563.86,-50.69 1772.78,-71.96"/>
+<polygon fill="black" stroke="black" points="1782.84,-72.99 1772.44,-76.45 1777.87,-72.48 1772.9,-71.97 1772.9,-71.97 1772.9,-71.97 1777.87,-72.48 1773.36,-67.5 1782.84,-72.99 1782.84,-72.99"/>
 </g>
 <!-- robot_sf.tb_logging -->
-<g id="node27" class="node">
+<g id="node29" class="node">
 <title>robot_sf.tb_logging</title>
-<polygon fill="#77aadd" stroke="#77aadd" points="245.5,-36 92.5,-36 92.5,0 245.5,0 245.5,-36"/>
-<text text-anchor="middle" x="169" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.tb_logging</text>
+<polygon fill="#77aadd" stroke="#77aadd" points="687,-36 534,-36 534,0 687,0 687,-36"/>
+<text text-anchor="middle" x="610.5" y="-14.3" font-family="Times,serif" font-size="14.00">robot_sf.tb_logging</text>
 </g>
 <!-- robot_sf.tb_logging&#45;&gt;robot_sf.eval -->
-<g id="edge27" class="edge">
+<g id="edge37" class="edge">
 <title>robot_sf.tb_logging&#45;&gt;robot_sf.eval</title>
-<path fill="none" stroke="black" d="M169,-36.3C169,-44.02 169,-53.29 169,-61.89"/>
-<polygon fill="black" stroke="black" points="169,-71.9 164.5,-61.9 169,-66.9 169,-61.9 169,-61.9 169,-61.9 169,-66.9 173.5,-61.9 169,-71.9 169,-71.9"/>
+<path fill="none" stroke="black" d="M610.5,-36.3C610.5,-44.02 610.5,-53.29 610.5,-61.89"/>
+<polygon fill="black" stroke="black" points="610.5,-71.9 606,-61.9 610.5,-66.9 610.5,-61.9 610.5,-61.9 610.5,-61.9 610.5,-66.9 615,-61.9 610.5,-71.9 610.5,-71.9"/>
 </g>
 </g>
 </svg>