From 3a5bfb1c788ec2e91eca145c49b962f1d39991c6 Mon Sep 17 00:00:00 2001 From: Matthew Hansen <matthew.k.hansen@intel.com> Date: Thu, 6 Jun 2019 16:29:52 -0700 Subject: [PATCH] WIP - update nav2_params for system test --- nav2_system_tests/params/nav2_params.yaml | 148 +++++++++++++++++++++- 1 file changed, 141 insertions(+), 7 deletions(-) diff --git a/nav2_system_tests/params/nav2_params.yaml b/nav2_system_tests/params/nav2_params.yaml index a2737a5d..e5d6203f 100644 --- a/nav2_system_tests/params/nav2_params.yaml +++ b/nav2_system_tests/params/nav2_params.yaml @@ -1,11 +1,61 @@ -map_server: +amcl: ros__parameters: - yaml_filename: "test_map.yaml" + use_sim_time: True + alpha1: 0.2 + alpha2: 0.2 + alpha3: 0.2 + alpha4: 0.2 + alpha5: 0.2 + base_frame_id: "base_footprint" + beam_skip_distance: 0.5 + beam_skip_error_threshold: 0.9 + beam_skip_threshold: 0.3 + do_beamskip: false + global_frame_id: "map" + lambda_short: 0.1 + laser_likelihood_max_dist: 2.0 + laser_max_range: 100.0 + laser_min_range: -1.0 + laser_model_type: "likelihood_field" + max_beams: 60 + max_particles: 2000 + min_particles: 500 + odom_frame_id: "odom" + pf_err: 0.05 + pf_z: 0.99 + recovery_alpha_fast: 0.0 + recovery_alpha_slow: 0.0 + resample_interval: 1 + robot_model_type: "differential" + save_pose_rate: 0.5 + sigma_hit: 0.2 + tf_broadcast: true + transform_tolerance: 1.0 + update_min_a: 0.2 + update_min_d: 0.25 + z_hit: 0.5 + z_max: 0.05 + z_rand: 0.5 + z_short: 0.05 + +amcl_map_client: + ros__parameters: + use_sim_time: True + +amcl_rclcpp_node: + ros__parameters: + use_sim_time: True + +#bt_navigator: +# ros__parameters: +# use_sim_time: True +# bt_xml_filename: "bt_navigator.xml" dwb_controller: ros__parameters: + use_sim_time: True debug_trajectory_details: True - min_vel_x: -0.26 + min_vel_x: 0.0 min_vel_y: 0.0 max_vel_x: 0.26 max_vel_y: 0.0 @@ -13,15 +63,26 @@ dwb_controller: min_speed_xy: 0.0 max_speed_xy: 0.26 min_speed_theta: 0.0 + min_x_velocity_threshold: 0.001 + # Add high threshold velocity for turtlebot 3 issue. + # https://github.com/ROBOTIS-GIT/turtlebot3_simulations/issues/75 + min_y_velocity_threshold: 0.5 + min_theta_velocity_threshold: 0.001 acc_lim_x: 2.5 acc_lim_y: 0.0 acc_lim_theta: 3.2 decel_lim_x: -2.5 decel_lim_y: 0.0 decel_lim_theta: -3.2 - ObstacleFootprint.scale: 1.0 - ObstacleFootprint.max_scaling_factor: 0.2 - ObstacleFootprint.scaling_speed: 0.25 + vx_samples: 20 + vy_samples: 5 + vtheta_samples: 20 + sim_time: 1.7 + linear_granularity: 0.05 + xy_goal_tolerance: 0.25 + # critics: ["RotateToGoal", "Oscillation", "BaseObstacle", "GoalAlign", "PathAlign", "PathDist", "GoalDist"] + critics: ["RotateToGoal", "Oscillation", "GoalAlign", "PathAlign", "PathDist", "GoalDist"] + BaseObstacle.scale: 0.02 PathAlign.scale: 32.0 GoalAlign.scale: 24.0 PathDist.scale: 32.0 @@ -31,10 +92,83 @@ dwb_controller: local_costmap: local_costmap: ros__parameters: - robot_radius: 0.092 + robot_radius: 0.17 + inflation_layer.cost_scaling_factor: 3.0 + obstacle_layer: + enabled: True always_send_full_costmap: True + observation_sources: scan + scan: + topic: /scan + max_obstacle_height: 2.0 + clearing: True + marking: True + +local_costmap: + local_costmap_client: + ros__parameters: + use_sim_time: True + +local_costmap: + local_costmap_rclcpp_node: + ros__parameters: + use_sim_time: True global_costmap: global_costmap: ros__parameters: + robot_radius: 0.17 + obstacle_layer: + enabled: True always_send_full_costmap: True + observation_sources: scan + scan: + topic: /scan + max_obstacle_height: 2.0 + clearing: True + marking: True + +global_costmap: + global_costmap_client: + ros__parameters: + use_sim_time: True + +global_costmap: + global_costmap_rclcpp_node: + ros__parameters: + use_sim_time: True + +#map_server: +# ros__parameters: +# use_sim_time: True +# yaml_filename: "turtlebot3_world.yaml" + +#lifecycle_manager: +# ros__parameters: +# use_sim_time: True + +lifecycle_manager_service_client: + ros__parameters: + use_sim_time: True + +lifecycle_manager_client_service_client: + ros__parameters: + use_sim_time: True + +#navfn_planner: +# ros__parameters: +# use_sim_time: True +# tolerance: 0.0 +# use_astar: false + +navfn_planner_GetCostmap_client: + ros__parameters: + use_sim_time: True + +#robot_state_publisher: +# ros__parameters: +# use_sim_time: True + +#world_model: +# ros__parameters: +# use_sim_time: True -- GitLab