diff --git a/src/picknik_ur_base_config/config/base_config.yaml b/src/picknik_ur_base_config/config/config.yaml similarity index 100% rename from src/picknik_ur_base_config/config/base_config.yaml rename to src/picknik_ur_base_config/config/config.yaml diff --git a/src/picknik_ur_site_config/objectives/3_waypoint_pick_and_place.xml b/src/picknik_ur_base_config/objectives/3_waypoint_pick_and_place.xml similarity index 100% rename from src/picknik_ur_site_config/objectives/3_waypoint_pick_and_place.xml rename to src/picknik_ur_base_config/objectives/3_waypoint_pick_and_place.xml diff --git a/src/picknik_ur_gazebo_config/objectives/joint_diagnostic.xml b/src/picknik_ur_base_config/objectives/joint_diagnostic.xml similarity index 100% rename from src/picknik_ur_gazebo_config/objectives/joint_diagnostic.xml rename to src/picknik_ur_base_config/objectives/joint_diagnostic.xml diff --git a/src/picknik_ur_site_config/objectives/looping_pick_and_place_object_config.yaml b/src/picknik_ur_base_config/objectives/looping_pick_and_place_object_config.yaml similarity index 100% rename from src/picknik_ur_site_config/objectives/looping_pick_and_place_object_config.yaml rename to src/picknik_ur_base_config/objectives/looping_pick_and_place_object_config.yaml diff --git a/src/picknik_ur_gazebo_config/config/site_config.yaml b/src/picknik_ur_gazebo_config/config/config.yaml similarity index 98% rename from src/picknik_ur_gazebo_config/config/site_config.yaml rename to src/picknik_ur_gazebo_config/config/config.yaml index 1c3b4a20..bd29887f 100644 --- a/src/picknik_ur_gazebo_config/config/site_config.yaml +++ b/src/picknik_ur_gazebo_config/config/config.yaml @@ -3,7 +3,7 @@ # # Name of the package to specialize -based_on_package: "picknik_ur_base_config" +based_on_package: "picknik_ur_site_config" # Optional parameters that can be read in your launch files for specific functionality optional_feature_params: diff --git a/src/picknik_ur_site_config/config/site_config.yaml b/src/picknik_ur_site_config/config/config.yaml similarity index 65% rename from src/picknik_ur_site_config/config/site_config.yaml rename to src/picknik_ur_site_config/config/config.yaml index 29135335..e362dfc8 100644 --- a/src/picknik_ur_site_config/config/site_config.yaml +++ b/src/picknik_ur_site_config/config/config.yaml @@ -6,6 +6,11 @@ hardware: ip: "0.0.0.0" objectives: + behavior_loader_plugins: + visual_servo_behaviors: + - "moveit_visual_servo::behaviors::VisualServoBehaviorLoader" + gibson: + - "gibson_behavior::GibsonBehaviorsLoader" objective_library_paths: # You must use a unique key for each package. # The picknik_ur_base_config uses "core" diff --git a/src/picknik_ur_site_config/objectives/apriltag_servoing.xml b/src/picknik_ur_site_config/objectives/apriltag_servoing.xml new file mode 100644 index 00000000..a963b06c --- /dev/null +++ b/src/picknik_ur_site_config/objectives/apriltag_servoing.xml @@ -0,0 +1,20 @@ + + + + + + + + + + + + + + + + + + + + diff --git a/src/picknik_ur_site_config/objectives/apriltag_servoing_config.yaml b/src/picknik_ur_site_config/objectives/apriltag_servoing_config.yaml new file mode 100644 index 00000000..5727ef47 --- /dev/null +++ b/src/picknik_ur_site_config/objectives/apriltag_servoing_config.yaml @@ -0,0 +1,25 @@ +GetApriltagPose: + apriltag_family_name: 16h5 + apriltag_ids: + - 0 + apriltag_names: + - frame_id0 + apriltag_sizes: + - 0.028 + max_hamming: 0 + nthreads: 1 + quad_decimate: 1 + quad_sigma: 0 + refine_edges: true + z_up: true +VisualServo: + ff_velocity_gain_angular: 0 + ff_velocity_gain_linear: 0 + include_ff: false + max_angular_output: 1 + max_linear_output: 1 + proportional_gain_angular: '10' + proportional_gain_linear: '150' + servo_spin_rate: '0.02' + target_servo_frame: 'manual_grasp_link' + fixed_servo_frame: 'base_link' diff --git a/src/picknik_ur_base_config/objectives/close_cabinet_door.xml b/src/picknik_ur_site_config/objectives/close_cabinet_door.xml similarity index 100% rename from src/picknik_ur_base_config/objectives/close_cabinet_door.xml rename to src/picknik_ur_site_config/objectives/close_cabinet_door.xml diff --git a/src/picknik_ur_base_config/objectives/find_cuboids.xml b/src/picknik_ur_site_config/objectives/find_cuboids.xml similarity index 100% rename from src/picknik_ur_base_config/objectives/find_cuboids.xml rename to src/picknik_ur_site_config/objectives/find_cuboids.xml diff --git a/src/picknik_ur_base_config/objectives/find_cuboids_config.yaml b/src/picknik_ur_site_config/objectives/find_cuboids_config.yaml similarity index 100% rename from src/picknik_ur_base_config/objectives/find_cuboids_config.yaml rename to src/picknik_ur_site_config/objectives/find_cuboids_config.yaml diff --git a/src/picknik_ur_base_config/objectives/inspect_surface.xml b/src/picknik_ur_site_config/objectives/inspect_surface.xml similarity index 100% rename from src/picknik_ur_base_config/objectives/inspect_surface.xml rename to src/picknik_ur_site_config/objectives/inspect_surface.xml diff --git a/src/picknik_ur_site_config/objectives/joint_diagnostic.xml b/src/picknik_ur_site_config/objectives/joint_diagnostic.xml deleted file mode 100644 index c8105f5f..00000000 --- a/src/picknik_ur_site_config/objectives/joint_diagnostic.xml +++ /dev/null @@ -1,15 +0,0 @@ - - - - - - - - - - - - - - - diff --git a/src/picknik_ur_site_config/objectives/open_cabinet_door_ml.xml b/src/picknik_ur_site_config/objectives/open_cabinet_door_ml.xml new file mode 100644 index 00000000..b4578df4 --- /dev/null +++ b/src/picknik_ur_site_config/objectives/open_cabinet_door_ml.xml @@ -0,0 +1,76 @@ + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + diff --git a/src/picknik_ur_base_config/objectives/open_door_admittance_controller_config.yaml b/src/picknik_ur_site_config/objectives/open_door_admittance_controller_config.yaml similarity index 100% rename from src/picknik_ur_base_config/objectives/open_door_admittance_controller_config.yaml rename to src/picknik_ur_site_config/objectives/open_door_admittance_controller_config.yaml diff --git a/src/picknik_ur_site_config/objectives/open_door_affordance.xml b/src/picknik_ur_site_config/objectives/open_door_affordance.xml index 411a07af..e40ba831 100644 --- a/src/picknik_ur_site_config/objectives/open_door_affordance.xml +++ b/src/picknik_ur_site_config/objectives/open_door_affordance.xml @@ -2,11 +2,18 @@ + + + + - + + + + diff --git a/src/picknik_ur_base_config/objectives/open_door_affordance_config.yaml b/src/picknik_ur_site_config/objectives/open_door_affordance_config.yaml similarity index 100% rename from src/picknik_ur_base_config/objectives/open_door_affordance_config.yaml rename to src/picknik_ur_site_config/objectives/open_door_affordance_config.yaml diff --git a/src/picknik_ur_base_config/objectives/open_lever_handle_door.xml b/src/picknik_ur_site_config/objectives/open_lever_handle_door.xml similarity index 100% rename from src/picknik_ur_base_config/objectives/open_lever_handle_door.xml rename to src/picknik_ur_site_config/objectives/open_lever_handle_door.xml diff --git a/src/picknik_ur_base_config/objectives/open_lever_handle_door_config.yaml b/src/picknik_ur_site_config/objectives/open_lever_handle_door_config.yaml similarity index 100% rename from src/picknik_ur_base_config/objectives/open_lever_handle_door_config.yaml rename to src/picknik_ur_site_config/objectives/open_lever_handle_door_config.yaml diff --git a/src/picknik_ur_base_config/objectives/pick_object.xml b/src/picknik_ur_site_config/objectives/pick_object.xml similarity index 100% rename from src/picknik_ur_base_config/objectives/pick_object.xml rename to src/picknik_ur_site_config/objectives/pick_object.xml diff --git a/src/picknik_ur_base_config/objectives/pick_object_config.yaml b/src/picknik_ur_site_config/objectives/pick_object_config.yaml similarity index 100% rename from src/picknik_ur_base_config/objectives/pick_object_config.yaml rename to src/picknik_ur_site_config/objectives/pick_object_config.yaml diff --git a/src/picknik_ur_base_config/objectives/pick_place_object.xml b/src/picknik_ur_site_config/objectives/pick_place_object.xml similarity index 100% rename from src/picknik_ur_base_config/objectives/pick_place_object.xml rename to src/picknik_ur_site_config/objectives/pick_place_object.xml diff --git a/src/picknik_ur_site_config/objectives/push_button_ml.xml b/src/picknik_ur_site_config/objectives/push_button_ml.xml new file mode 100644 index 00000000..cf9b76fe --- /dev/null +++ b/src/picknik_ur_site_config/objectives/push_button_ml.xml @@ -0,0 +1,101 @@ + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + diff --git a/src/picknik_ur_base_config/objectives/take_snapshot.xml b/src/picknik_ur_site_config/objectives/take_snapshot.xml similarity index 100% rename from src/picknik_ur_base_config/objectives/take_snapshot.xml rename to src/picknik_ur_site_config/objectives/take_snapshot.xml diff --git a/src/picknik_ur_base_config/objectives/update_admittance_controller_config.yaml b/src/picknik_ur_site_config/objectives/update_admittance_controller_config.yaml similarity index 100% rename from src/picknik_ur_base_config/objectives/update_admittance_controller_config.yaml rename to src/picknik_ur_site_config/objectives/update_admittance_controller_config.yaml