Feature/add costmap weight

Add the new weight for the costmap obstacle to the TimedElasticBands Paramters.

This needs teb_local_planner/!3 to work.

Closes #31 (closed)

data/armarx_navigation/local_planner_config/TimedElasticBands/default.json

@@ -6,6 +6,7 @@
     "pse": {
       "pse_costum_obstacle_penalties": true,
       "pse_costum_obstacle_penalties_dynamic": true,
+      "weight_costmap": 0.5,
       "weight_global_path_position": 0.3,
       "weight_global_path_orientation": 0.3,
       "lrk_use_alternative_approach": false,