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