diff --git a/bags/rviz_1dof/metadata.yaml b/bags/rviz_1dof/metadata.yaml
deleted file mode 100644
index f01a8f3f3ee4a801db6ee2f195e4dcde086ece6a..0000000000000000000000000000000000000000
--- a/bags/rviz_1dof/metadata.yaml
+++ /dev/null
@@ -1,32 +0,0 @@
-rosbag2_bagfile_information:
-  version: 5
-  storage_identifier: sqlite3
-  duration:
-    nanoseconds: 30400492341
-  starting_time:
-    nanoseconds_since_epoch: 1718808270506196030
-  message_count: 1218
-  topics_with_message_count:
-    - topic_metadata:
-        name: /visualization_marker
-        type: visualization_msgs/msg/Marker
-        serialization_format: cdr
-        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
-      message_count: 609
-    - topic_metadata:
-        name: /visualization_path
-        type: nav_msgs/msg/Path
-        serialization_format: cdr
-        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
-      message_count: 609
-  compression_format: ""
-  compression_mode: ""
-  relative_file_paths:
-    - rviz_1dof_0.db3
-  files:
-    - path: rviz_1dof_0.db3
-      starting_time:
-        nanoseconds_since_epoch: 1718808270506196030
-      duration:
-        nanoseconds: 30400492341
-      message_count: 1218
\ No newline at end of file
diff --git a/bags/rviz_1dof/rviz_1dof_0.db3 b/bags/rviz_1dof/rviz_1dof_0.db3
deleted file mode 100644
index 3c44d8eabb6cee0c1853cf19864d8bac9470f507..0000000000000000000000000000000000000000
Binary files a/bags/rviz_1dof/rviz_1dof_0.db3 and /dev/null differ
diff --git a/bags/rviz_2dof_1/metadata.yaml b/bags/rviz_2dof_1/metadata.yaml
deleted file mode 100644
index 1e5a32a140dbb35850c5149e1e233ce9e833f518..0000000000000000000000000000000000000000
--- a/bags/rviz_2dof_1/metadata.yaml
+++ /dev/null
@@ -1,32 +0,0 @@
-rosbag2_bagfile_information:
-  version: 5
-  storage_identifier: sqlite3
-  duration:
-    nanoseconds: 30600218253
-  starting_time:
-    nanoseconds_since_epoch: 1718808388798385174
-  message_count: 1226
-  topics_with_message_count:
-    - topic_metadata:
-        name: /visualization_path
-        type: nav_msgs/msg/Path
-        serialization_format: cdr
-        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
-      message_count: 613
-    - topic_metadata:
-        name: /visualization_marker
-        type: visualization_msgs/msg/Marker
-        serialization_format: cdr
-        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
-      message_count: 613
-  compression_format: ""
-  compression_mode: ""
-  relative_file_paths:
-    - rviz_2dof_1_0.db3
-  files:
-    - path: rviz_2dof_1_0.db3
-      starting_time:
-        nanoseconds_since_epoch: 1718808388798385174
-      duration:
-        nanoseconds: 30600218253
-      message_count: 1226
\ No newline at end of file
diff --git a/bags/rviz_2dof_1/rviz_2dof_1_0.db3 b/bags/rviz_2dof_1/rviz_2dof_1_0.db3
deleted file mode 100644
index 8d31d7cf163234f565885e9d75054f7d26f67b7f..0000000000000000000000000000000000000000
Binary files a/bags/rviz_2dof_1/rviz_2dof_1_0.db3 and /dev/null differ
diff --git a/bags/rviz_2dof_2/metadata.yaml b/bags/rviz_2dof_2/metadata.yaml
deleted file mode 100644
index 431583675782bf2e21d8ffe81b499ea533b809c7..0000000000000000000000000000000000000000
--- a/bags/rviz_2dof_2/metadata.yaml
+++ /dev/null
@@ -1,32 +0,0 @@
-rosbag2_bagfile_information:
-  version: 5
-  storage_identifier: sqlite3
-  duration:
-    nanoseconds: 60550348852
-  starting_time:
-    nanoseconds_since_epoch: 1718808470846328856
-  message_count: 2424
-  topics_with_message_count:
-    - topic_metadata:
-        name: /visualization_marker
-        type: visualization_msgs/msg/Marker
-        serialization_format: cdr
-        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
-      message_count: 1212
-    - topic_metadata:
-        name: /visualization_path
-        type: nav_msgs/msg/Path
-        serialization_format: cdr
-        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
-      message_count: 1212
-  compression_format: ""
-  compression_mode: ""
-  relative_file_paths:
-    - rviz_2dof_2_0.db3
-  files:
-    - path: rviz_2dof_2_0.db3
-      starting_time:
-        nanoseconds_since_epoch: 1718808470846328856
-      duration:
-        nanoseconds: 60550348852
-      message_count: 2424
\ No newline at end of file
diff --git a/bags/rviz_2dof_2/rviz_2dof_2_0.db3 b/bags/rviz_2dof_2/rviz_2dof_2_0.db3
deleted file mode 100644
index f1bda850a4c64b468a0a98f42ba5e0a9f0a585da..0000000000000000000000000000000000000000
Binary files a/bags/rviz_2dof_2/rviz_2dof_2_0.db3 and /dev/null differ
diff --git a/bags/rviz_3dof_1/metadata.yaml b/bags/rviz_3dof_1/metadata.yaml
deleted file mode 100644
index 06fac8d04a2713e4e3a2e371bc65ce53e4e13425..0000000000000000000000000000000000000000
--- a/bags/rviz_3dof_1/metadata.yaml
+++ /dev/null
@@ -1,32 +0,0 @@
-rosbag2_bagfile_information:
-  version: 5
-  storage_identifier: sqlite3
-  duration:
-    nanoseconds: 30900144418
-  starting_time:
-    nanoseconds_since_epoch: 1718808618464726430
-  message_count: 1238
-  topics_with_message_count:
-    - topic_metadata:
-        name: /visualization_marker
-        type: visualization_msgs/msg/Marker
-        serialization_format: cdr
-        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
-      message_count: 619
-    - topic_metadata:
-        name: /visualization_path
-        type: nav_msgs/msg/Path
-        serialization_format: cdr
-        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
-      message_count: 619
-  compression_format: ""
-  compression_mode: ""
-  relative_file_paths:
-    - rviz_3dof_1_0.db3
-  files:
-    - path: rviz_3dof_1_0.db3
-      starting_time:
-        nanoseconds_since_epoch: 1718808618464726430
-      duration:
-        nanoseconds: 30900144418
-      message_count: 1238
\ No newline at end of file
diff --git a/bags/rviz_3dof_1/rviz_3dof_1_0.db3 b/bags/rviz_3dof_1/rviz_3dof_1_0.db3
deleted file mode 100644
index 24729a4abfb87707211db38250091ffa7c634420..0000000000000000000000000000000000000000
Binary files a/bags/rviz_3dof_1/rviz_3dof_1_0.db3 and /dev/null differ
diff --git a/bags/rviz_3dof_2/metadata.yaml b/bags/rviz_3dof_2/metadata.yaml
deleted file mode 100644
index db2dcfb1e419ea9f9a390851b808a6e786f194ad..0000000000000000000000000000000000000000
--- a/bags/rviz_3dof_2/metadata.yaml
+++ /dev/null
@@ -1,32 +0,0 @@
-rosbag2_bagfile_information:
-  version: 5
-  storage_identifier: sqlite3
-  duration:
-    nanoseconds: 60548817336
-  starting_time:
-    nanoseconds_since_epoch: 1718808731471501787
-  message_count: 2424
-  topics_with_message_count:
-    - topic_metadata:
-        name: /visualization_marker
-        type: visualization_msgs/msg/Marker
-        serialization_format: cdr
-        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
-      message_count: 1212
-    - topic_metadata:
-        name: /visualization_path
-        type: nav_msgs/msg/Path
-        serialization_format: cdr
-        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
-      message_count: 1212
-  compression_format: ""
-  compression_mode: ""
-  relative_file_paths:
-    - rviz_3dof_2_0.db3
-  files:
-    - path: rviz_3dof_2_0.db3
-      starting_time:
-        nanoseconds_since_epoch: 1718808731471501787
-      duration:
-        nanoseconds: 60548817336
-      message_count: 2424
\ No newline at end of file
diff --git a/bags/rviz_3dof_2/rviz_3dof_2_0.db3 b/bags/rviz_3dof_2/rviz_3dof_2_0.db3
deleted file mode 100644
index abed8c716c2799d3e8c6298fbb08f093340f8b0b..0000000000000000000000000000000000000000
Binary files a/bags/rviz_3dof_2/rviz_3dof_2_0.db3 and /dev/null differ
diff --git a/bags/rviz_3dof_3/metadata.yaml b/bags/rviz_3dof_3/metadata.yaml
deleted file mode 100644
index e96e64692cad1a3cb6bf1f69272640299a852b2b..0000000000000000000000000000000000000000
--- a/bags/rviz_3dof_3/metadata.yaml
+++ /dev/null
@@ -1,32 +0,0 @@
-rosbag2_bagfile_information:
-  version: 5
-  storage_identifier: sqlite3
-  duration:
-    nanoseconds: 60800065650
-  starting_time:
-    nanoseconds_since_epoch: 1718809979497795328
-  message_count: 2434
-  topics_with_message_count:
-    - topic_metadata:
-        name: /visualization_path
-        type: nav_msgs/msg/Path
-        serialization_format: cdr
-        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
-      message_count: 1217
-    - topic_metadata:
-        name: /visualization_marker
-        type: visualization_msgs/msg/Marker
-        serialization_format: cdr
-        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
-      message_count: 1217
-  compression_format: ""
-  compression_mode: ""
-  relative_file_paths:
-    - rviz_3dof_3_0.db3
-  files:
-    - path: rviz_3dof_3_0.db3
-      starting_time:
-        nanoseconds_since_epoch: 1718809979497795328
-      duration:
-        nanoseconds: 60800065650
-      message_count: 2434
\ No newline at end of file
diff --git a/bags/rviz_3dof_3/rviz_3dof_3_0.db3 b/bags/rviz_3dof_3/rviz_3dof_3_0.db3
deleted file mode 100644
index bde2d4200fe04912339ce1bb63027c588e661b04..0000000000000000000000000000000000000000
Binary files a/bags/rviz_3dof_3/rviz_3dof_3_0.db3 and /dev/null differ
diff --git a/bags/simulation_1dof/metadata.yaml b/bags/simulation_1dof/metadata.yaml
new file mode 100644
index 0000000000000000000000000000000000000000..552a1b0dcbd46f5fdb91b8c64854f56dcf53e917
--- /dev/null
+++ b/bags/simulation_1dof/metadata.yaml
@@ -0,0 +1,74 @@
+rosbag2_bagfile_information:
+  version: 5
+  storage_identifier: sqlite3
+  duration:
+    nanoseconds: 28131102203
+  starting_time:
+    nanoseconds_since_epoch: 1724005961084142906
+  message_count: 1523
+  topics_with_message_count:
+    - topic_metadata:
+        name: /kuka_iiwa/target_pose
+        type: geometry_msgs/msg/Pose
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 89
+    - topic_metadata:
+        name: /simple_robot/visualization_path
+        type: nav_msgs/msg/Path
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 268
+    - topic_metadata:
+        name: /joint_states
+        type: sensor_msgs/msg/JointState
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 268
+    - topic_metadata:
+        name: /simple_robot/target_pose
+        type: geometry_msgs/msg/Pose
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 265
+    - topic_metadata:
+        name: /iiwa_arm_controller/joint_trajectory
+        type: trajectory_msgs/msg/JointTrajectory
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 89
+    - topic_metadata:
+        name: /robot_description
+        type: std_msgs/msg/String
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 1\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 1
+    - topic_metadata:
+        name: /tf_static
+        type: tf2_msgs/msg/TFMessage
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 1\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 1
+    - topic_metadata:
+        name: /dof1/reference_angles
+        type: std_msgs/msg/Float64
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 276
+    - topic_metadata:
+        name: /tf
+        type: tf2_msgs/msg/TFMessage
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 266
+  compression_format: ""
+  compression_mode: ""
+  relative_file_paths:
+    - subset_0.db3
+  files:
+    - path: subset_0.db3
+      starting_time:
+        nanoseconds_since_epoch: 1724005961084142906
+      duration:
+        nanoseconds: 28131102203
+      message_count: 1523
\ No newline at end of file
diff --git a/bags/simulation_1dof/subset_0.db3 b/bags/simulation_1dof/subset_0.db3
new file mode 100644
index 0000000000000000000000000000000000000000..fabce2a6f7a52b2d9f4cecae2e11f81d68aaf826
Binary files /dev/null and b/bags/simulation_1dof/subset_0.db3 differ
diff --git a/bags/simulation_2dof_simultaneous/metadata.yaml b/bags/simulation_2dof_simultaneous/metadata.yaml
new file mode 100644
index 0000000000000000000000000000000000000000..d954d494366fba22c1df0ee3a2c9b5db97a1d05c
--- /dev/null
+++ b/bags/simulation_2dof_simultaneous/metadata.yaml
@@ -0,0 +1,68 @@
+rosbag2_bagfile_information:
+  version: 5
+  storage_identifier: sqlite3
+  duration:
+    nanoseconds: 28539952674
+  starting_time:
+    nanoseconds_since_epoch: 1724006104156845691
+  message_count: 1322
+  topics_with_message_count:
+    - topic_metadata:
+        name: /simple_robot/visualization_path
+        type: nav_msgs/msg/Path
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 285
+    - topic_metadata:
+        name: /kuka_iiwa/target_pose
+        type: geometry_msgs/msg/Pose
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 89
+    - topic_metadata:
+        name: /joint_states
+        type: sensor_msgs/msg/JointState
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 285
+    - topic_metadata:
+        name: /dof2/reference_angles
+        type: std_msgs/msg/Float64
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 286
+    - topic_metadata:
+        name: /iiwa_arm_controller/joint_trajectory
+        type: trajectory_msgs/msg/JointTrajectory
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 89
+    - topic_metadata:
+        name: /robot_description
+        type: std_msgs/msg/String
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 1\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 1
+    - topic_metadata:
+        name: /tf_static
+        type: tf2_msgs/msg/TFMessage
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 1\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 1
+    - topic_metadata:
+        name: /tf
+        type: tf2_msgs/msg/TFMessage
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 286
+  compression_format: ""
+  compression_mode: ""
+  relative_file_paths:
+    - simulation_2dof_simultaneous_0.db3
+  files:
+    - path: simulation_2dof_simultaneous_0.db3
+      starting_time:
+        nanoseconds_since_epoch: 1724006104156845691
+      duration:
+        nanoseconds: 28539952674
+      message_count: 1322
\ No newline at end of file
diff --git a/bags/simulation_2dof_simultaneous/simulation_2dof_simultaneous_0.db3 b/bags/simulation_2dof_simultaneous/simulation_2dof_simultaneous_0.db3
new file mode 100644
index 0000000000000000000000000000000000000000..e3017650209b5610689559167bf2fcc0ffd2a308
Binary files /dev/null and b/bags/simulation_2dof_simultaneous/simulation_2dof_simultaneous_0.db3 differ
diff --git a/bags/simulation_2dof_successive/metadata.yaml b/bags/simulation_2dof_successive/metadata.yaml
new file mode 100644
index 0000000000000000000000000000000000000000..16a722fb33ea07fc75b11a7377e2570a048e091f
--- /dev/null
+++ b/bags/simulation_2dof_successive/metadata.yaml
@@ -0,0 +1,68 @@
+rosbag2_bagfile_information:
+  version: 5
+  storage_identifier: sqlite3
+  duration:
+    nanoseconds: 56259534427
+  starting_time:
+    nanoseconds_since_epoch: 1724006189895851301
+  message_count: 2577
+  topics_with_message_count:
+    - topic_metadata:
+        name: /simple_robot/visualization_path
+        type: nav_msgs/msg/Path
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 552
+    - topic_metadata:
+        name: /kuka_iiwa/target_pose
+        type: geometry_msgs/msg/Pose
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 178
+    - topic_metadata:
+        name: /joint_states
+        type: sensor_msgs/msg/JointState
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 552
+    - topic_metadata:
+        name: /iiwa_arm_controller/joint_trajectory
+        type: trajectory_msgs/msg/JointTrajectory
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 178
+    - topic_metadata:
+        name: /dof2/reference_angles
+        type: std_msgs/msg/Float64
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 562
+    - topic_metadata:
+        name: /robot_description
+        type: std_msgs/msg/String
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 1\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 1
+    - topic_metadata:
+        name: /tf_static
+        type: tf2_msgs/msg/TFMessage
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 1\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 1
+    - topic_metadata:
+        name: /tf
+        type: tf2_msgs/msg/TFMessage
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 553
+  compression_format: ""
+  compression_mode: ""
+  relative_file_paths:
+    - simulation_2dof_successive_0.db3
+  files:
+    - path: simulation_2dof_successive_0.db3
+      starting_time:
+        nanoseconds_since_epoch: 1724006189895851301
+      duration:
+        nanoseconds: 56259534427
+      message_count: 2577
\ No newline at end of file
diff --git a/bags/simulation_2dof_successive/simulation_2dof_successive_0.db3 b/bags/simulation_2dof_successive/simulation_2dof_successive_0.db3
new file mode 100644
index 0000000000000000000000000000000000000000..2a20314fc561bc91c9c5706b0a01285f2e5e192b
Binary files /dev/null and b/bags/simulation_2dof_successive/simulation_2dof_successive_0.db3 differ
diff --git a/bags/simulation_3dof_successive/metadata.yaml b/bags/simulation_3dof_successive/metadata.yaml
new file mode 100644
index 0000000000000000000000000000000000000000..34bef6d4290f8e9b396e606656d54dd380438d5b
--- /dev/null
+++ b/bags/simulation_3dof_successive/metadata.yaml
@@ -0,0 +1,62 @@
+rosbag2_bagfile_information:
+  version: 5
+  storage_identifier: sqlite3
+  duration:
+    nanoseconds: 46065644605
+  starting_time:
+    nanoseconds_since_epoch: 1724006784953062923
+  message_count: 1595
+  topics_with_message_count:
+    - topic_metadata:
+        name: /simple_robot/visualization_path
+        type: nav_msgs/msg/Path
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 432
+    - topic_metadata:
+        name: /kuka_iiwa/target_pose
+        type: geometry_msgs/msg/Pose
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 149
+    - topic_metadata:
+        name: /joint_states
+        type: sensor_msgs/msg/JointState
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 432
+    - topic_metadata:
+        name: /iiwa_arm_controller/joint_trajectory
+        type: trajectory_msgs/msg/JointTrajectory
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 149
+    - topic_metadata:
+        name: /tf
+        type: tf2_msgs/msg/TFMessage
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 2\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 431
+    - topic_metadata:
+        name: /tf_static
+        type: tf2_msgs/msg/TFMessage
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 1\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 1
+    - topic_metadata:
+        name: /robot_description
+        type: std_msgs/msg/String
+        serialization_format: cdr
+        offered_qos_profiles: "- history: 3\n  depth: 0\n  reliability: 1\n  durability: 1\n  deadline:\n    sec: 9223372036\n    nsec: 854775807\n  lifespan:\n    sec: 9223372036\n    nsec: 854775807\n  liveliness: 1\n  liveliness_lease_duration:\n    sec: 9223372036\n    nsec: 854775807\n  avoid_ros_namespace_conventions: false"
+      message_count: 1
+  compression_format: ""
+  compression_mode: ""
+  relative_file_paths:
+    - simulation_3dof_successive_0.db3
+  files:
+    - path: simulation_3dof_successive_0.db3
+      starting_time:
+        nanoseconds_since_epoch: 1724006784953062923
+      duration:
+        nanoseconds: 46065644605
+      message_count: 1595
\ No newline at end of file
diff --git a/bags/simulation_3dof_successive/simulation_3dof_successive_0.db3 b/bags/simulation_3dof_successive/simulation_3dof_successive_0.db3
new file mode 100644
index 0000000000000000000000000000000000000000..6230a77db8c5f002170bcc30ba4b0690928cc5c2
Binary files /dev/null and b/bags/simulation_3dof_successive/simulation_3dof_successive_0.db3 differ