diff --git a/src/lab_sim/config/config.yaml b/src/lab_sim/config/config.yaml index 85265ad4c..ab65b09db 100644 --- a/src/lab_sim/config/config.yaml +++ b/src/lab_sim/config/config.yaml @@ -32,6 +32,9 @@ moveit_params: pose_jog: package: "lab_sim" path: "config/moveit/pose_jog.yaml" + sensors_3d: + package: "lab_sim" + path: "config/moveit/sensors_3d.yaml" # Configuration for loading behaviors and objectives. # [Required] diff --git a/src/lab_sim/config/moveit/sensors_3d.yaml b/src/lab_sim/config/moveit/sensors_3d.yaml index 12ac12971..0bea339b5 100644 --- a/src/lab_sim/config/moveit/sensors_3d.yaml +++ b/src/lab_sim/config/moveit/sensors_3d.yaml @@ -7,18 +7,18 @@ scene_scan_camera: # Set to an empty topic to disable. point_cloud_service_name: "/point_cloud_service" # Points further than this will not be used (in meters). - max_range: 1.5 + max_range: 6.0 # Choose one of every 'point_subsample' points (select all if set to 1). point_subsample: 1 # Should always be >= 1.0. Scale up collision shapes in the scene before excluding them from the octomap. padding_scale: 1.0 # Absolute padding around scaled collision shapes when excluding them from the octomap (in meters). - padding_offset: 0.01 + padding_offset: 0.1 # The octomap representation will be updated at rate less than or equal to this value. max_update_rate: 0.1 # Specifies the resolution at which the octomap is maintained (in meters). -octomap_resolution: 0.01 +octomap_resolution: 0.05 # Specifies the coordinate frame in which the Octomap representation will be stored. # Note! When an OccupancyMonitor instance is initialized by the PlanningSceneMonitor, # this frame parameter will not be used. Instead, the frame defaults to the planning frame. diff --git a/src/lab_sim/objectives/octomap_example.xml b/src/lab_sim/objectives/octomap_example.xml new file mode 100644 index 000000000..a7a50f305 --- /dev/null +++ b/src/lab_sim/objectives/octomap_example.xml @@ -0,0 +1,38 @@ + + + + + + + + + + + + + + + + + + + +