Merge v9.2 main

.github/actions/find_release_branch/action.yaml

@@ -0,0 +1,42 @@
+name: 'Find Release Branch'
+description: 'Find the highest v<major>.<minor> branch in the repository.'
+outputs:
+  branch:
+    description: 'The release branch name (e.g. v9.5).'
+    value: ${{ steps.find_branch.outputs.branch }}
+
+runs:
+  using: 'composite'
+  steps:
+    - name: Find highest release branch
+      id: find_branch
+      uses: actions/github-script@3a2844b7e9c422d3c10d287c895573f7108da1b3 # v9.0.0
+      with:
+        script: |
+          const owner = context.repo.owner;
+          const repo = context.repo.repo;
+
+          const branchPattern = /^v(\d+)\.(\d+)$/;
+          const branches = await github.paginate(github.rest.repos.listBranches, {
+            owner,
+            repo,
+            per_page: 100,
+          });
+
+          const versionBranches = branches
+            .map(b => b.name)
+            .filter(name => branchPattern.test(name))
+            .sort((a, b) => {
+              const [, aMajor, aMinor] = a.match(branchPattern).map(Number);
+              const [, bMajor, bMinor] = b.match(branchPattern).map(Number);
+              return bMajor - aMajor || bMinor - aMinor;
+            });
+
+          if (versionBranches.length === 0) {
+            core.setFailed('No branch matching v<major>.<minor> found.');
+            return;
+          }
+
+          const branch = versionBranches[0];
+          core.info(`Found release branch: ${branch}`);
+          core.setOutput('branch', branch);

.github/workflows/batch-merge-release-branch.yaml

@@ -14,17 +14,17 @@ jobs:
   batch-merge-release-branch:
     runs-on: ubuntu-latest
     steps:
-      - name: Get current release branch
-        id: get_current_release_branch
-        uses: PickNikRobotics/moveit_pro/.github/actions/find_release_branch@v9.2
-
       - name: Checkout code
         uses: actions/checkout@v6
         with:
           ref: main
           fetch-depth: 0
           lfs: false
 
+      - name: Get current release branch
+        id: get_current_release_branch
+        uses: ./.github/actions/find_release_branch
+
       - name: Merge release branch into main
         id: merge
         env:

src/lab_sim/objectives/stitch_multiple_point_clouds_together.xml

@@ -18,7 +18,7 @@
       <Action
         ID="CreateStampedPose"
         orientation_xyzw="0;-1;0;0"
-        position_xyz="0.5;0.1;0.5"
+        position_xyz="0.0;0.5;0.8"
         stamped_pose="{pose1}"
         reference_frame="world"
       />
@@ -30,7 +30,7 @@
       <Action
         ID="CreateStampedPose"
         orientation_xyzw="0;-1;0;0"
-        position_xyz="0.6;0.2;0.5"
+        position_xyz="0.3;0.4;0.8"
         stamped_pose="{pose2}"
         reference_frame="world"
       />
@@ -42,7 +42,7 @@
       <Action
         ID="CreateStampedPose"
         orientation_xyzw="0;-1;0;0"
-        position_xyz="0.4;0.3;0.5"
+        position_xyz="0.6;0.5;0.8"
         stamped_pose="{pose3}"
         reference_frame="world"
       />