Add speed limit to navgraph (#397)

Signed-off-by: Luca Della Vedova <[email protected]>

Author: luca-della-vedova

rmf_building_map_tools/building_map/level.py

@@ -422,6 +422,10 @@ def generate_nav_graph(self, graph_idx, always_unidirectional=True):
             if l.orientation():
                 p['orientation_constraint'] = l.orientation()
 
+            if 'speed_limit' in l.params and \
+                    l.params['speed_limit'].value > 0.0:
+                p['speed_limit'] = l.params['speed_limit'].value
+
             if 'demo_mock_floor_name' in l.params and \
                     l.params['demo_mock_floor_name'].value:
                 p['demo_mock_floor_name'] = \