bl_update: Allow booting from SD card (without forced BL copy to ROMFS)

2026-05-27 06:00:04 +08:00 · 2025-08-20 18:22:42 +02:00
1997 changed files with 19635 additions and 73646 deletions
@@ -1,9 +1,22 @@
 <!--

+Thank you for your contribution!
+
+Get early feedback through
+- Dronecode Discord: https://discord.gg/dronecode
+- PX4 Discuss: http://discuss.px4.io/
+- opening a draft pr and sharing the link
+
+-->
+
 ### Solved Problem
+When ... I found that ...
+
 Fixes #{Github issue ID}

 ### Solution
+- Add ... for ...
+- Refactor ...

 ### Changelog Entry
 For release notes:
@@ -14,10 +27,11 @@ Documentation: Need to clarify page ... / done, read docs.px4.io/...
 ```

 ### Alternatives
+We could also ...

 ### Test coverage
+- Unit/integration test: ...
+- Simulation/hardware testing logs: https://review.px4.io/

 ### Context
 Related links, screenshot before/after, video
-
-->
@@ -1,24 +0,0 @@
-runners:
-  x86-small-runner:
-    cpu: [1, 2]
-    ram: [1, 4]
-    disk: default
-    spot: price-capacity-optimized
-    image: ubuntu24-full-x64
-    extras: s3-cache
-  x86-firmware-builder:
-    cpu: [4, 8]
-    ram: [8, 16]
-    disk: default
-    family: ["c7i", "m7i", "r7i"]
-    spot: price-capacity-optimized
-    image: ubuntu24-full-x64
-    extras: s3-cache
-  arm64-firmware-builder:
-    cpu: [4, 8]
-    ram: [8, 16]
-    disk: default
-    family: ["c7g", "m7g", "r7g"]
-    spot: price-capacity-optimized
-    image: ubuntu24-full-arm64
-    extras: s3-cache
@@ -26,15 +26,11 @@ concurrency:
  group: ${{ github.workflow }}-${{ github.ref }}
  cancel-in-progress: true

-permissions:
-  contents: write
-  actions: read
-
 jobs:
  group_targets:
    name: Scan for Board Targets
    # runs-on: ubuntu-latest
-    runs-on: [runs-on,runner=1cpu-linux-x64,image=ubuntu24-full-x64,"run-id=${{ github.run_id }}",spot=false]
+    runs-on: [runs-on,runner=1cpu-linux-x64,image=ubuntu22-full-x64,"run-id=${{ github.run_id }}",spot=false]
    outputs:
      matrix: ${{ steps.set-matrix.outputs.matrix }}
      timestamp: ${{ steps.set-timestamp.outputs.timestamp }}
@@ -42,14 +38,6 @@ jobs:
    steps:
      - uses: actions/checkout@v4

-      - name: Cache Python pip
-        uses: actions/cache@v4
-        with:
-          path: ~/.cache/pip
-          key: ${{ runner.os }}-pip-${{ hashFiles('**./Tools/setup/requirements.txt') }}
-          restore-keys: |
-            ${{ runner.os }}-pip-
-
      - name: Update python packaging to avoid canonicalize_version() error
        run: |
            pip3 install -U packaging
@@ -60,15 +48,12 @@ jobs:
          path: "./Tools/setup/requirements.txt"

      - id: set-matrix
-        name: Generate Build Matrix
-        run: echo "matrix=$(./Tools/ci/generate_board_targets_json.py --group)" >> $GITHUB_OUTPUT
+        run: echo "::set-output name=matrix::$(./Tools/ci/generate_board_targets_json.py --group)"

      - id: set-timestamp
-        name: Save Current Timestamp
-        run: echo "timestamp=$(date +"%Y%m%d%H%M%S")" >> $GITHUB_OUTPUT
+        run: echo "::set-output name=timestamp::$(date +"%Y%m%d%H%M%S")"

      - id: set-branch
-        name: Save Current Branch Name
        run: |
          echo "branchname=${{
            github.event_name == 'pull_request' &&
@@ -85,7 +70,7 @@ jobs:
          echo "$(./Tools/ci/generate_board_targets_json.py --group --verbose)"

  setup:
-    name: Build [${{ matrix.runner }}][${{ matrix.group }}]
+    name: Build Group [${{ matrix.group }}][${{ matrix.arch == 'nuttx' && 'x86' || 'arm64' }}]
    # runs-on: ubuntu-latest
    runs-on: [runs-on,"runner=8cpu-linux-${{ matrix.runner }}","image=ubuntu24-full-${{ matrix.runner }}","run-id=${{ github.run_id }}",spot=false]
    needs: group_targets
@@ -95,7 +80,6 @@ jobs:
    container:
      image: ${{ matrix.container }}
    steps:
-      - uses: runs-on/action@v2
      - uses: actions/checkout@v4
        with:
          fetch-depth: 0
@@ -103,24 +87,14 @@ jobs:
      - name: Git ownership workaround
        run: git config --system --add safe.directory '*'

-      # ccache key breakdown:
-      # ccache-<system os>-<system arch>-<builder group>-
-      # ccache-<linux>-<arm64>-<aarch64-0>-
-      # ccache-<linux>-<x64>-<nuttx-0>-
-      - name: Cache Restore from Key
-        id: cc_restore
-        uses: actions/cache/restore@v4
+      - name: Setup ccache
+        uses: actions/cache@v4
        with:
          path: ~/.ccache
-          key: ${{ format('ccache-{0}-{1}-{2}', runner.os, matrix.runner, matrix.group) }}
-          restore-keys: |
-            ccache-${{ runner.os }}-${{ matrix.runner }}-${{ matrix.group }}-
-            ccache-${{ runner.os }}-${{ matrix.runner }}-
-            ccache-${{ runner.os }}-${{ matrix.runner }}-
-            ccache-${{ runner.os }}-
-            ccache-
+          key: ${{ matrix.group }}-ccache-${{ needs.group_targets.outputs.timestamp }}
+          restore-keys: ${{ matrix.group }}-ccache-${{ needs.group_targets.outputs.timestamp }}

-      - name: Cache Config and Stats
+      - name: Configure ccache
        run: |
            mkdir -p ~/.ccache
            echo "base_dir = ${GITHUB_WORKSPACE}" > ~/.ccache/ccache.conf
@@ -128,11 +102,10 @@ jobs:
            echo "compression_level = 6" >> ~/.ccache/ccache.conf
            echo "max_size = 120M" >> ~/.ccache/ccache.conf
            echo "hash_dir = false" >> ~/.ccache/ccache.conf
-            echo "compiler_check = content" >> ~/.ccache/ccache.conf
            ccache -s
            ccache -z

-      - name: Building Artifacts for [${{ matrix.targets }}]
+      - name: Building [${{ matrix.group }}]
        run: |
            ./Tools/ci/build_all_runner.sh ${{matrix.targets}} ${{matrix.arch}}

@@ -146,27 +119,15 @@ jobs:
          name: px4_${{matrix.group}}_build_artifacts
          path: artifacts/

-      - name: Cache Post Build Stats
-        if: always()
-        run: |
-            ccache -s
-            ccache -z
-
      - name: Cache Save
-        if: always()
-        uses: actions/cache/save@v4
-        with:
-          path: ~/.ccache
-          key: ${{ steps.cc_restore.outputs.cache-primary-key }}
+        run: ccache -s

  artifacts:
-    name: Upload Artifacts
+    name: Upload Artifacts to S3
    # runs-on: ubuntu-latest
    runs-on: [runs-on,runner=1cpu-linux-x64,image=ubuntu24-full-x64,"run-id=${{ github.run_id }}",spot=false]
    needs: [setup, group_targets]
-    if: startsWith(github.ref, 'refs/tags/v') || contains(fromJSON('["main","stable","beta"]'), needs.group_targets.outputs.branchname)
-    outputs:
-      uploadlocation: ${{ steps.upload-location.outputs.uploadlocation }}
+    if: contains(fromJSON('["main", "stable", "beta"]'), needs.group_targets.outputs.branchname)
    steps:
      - name: Download Artifacts
        uses: actions/download-artifact@v4
@@ -174,36 +135,11 @@ jobs:
          path: artifacts/
          merge-multiple: true

-      - name: Choose Upload Location
-        id: upload-location
+      - name: Branch Name
        run: |
-          # Determine upload location based on branch or tag with the following considerations:
-          # Destination: AWS S3 bucket px4-travis in folder Firmware/
-          # - If branch is main -> upload to master/
-          #   - Older versions of QGC are hardocded to look for master/
-          # - If branch is stable or beta -> upload to stable/ or beta/
-          # - If a tag vX.Y.Z -> upload to vX.Y.Z/
-          #   - Also update stable/ to point to the same version
-          #.  - Older versions of QGC are hardocded to look for stable/
-          # - If a pull request -> do not upload
-          set -euo pipefail
+          echo "${{ needs.group_targets.outputs.branchname }}"

-          ref="${GITHUB_REF}"
-          branch=${{ needs.group_targets.outputs.branchname  }}
-          location="$branch"
-
-          if [[ "$branch" == "main" ]]; then
-            location="master"
-          fi
-
-          if [[ "$ref" == refs/tags/v[0-9]* ]]; then
-            tag="${ref#refs/tags/}"
-            location="$tag"
-          fi
-
-          echo "uploadlocation=$location" >> $GITHUB_OUTPUT
-
-      - name: Uploading Artifacts to S3 [${{ steps.upload-location.outputs.uploadlocation }}]
+      - name: Uploading Artifacts to S3 [${{ needs.group_targets.outputs.branchname == 'main' && 'master' || needs.group_targets.outputs.branchname }}]
        uses: jakejarvis/s3-sync-action@master
        with:
          args: --acl public-read
@@ -213,30 +149,25 @@ jobs:
          AWS_SECRET_ACCESS_KEY: ${{ secrets.AWS_SECRET_ACCESS_KEY }}
          AWS_REGION: 'us-west-1'
          SOURCE_DIR: artifacts/
-          DEST_DIR: Firmware/${{ steps.upload-location.outputs.uploadlocation }}/
+          DEST_DIR: Firmware/${{ needs.group_targets.outputs.branchname == 'main' && 'master' || needs.group_targets.outputs.branchname }}/

-      # if we are uploading artifacts to a versioned folder
-      # we should also update the stable folder in the s3 bucket
-      - name: Uploading Artifacts to S3 [stable]
-        uses: jakejarvis/s3-sync-action@master
-        if: startsWith(github.ref, 'refs/tags/v')
+  release:
+    name: Create Release and Upload Artifacts
+    permissions:
+      contents: write
+    # runs-on: ubuntu-latest
+    runs-on: [runs-on,runner=1cpu-linux-x64,image=ubuntu24-full-x64,"run-id=${{ github.run_id }}",spot=false]
+    needs: [setup, group_targets]
+    if: startsWith(github.ref, 'refs/tags/')
+    steps:
+      - name: Download Artifacts
+        uses: actions/download-artifact@v4
        with:
-          args: --acl public-read
-        env:
-          AWS_S3_BUCKET: 'px4-travis'
-          AWS_ACCESS_KEY_ID: ${{ secrets.AWS_ACCESS_KEY_ID }}
-          AWS_SECRET_ACCESS_KEY: ${{ secrets.AWS_SECRET_ACCESS_KEY }}
-          AWS_REGION: 'us-west-1'
-          SOURCE_DIR: artifacts/
-          DEST_DIR: Firmware/stable/
+          path: artifacts/
+          merge-multiple: true

-      # if build is a release triggered by a versioned tag then create a github release
-      # and upload the build artifacts. A draft release is created so that the release
-      # can be reviewed before publishing
-      - name: Upload Artifacts to GitHub Release
+      - name: Upload Binaries to Release
        uses: softprops/action-gh-release@v2
-        if: startsWith(github.ref, 'refs/tags/v')
        with:
          draft: true
          files: artifacts/*.px4
-          name: ${{ steps.upload-location.outputs.uploadlocation }}
@@ -29,7 +29,7 @@ jobs:
      fail-fast: false
      matrix:
        version: ['ubuntu:22.04', 'ubuntu:24.04']
-    runs-on: [runs-on,runner=4cpu-linux-x64,"image=ubuntu24-full-x64","run-id=${{ github.run_id }}",spot=false]
+    runs-on: [runs-on,runner=8cpu-linux-x64,"image=ubuntu24-full-x64","run-id=${{ github.run_id }}",spot=false]
    container:
      image: ${{ matrix.version }}
      volumes:
@@ -39,7 +39,7 @@ jobs:
    name: Set Tags and Variables
    permissions:
      contents: read
-    runs-on: [runs-on,"runner=1cpu-linux-x64","image=ubuntu24-full-x64","run-id=${{ github.run_id }}",extras=s3-cache,spot=false]
+    runs-on: [runs-on,"runner=1cpu-linux-x64","image=ubuntu24-full-x64","run-id=${{ github.run_id }}",spot=false,extras=s3-cache]
    outputs:
      px4_version: ${{ steps.px4_version.outputs.px4_version }}
      meta_tags: ${{ steps.meta.outputs.tags }}
@@ -87,7 +87,7 @@ jobs:
          - platform: linux/amd64
            arch: amd64
            runner: x64
-    runs-on: [runs-on,"runner=4cpu-linux-${{ matrix.runner }}","image=ubuntu24-full-${{ matrix.runner }}","run-id=${{ github.run_id }}",extras=s3-cache,spot=false]
+    runs-on: [runs-on,"runner=8cpu-linux-${{ matrix.runner }}","image=ubuntu24-full-${{ matrix.runner }}","run-id=${{ github.run_id }}",spot=false,extras=s3-cache]
    steps:
      - uses: runs-on/action@v1
      - uses: actions/checkout@v4
@@ -130,15 +130,15 @@ jobs:
          load: false
          push: ${{ startsWith(github.ref, 'refs/tags/') || (github.event_name == 'workflow_dispatch' && github.event.inputs.deploy_to_registry) }}
          provenance: false
-          cache-from: type=gha,version=1,scope=${{ matrix.arch }}
-          cache-to: type=gha,version=1,mode=max,scope=${{ matrix.arch }}
+          cache-from: type=gha,version=1
+          cache-to: type=gha,version=1,mode=max

  deploy:
    name: Deploy To Registry
    permissions:
      contents: read
      packages: write
-    runs-on: [runs-on,"runner=4cpu-linux-x64","image=ubuntu24-full-x64","run-id=${{ github.run_id }}",extras=s3-cache,spot=false]
+    runs-on: [runs-on,"runner=8cpu-linux-x64","image=ubuntu24-full-x64","run-id=${{ github.run_id }}",spot=false,extras=s3-cache]
    needs: [build, setup]
    if: ${{ startsWith(github.ref, 'refs/tags/') || (github.event_name == 'workflow_dispatch' && github.event.inputs.deploy_to_registry) }}
    steps:
@@ -1,6 +1,19 @@
-name: Docs - Deploy PX4 User Guide to Github pages (Manual)
+name: Docs - Deploy PX4 User Guide

 on:
+  push:
+    branches:
+      - 'main'
+      - 'release/**'
+    paths:
+      - 'docs/en/**'
+  pull_request:
+    branches:
+      - '**'
+    paths:
+      - 'docs/en/**'
+
+  # Allows you to run this workflow manually from the Actions tab
  workflow_dispatch:

 # Sets permissions of the GITHUB_TOKEN to allow deployment to GitHub Pages
@@ -20,7 +33,7 @@ env:

 jobs:
  build:
-    runs-on: [runs-on,runner=4cpu-linux-x64,image=ubuntu24-full-x64,"run-id=${{ github.run_id }}",extras=s3-cache,spot=false]
+    runs-on: [runs-on,runner=8cpu-linux-x64,image=ubuntu24-full-x64,"run-id=${{ github.run_id }}",spot=false,extras=s3-cache]
    steps:
      - uses: runs-on/action@v1
      - name: Checkout
@@ -55,7 +68,7 @@ jobs:
  deploy:
    if: ${{ github.event_name == 'push' || (github.event_name == 'pull_request' && github.event.pull_request.merged) || github.event_name == 'workflow_dispatch' }}
    needs: build
-    runs-on: [runs-on,runner=4cpu-linux-x64,image=ubuntu24-full-x64,"run-id=${{ github.run_id }}",spot=false]
+    runs-on: [runs-on,runner=8cpu-linux-x64,image=ubuntu24-full-x64,"run-id=${{ github.run_id }}",spot=false]

    steps:
      - name: Download Artifact
@@ -7,52 +7,42 @@ on:
      - "release/**"
    paths:
      - "docs/en/**"
-      - "docs/zh/**"
-      - "docs/uk/**"
-      - "docs/ko/**"
  pull_request:
+    branches:
+      - "**"
    paths:
      - "docs/en/**"
-      - "docs/zh/**"
-      - "docs/uk/**"
-      - "docs/ko/**"

  workflow_dispatch:

 permissions:
  contents: read
-  actions: read
  id-token: write # for AWS OIDC

 concurrency:
  group: docs-deploy
  cancel-in-progress: false

+env:
+  BRANCH_NAME: ${{ github.head_ref || github.ref_name }}
+
 jobs:
  build:
-    runs-on: [runs-on,runner=4cpu-linux-x64,image=ubuntu24-full-x64,"run-id=${{ github.run_id }}",spot=false,extras=s3-cache]
-    outputs:
-      branchname: ${{ steps.set-branch.outputs.branchname }}
-      releaseversion: ${{ steps.set-version.outputs.releaseversion }}
+    runs-on:
+      [
+        runs-on,
+        runner=8cpu-linux-x64,
+        image=ubuntu24-full-x64,
+        "run-id=${{ github.run_id }}",
+        spot=false,
+        extras=s3-cache,
+      ]
    steps:
      - uses: runs-on/action@v1

      - name: Checkout
        uses: actions/checkout@v4

-      - id: set-branch
-        run: echo "branchname=${GITHUB_HEAD_REF:-${GITHUB_REF#refs/heads/}}" >> $GITHUB_OUTPUT
-
-      - id: set-version
-        run: |
-          branch="${{ steps.set-branch.outputs.branchname }}"
-          if [[ "$branch" == "main" ]]; then
-            version="main"
-          else
-            version="v${branch#release/}"
-          fi
-          echo "releaseversion=$version" >> $GITHUB_OUTPUT
-
      - name: Setup Node
        uses: actions/setup-node@v4
        with:
@@ -65,8 +55,6 @@ jobs:

      - name: Build with VitePress
        working-directory: ./docs
-        env:
-          BRANCH_NAME: ${{ steps.set-version.outputs.releaseversion }}
        run: |
          npm run docs:build_ubuntu
          touch .vitepress/dist/.nojekyll
@@ -103,14 +91,14 @@ jobs:

      - name: Upload HTML with short cache
        run: |
-          aws s3 sync ~/_book/ s3://px4-docs/${{ needs.build.outputs.releaseversion }}/ \
+          aws s3 sync ~/_book/ s3://px4-docs/${{ env.BRANCH_NAME }}/ \
            --delete \
            --exclude "*" --include "*.html" \
            --cache-control "public, max-age=60"

      - name: Upload assets with long cache
        run: |
-          aws s3 sync ~/_book/ s3://px4-docs/${{ needs.build.outputs.releaseversion }}/ \
+          aws s3 sync ~/_book/ s3://px4-docs/${{ env.BRANCH_NAME }}/ \
            --delete \
            --exclude "*.html" \
            --cache-control "public, max-age=86400, immutable"
@@ -48,7 +48,6 @@ jobs:
        run: |
          git clone https://github.com/emscripten-core/emsdk.git _emscripten_sdk
          cd _emscripten_sdk
-          git checkout 4.0.15
          ./emsdk install latest
          ./emsdk activate latest

@@ -24,7 +24,7 @@ env:
 jobs:
  analyze_flash:
    name: Analyzing ${{ matrix.target }}
-    runs-on: [runs-on,runner=4cpu-linux-x64,image=ubuntu24-full-x64,"run-id=${{ github.run_id }}",spot=false]
+    runs-on: [runs-on,runner=8cpu-linux-x64,image=ubuntu24-full-x64,"run-id=${{ github.run_id }}",spot=false]
    container:
      image: px4io/px4-dev:v1.16.0-rc1-258-g0369abd556
    strategy:
@@ -54,7 +54,6 @@ jobs:
        run: |
          make clean
          make distclean
-          make submodulesclean

      - name: If it's a PR checkout the base branch
        if: ${{ github.event.pull_request }}
@@ -98,7 +97,7 @@ jobs:
  # Track this issue https://github.com/PX4/PX4-Autopilot/issues/24408
  post_pr_comment:
    name: Publish Results
-    runs-on: [runs-on,runner=1cpu-linux-x64,image=ubuntu24-full-x64,"run-id=${{ github.run_id }}"]
+    runs-on: [runs-on,runner=1cpu-linux-x64,image=ubuntu24-full-x64,"run-id=${{ github.run_id }}",spot=false]
    needs: [analyze_flash]
    env:
      V5X-SUMMARY-MAP-ABS: ${{ fromJSON(fromJSON(needs.analyze_flash.outputs.px4_fmu-v5x-bloaty-summary-map).vm-absolute) }}
@@ -5,7 +5,6 @@ on:

 permissions:
  contents: read
-  issues: write # for JasonEtco/create-an-issue

 env:
  RUNS_IN_DOCKER: true
@@ -22,7 +22,7 @@ concurrency:
 jobs:
  check_itcm:
    name: Checking ${{ matrix.target }}
-    runs-on: [runs-on,runner=4cpu-linux-x64,image=ubuntu24-full-x64,"run-id=${{ github.run_id }}",spot=false]
+    runs-on: [runs-on,runner=8cpu-linux-x64,image=ubuntu24-full-x64,"run-id=${{ github.run_id }}",spot=false]
    container:
      image: px4io/px4-dev:v1.16.0-rc1-258-g0369abd556
    strategy:
@@ -41,10 +41,6 @@ jobs:
            scripts: >
              boards/nxp/tropic-community/nuttx-config/scripts/itcm_functions_includes.ld
              boards/nxp/tropic-community/nuttx-config/scripts/itcm_static_functions.ld
-          - target: nxp_mr-tropic
-            scripts: >
-              boards/nxp/mr-tropic/nuttx-config/scripts/itcm_functions_includes.ld
-              boards/nxp/mr-tropic/nuttx-config/scripts/itcm_static_functions.ld
    steps:
      - uses: actions/checkout@v4
        with:
@@ -23,7 +23,7 @@ concurrency:

 jobs:
  build:
-    runs-on: [runs-on,runner=4cpu-linux-x64,image=ubuntu22-full-x64,"run-id=${{ github.run_id }}",spot=false]
+    runs-on: [runs-on,runner=16cpu-linux-x64,image=ubuntu22-full-x64,"run-id=${{ github.run_id }}",spot=false]
    container:
      image: px4io/px4-dev-ros2-galactic:2021-09-08
      options: --privileged --ulimit core=-1 --security-opt seccomp=unconfined
@@ -21,7 +21,7 @@ concurrency:
 jobs:
  build_and_test:
    name: Build and test
-    runs-on: [runs-on,runner=4cpu-linux-x64,image=ubuntu24-full-x64,"run-id=${{ github.run_id }}",spot=false]
+    runs-on: [runs-on,runner=8cpu-linux-x64,image=ubuntu24-full-x64,"run-id=${{ github.run_id }}",spot=false]
    strategy:
      fail-fast: false
      matrix:
@@ -24,7 +24,7 @@ concurrency:
 jobs:
  build:
    name: Testing PX4 ${{ matrix.config.model }}
-    runs-on: [runs-on,runner=4cpu-linux-x64,image=ubuntu22-full-x64,"run-id=${{ github.run_id }}",spot=false]
+    runs-on: [runs-on,runner=16cpu-linux-x64,image=ubuntu22-full-x64,"run-id=${{ github.run_id }}",spot=false]
    container:
      image: px4io/px4-dev-simulation-focal:2021-09-08
      options: --privileged --ulimit core=-1 --security-opt seccomp=unconfined
@@ -118,7 +118,7 @@ jobs:
          PX4_HOME_LON: ${{matrix.config.longitude}}
          PX4_HOME_ALT: ${{matrix.config.altitude}}
          PX4_CMAKE_BUILD_TYPE: ${{matrix.config.build_type}}
-        run: test/mavsdk_tests/mavsdk_test_runner.py --speed-factor 10 --abort-early --model ${{matrix.config.model}} test/mavsdk_tests/configs/sitl.json --verbose --force-color
+        run: test/mavsdk_tests/mavsdk_test_runner.py --speed-factor 10 --abort-early --model ${{matrix.config.model}} --upload test/mavsdk_tests/configs/sitl.json --verbose --force-color
        timeout-minutes: 45

      - name: Upload failed logs
@@ -7,15 +7,10 @@ jobs:
  stale:
    runs-on: ubuntu-latest
    steps:
-      - uses: actions/stale@v10
+      - uses: actions/stale@v8
        with:
-          operations-per-run: 250
-          days-before-stale: 90
-          days-before-close: 30
+          days-before-stale: 30
+          days-before-close: -1
          stale-issue-label: 'stale'
          stale-pr-label: 'stale'
          remove-stale-when-updated: true
-          stale-issue-message: 'This issue has been marked as stale due to 90 days of inactivity. If no further activity occurs, it will be automatically closed in 30 days. Please leave a comment, add a reaction, make an update, or remove the stale label if you’d like to keep it open.'
-          close-issue-message: 'This issue has been closed due to prolonged inactivity after being marked as stale. If you believe this was closed in error or the topic is still relevant, please feel free to reopen it or create a new issue.'
-          stale-pr-message: 'This PR was identified as stale and it will be closed in 30 days unless any activity is detected.'
-          close-pr-message: 'This pull request has been closed after being marked as stale with no further activity. Thank you for the time and effort you put into this contribution. If you’d like to continue the discussion or update the work, please feel free to reopen it or submit a new PR.'
@@ -1,62 +0,0 @@
-name: Sync ROS 2 messages to px4_msgs
-on:
-  push:
-    branches:
-      - 'main'
-      - 'stable'
-      - 'beta'
-      - 'release/**'
-    paths:
-      - 'msg/**'
-      - 'srv/**'
-  workflow_dispatch:
-
-permissions:
-  contents: read
-
-jobs:
-  sync_to_px4_msgs:
-    if: github.repository == 'PX4/PX4-Autopilot'
-    runs-on: [runs-on,runner=4cpu-linux-x64,image=ubuntu22-full-x64,"run-id=${{ github.run_id }}",spot=false]
-    steps:
-      - name: Checkout PX4 repo
-        uses: actions/checkout@v4
-
-      - name: Setup git credentials
-        run: |
-          git config --global user.name "${{ secrets.PX4BUILDBOT_USER }}"
-          git config --global user.email "${{ secrets.PX4BUILDBOT_EMAIL }}"
-
-      - name: Clone PX4_msgs repo
-        run: |
-          git clone https://${{ secrets.PX4BUILTBOT_PERSONAL_ACCESS_TOKEN }}@github.com/PX4/px4_msgs.git
-
-      - name: Check out the same branch as the PX4 repo
-        run: |
-          cd px4_msgs
-          if git checkout ${{ github.ref_name }}; then
-            echo "Checked out existing branch"
-          else
-            git checkout -b ${{ github.ref_name }}
-          fi
-
-      - name: Copy ROS 2 messages
-        run: |
-          rm -f px4_msgs/msg/*.msg
-          rm -f px4_msgs/msg/versioned/*.msg
-          rm -f px4_msgs/srv/*.srv
-          rm -f px4_msgs/srv/versioned/*.srv
-          cp msg/*.msg px4_msgs/msg/
-          cp msg/versioned/*.msg px4_msgs/msg/ || true
-          cp srv/*.srv px4_msgs/srv/
-          cp srv/versioned/*.srv px4_msgs/srv/ || true
-
-      - name: Commit and push changes
-        run: |
-          cd px4_msgs
-          git status
-          git add .
-          git commit -a -m "Update to PX4 ${{ github.sha }}" || true
-          git push origin ${{ github.ref_name }} || true
-          cd ..
-          rm -rf px4_msgs
@@ -100,6 +100,3 @@
 [submodule "src/drivers/ins/microstrain/mip_sdk"]
 	path = src/drivers/ins/microstrain/mip_sdk
 	url = https://github.com/PX4/LORD-MicroStrain_mip_sdk.git
-[submodule "src/drivers/ins/sbgecom/sbgECom"]
-	path = src/drivers/ins/sbgecom/sbgECom
-	url = https://github.com/PX4/sbgECom.git
@@ -36,11 +36,6 @@ CONFIG:
      buildType: RelWithDebInfo
      settings:
        CONFIG: px4_sitl_test
-    px4_sitl_zenoh:
-      short: px4_sitl_zenoh
-      buildType: RelWithDebInfo
-      settings:
-        CONFIG: px4_sitl_test
    px4_io-v2_default:
      short: px4_io-v2
      buildType: MinSizeRel
@@ -141,11 +136,6 @@ CONFIG:
      buildType: MinSizeRel
      settings:
        CONFIG: ark_can-flow_canbootloader
-    ark_can-flow-mr_default:
-      short: ark_can-flow-mr_default
-      buildType: MinSizeRel
-      settings:
-        CONFIG: ark_can-flow-mr_default
    ark_can-flow-mr_canbootloader:
      short: ark_can-flow-mr_canbootloader
      buildType: MinSizeRel
@@ -211,16 +201,6 @@ CONFIG:
      buildType: MinSizeRel
      settings:
        CONFIG: ark_dist_canbootloader
-    ark_f9p-gps_default:
-      short: ark_f9p-gps_default
-      buildType: MinSizeRel
-      settings:
-        CONFIG: ark_f9p-gps_default
-    ark_f9p-gps_canbootloader:
-      short: ark_f9p-gps_canbootloader
-      buildType: MinSizeRel
-      settings:
-        CONFIG: ark_f9p-gps_canbootloader
    ark_fmu-v6x_bootloader:
      short: ark_fmu-v6x_bootloader
      buildType: MinSizeRel
@@ -241,16 +221,6 @@ CONFIG:
      buildType: MinSizeRel
      settings:
        CONFIG: ark_fpv_default
-    ark_mag_canbootloader:
-      short: ark_mag_canbootloader
-      buildType: MiniSizeRel
-      settings:
-        CONFIG: ark_mag_canbootloader
-    ark_mag_default:
-      short: ark_mag_default
-      buildType: MiniSizeRel
-      settings:
-        CONFIG: ark_mag_default
    ark_pi6x_bootloader:
      short: ark_pi6x_bootloader
      buildType: MinSizeRel
@@ -261,16 +231,6 @@ CONFIG:
      buildType: MinSizeRel
      settings:
        CONFIG: ark_pi6x_default
-    ark_x20-gps_default:
-      short: ark_x20-gps_default
-      buildType: MinSizeRel
-      settings:
-        CONFIG: ark_x20-gps_default
-    ark_x20-gps_canbootloader:
-      short: ark_x20-gps_canbootloader
-      buildType: MinSizeRel
-      settings:
-        CONFIG: ark_x20-gps_canbootloader
    atl_mantis-edu_default:
      short: atl_mantis-edu
      buildType: MinSizeRel
@@ -421,16 +381,6 @@ CONFIG:
      buildType: MinSizeRel
      settings:
        CONFIG: micoair_h743-v2_default
-    micoair_h743-lite_bootloader:
-      short: micoair_h743-lite_bootloader
-      buildType: MinSizeRel
-      settings:
-        CONFIG: micoair_h743-lite_bootloader
-    micoair_h743-lite_default:
-      short: micoair_h743-lite
-      buildType: MinSizeRel
-      settings:
-        CONFIG: micoair_h743-lite_default
    modalai_fc-v1_default:
      short: modalai_fc-v1
      buildType: MinSizeRel
@@ -481,16 +431,6 @@ CONFIG:
      buildType: MinSizeRel
      settings:
        CONFIG: nxp_mr-canhubk3_fmu
-    nxp_mr-tropic_default:
-      short: nxp_mr-tropic_default
-      buildType: MinSizeRel
-      settings:
-        CONFIG: nxp_mr-tropic_default
-    nxp_mr-tropic_bootloader:
-      short: nxp_mr-tropic_bootloader
-      buildType: MinSizeRel
-      settings:
-        CONFIG: nxp_mr-tropic_bootloader
    nxp_tropic-community_default:
      short: nxp_tropic-community_default
      buildType: MinSizeRel
@@ -521,23 +461,3 @@ CONFIG:
      buildType: MinSizeRel
      settings:
        CONFIG: x-mav_ap-h743v2_default
-    svehicle_e2_bootloader:
-      short: svehicle_e2_bootloader
-      buildType: MinSizeRel
-      settings:
-        CONFIG: svehicle_e2_bootloader
-    svehicle_e2_default:
-      short: svehicle_e2
-      buildType: MinSizeRel
-      settings:
-        CONFIG: svehicle_e2_default
-    x-mav_ap-h743r1_bootloader:
-      short: x-mav_ap-h743r1-boot
-      buildType: MinSizeRel
-      settings:
-        CONFIG: x-mav_ap-h743r1_bootloader
-    x-mav_ap-h743r1_default:
-      short: x-mav_ap-h743r1
-      buildType: MinSizeRel
-      settings:
-        CONFIG: x-mav_ap-h743r1_default
@@ -43,7 +43,7 @@
        "files.watcherExclude": {
                "**/build/**": true
        },
-        "git.detectSubmodulesLimit": 25,
+        "git.detectSubmodulesLimit": 20,
        "git.ignoreLimitWarning": true,
        "githubPullRequests.defaultMergeMethod": "squash",
        "githubPullRequests.telemetry.enabled": false,
@@ -220,6 +220,36 @@ pipeline {
          }
        }

+        stage('PX4 ROS msgs') {
+          agent {
+            docker { image 'px4io/px4-dev-base-focal:2021-08-18' }
+          }
+          steps {
+            sh('export')
+            sh('make distclean; git clean -ff -x -d .')
+            withCredentials([usernamePassword(credentialsId: 'px4buildbot_github_personal_token', passwordVariable: 'GIT_PASS', usernameVariable: 'GIT_USER')]) {
+              sh("git clone https://${GIT_USER}:${GIT_PASS}@github.com/PX4/px4_msgs.git")
+              // 'main' branch
+              sh('rm -f px4_msgs/msg/*.msg')
+              sh('rm -f px4_msgs/msg/versioned/*.msg')
+              sh('rm -f px4_msgs/srv/*.srv')
+              sh('rm -f px4_msgs/srv/versioned/*.srv')
+              sh('cp msg/*.msg px4_msgs/msg/')
+              sh('cp msg/versioned/*.msg px4_msgs/msg/ || true')
+              sh('cp srv/*.srv px4_msgs/srv/')
+              sh('cp srv/versioned/*.srv px4_msgs/srv/ || true')
+              sh('cd px4_msgs; git status; git add .; git commit -a -m "Update message definitions `date`" || true')
+              sh('cd px4_msgs; git push origin main || true')
+              sh('rm -rf px4_msgs')
+            }
+          }
+          when {
+            anyOf {
+              branch 'main'
+            }
+          }
+        }
+
        stage('S3') {
          agent {
            docker { image 'px4io/px4-dev-base-focal:2021-08-18' }
@@ -73,11 +73,6 @@ menu "Toolchain"
        help
            relative path to the ROMFS root directory

-    config BOARD_ADDITIONAL_INIT
-        string "Additional init file"
-        help
-            additional configurable init file to include in the ROMFS
-
    config BOARD_IO
        string "IO board name"
        default "px4_io-v2_default"
@@ -1,6 +1,6 @@
 BSD 3-Clause License

-Copyright (c) 2012 - 2025, PX4 Development Team
+Copyright (c) 2012 - 2023, PX4 Development Team
 All rights reserved.

 Redistribution and use in source and binary forms, with or without
@@ -19,7 +19,7 @@ See [the documentation on Maintainers](https://docs.px4.io/main/en/contribute/ma
 | Matthias Grob | Multirotor | [@MaEtUgR](https://github.com/MaEtUgR) | maetugr |
 | Silvan Fuhrer | Fixed-Wing / VTOL | [@sfuhrer](https://github.com/sfuhrer) | sfuhrer |
 | Christian Friedrich | Rover | [@chfriedrich98](https://github.com/chfriedrich98) | christian982564 |
-| Pedro Roque | Spacecraft | [@Pedro-Roque](https://github.com/Pedro-Roque) | .pedroroque | <roque@caltech.edu>
+| Pedro Roque | Spacecraft | [@Pedro-Roque](https://github.com/Pedro-Roque) | .pedroroque | <padr@kth.se>
 | Jacob Dahl | Simulation | [@dakejahl](https://github.com/dakejahl) | dakejahl | <dahl.jakejacob@gmail.com>


@@ -325,8 +325,6 @@ bootloaders_update: \
 	ark_fmu-v6x_bootloader \
 	ark_fpv_bootloader \
 	ark_pi6x_bootloader \
-	auterion_fmu-v6s_bootloader \
-	auterion_fmu-v6x_bootloader \
 	cuav_nora_bootloader \
 	cuav_x7pro_bootloader \
 	cuav_7-nano_bootloader \
@@ -346,7 +344,6 @@ bootloaders_update: \
        micoair_h743_bootloader \
        micoair_h743-aio_bootloader \
 	micoair_h743-v2_bootloader \
-	micoair_h743-lite_bootloader \
 	modalai_fc-v2_bootloader \
 	mro_ctrl-zero-classic_bootloader \
 	mro_ctrl-zero-h7_bootloader \
@@ -514,7 +511,6 @@ validate_module_configs:
 	@find "$(SRC_DIR)"/src/modules "$(SRC_DIR)"/src/drivers "$(SRC_DIR)"/src/lib -name *.yaml -type f \
 	-not -path "$(SRC_DIR)/src/lib/mixer_module/*" \
 	-not -path "$(SRC_DIR)/src/modules/uxrce_dds_client/dds_topics.yaml" \
-	-not -path "$(SRC_DIR)/src/modules/zenoh/dds_topics.yaml" \
 	-not -path "$(SRC_DIR)/src/modules/zenoh/zenoh-pico/*" \
 	-not -path "$(SRC_DIR)/src/lib/events/libevents/*" \
 	-not -path "$(SRC_DIR)/src/lib/cdrstream/*" \
@@ -85,32 +85,10 @@ endif()
 if(PX4_ETHERNET)
 	set(added_arguments ${added_arguments} --ethernet)
 endif()
-# Check if board has an rc.board_airframes file to filter airframes
-set(board_airframes_file "${PX4_BOARD_DIR}/init/rc.board_airframes")
-set(airframes_whitelist "")
-if(EXISTS "${board_airframes_file}")
-	message(STATUS "ROMFS: Using board-specific airframes list: ${board_airframes_file}")
-	file(STRINGS "${board_airframes_file}" airframes_whitelist)
-	# Remove comments and empty lines
-	list(FILTER airframes_whitelist EXCLUDE REGEX "^[ \t]*#")
-	list(FILTER airframes_whitelist EXCLUDE REGEX "^[ \t]*$")
-endif()
-
 # create list of relative romfs file names
 set(romfs_copy_files_relative)
 foreach(romfs_file IN LISTS romfs_copy_files)
 	string(REPLACE "${romfs_src_dir}/" "" romfs_file_rel ${romfs_file})
-
-	# If we have an airframes whitelist, filter airframe files
-	if(airframes_whitelist AND romfs_file_rel MATCHES "^init.d/airframes/")
-		# Extract just the filename
-		get_filename_component(airframe_name "${romfs_file_rel}" NAME)
-		# Check if it's in the whitelist
-		if(NOT "${airframe_name}" IN_LIST airframes_whitelist)
-			continue()
-		endif()
-	endif()
-
 	list(APPEND romfs_copy_files_relative ${romfs_file_rel})
 endforeach()
 # copy the ROMFS files by creating a tar and extracting it to the build
@@ -224,43 +202,18 @@ foreach(board_rc_file ${OPTIONAL_BOARD_RC})

 endforeach()

-if(config_additional_init)
-	if(EXISTS "${PX4_BOARD_DIR}/init/${config_additional_init}")
-		file(RELATIVE_PATH rc_file_relative ${PX4_SOURCE_DIR} ${PX4_BOARD_DIR}/init/${config_additional_init})
-		message(STATUS "ROMFS:  Adding ${rc_file_relative} -> /etc/init.d/rc.additional_init")
-
-		add_custom_command(
-			OUTPUT
-				${romfs_gen_root_dir}/init.d/rc.additional_init
-				${config_additional_init}.stamp
-			COMMAND ${CMAKE_COMMAND} -E copy_if_different ${PX4_BOARD_DIR}/init/${config_additional_init} ${romfs_gen_root_dir}/init.d/rc.additional_init
-			COMMAND ${CMAKE_COMMAND} -E touch ${config_additional_init}.stamp
-			DEPENDS
-				${PX4_BOARD_DIR}/init/${config_additional_init}
-				romfs_copy.stamp
-			COMMENT "ROMFS: copying ${config_additional_init}"
-		)
-
-		list(APPEND extras_dependencies
-			${config_additional_init}.stamp
-			)
-	else()
-		message(FATAL_ERROR "BOARD_ADDITIONAL_INIT file not found at: ${PX4_BOARD_DIR}/init/${config_additional_init}")
-	endif()
-endif()
-

 # board extras
 set(OPTIONAL_BOARD_EXTRAS)
 file(GLOB OPTIONAL_BOARD_EXTRAS ${PX4_BOARD_DIR}/extras/*)

 # bootloader (optional)
-#  - if systemcmds/bl_update included and board bootloader available then generate rc.board_bootloader_upgrade and copy bootloader binary
+#  - if systemcmds/bl_update included (with romfs copy) and board bootloader available then generate rc.board_bootloader_upgrade and copy bootloader binary
 #  - otherwise remove bootloader binary from extras in final ROMFS
 foreach(board_extra_file ${OPTIONAL_BOARD_EXTRAS})
 	file(RELATIVE_PATH extra_file_base_name ${PX4_BOARD_DIR}/extras/ ${board_extra_file})
 	if(${extra_file_base_name} MATCHES "${PX4_BOARD_VENDOR}_${PX4_BOARD_MODEL}_bootloader.bin")
-		if(CONFIG_SYSTEMCMDS_BL_UPDATE)
+		if(CONFIG_SYSTEMCMDS_BL_UPDATE AND CONFIG_BL_UPDATE_BL_ROMFS)
 			# generate rc.board_bootloader_upgrade
 			set(BOARD_FIRMWARE_BIN "${PX4_BOARD_VENDOR}_${PX4_BOARD_MODEL}_bootloader.bin")
 			message(STATUS "ROMFS:  Adding platforms/nuttx/init/rc.board_bootloader_upgrade -> /etc/init.d/rc.board_bootloader_upgrade")
@@ -56,17 +56,6 @@ then
 fi
 unset BOARD_RC_DEFAULTS

-#
-# Optional additional init file: rc.additional_init
-#
-set BOARD_RC_ADDITIONAL_INIT ${R}etc/init.d/rc.additional_init
-if [ -f $BOARD_RC_ADDITIONAL_INIT ]
-then
-	echo "Board additional init: ${BOARD_RC_ADDITIONAL_INIT}"
-	. $BOARD_RC_ADDITIONAL_INIT
-fi
-unset BOARD_RC_ADDITIONAL_INIT
-
 #
 # Start system state indicator.
 #
@@ -27,6 +27,7 @@ param set-default SIH_KDV 0.2
 param set-default SIH_VEHICLE_TYPE 1 	# sih as fixed wing
 param set-default RWTO_TKOFF 1  # enable takeoff from runway (as opposed to launched)

+param set-default CA_AIRFRAME 1
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3

@@ -44,6 +44,8 @@ param set-default NAV_DLL_ACT 2

 param set-default RWTO_TKOFF 1

+param set-default CA_AIRFRAME 1
+
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3

@@ -46,6 +46,8 @@ param set-default NAV_DLL_ACT 2

 param set-default RWTO_TKOFF 1

+param set-default CA_AIRFRAME 1
+
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3

@@ -46,6 +46,8 @@ param set-default MIS_TAKEOFF_ALT 30
 param set-default NAV_ACC_RAD 15
 param set-default NAV_DLL_ACT 2

+param set-default CA_AIRFRAME 1
+
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3

@@ -31,6 +31,8 @@ param set-default NAV_DLL_ACT 2
 param set-default RWTO_TKOFF 1
 param set-default RWTO_PSP 8

+param set-default CA_AIRFRAME 1
+
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3

@@ -31,6 +31,8 @@ param set-default NAV_DLL_ACT 2
 param set-default RWTO_TKOFF 1
 param set-default RWTO_PSP 8

+param set-default CA_AIRFRAME 1
+
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3

@@ -30,6 +30,8 @@ param set-default NAV_DLL_ACT 2

 param set-default RWTO_TKOFF 1

+param set-default CA_AIRFRAME 1
+
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3

@@ -31,6 +31,8 @@ param set-default NAV_DLL_ACT 2
 param set-default RWTO_TKOFF 1
 param set-default RWTO_PSP 8

+param set-default CA_AIRFRAME 1
+
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3

@@ -38,6 +38,8 @@ param set-default NAV_DLL_ACT 2

 param set-default RWTO_TKOFF 1

+param set-default CA_AIRFRAME 1
+
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3

@@ -44,6 +44,8 @@ param set-default MIS_TAKEOFF_ALT 30
 param set-default NAV_ACC_RAD 15
 param set-default NAV_DLL_ACT 2

+param set-default CA_AIRFRAME 1
+
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3

@@ -35,6 +35,8 @@ param set-default RWTO_MAX_PITCH 20
 param set-default RWTO_PSP 8
 param set-default RWTO_AIRSPD_SCL 1.8

+param set-default CA_AIRFRAME 1
+
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3

@@ -35,6 +35,8 @@ param set-default NAV_DLL_ACT 2

 param set-default RWTO_TKOFF 1

+param set-default CA_AIRFRAME 1
+
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3

@@ -46,6 +46,8 @@ param set-default NAV_DLL_ACT 2

 param set-default RWTO_TKOFF 1

+param set-default CA_AIRFRAME 1
+
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3

@@ -43,6 +43,8 @@ param set-default FW_THR_TRIM 0.8
 param set-default FW_THR_IDLE 0
 param set-default COM_DISARM_PRFLT 0

+param set-default CA_AIRFRAME 1
+
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3

@@ -48,6 +48,8 @@ param set-default FW_THR_TRIM 0.8
 param set-default FW_THR_IDLE 0
 param set-default COM_DISARM_PRFLT 0

+param set-default CA_AIRFRAME 1
+
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3

@@ -53,6 +53,8 @@ param set-default NAV_DLL_ACT 2

 param set-default RWTO_TKOFF 1

+param set-default CA_AIRFRAME 1
+
 param set-default COM_PREARM_MODE 2

 param set-default CA_ROTOR_COUNT 1
@@ -11,6 +11,8 @@ PX4_SIM_MODEL=${PX4_SIM_MODEL:=advanced_plane}

 param set-default SIM_GZ_EN 1

+param set-default SENS_EN_ARSPDSIM 1
+
 param set-default FW_LND_ANG 8

 param set-default FW_PR_FF 0.08
@@ -46,6 +48,8 @@ param set-default NAV_DLL_ACT 2

 param set-default RWTO_TKOFF 1

+param set-default CA_AIRFRAME 1
+
 param set-default CA_ROTOR_COUNT 1

 param set-default CA_SV_CS_COUNT 6
@@ -1,5 +1,5 @@
 #!/bin/sh
-# @name Generic Ackermann Rover
+# @name Rover Ackermann
 # @type Rover
 # @class Rover

@@ -14,32 +14,30 @@ param set-default SIM_GZ_EN 1 # Gazebo bridge
 param set-default NAV_ACC_RAD 0.5

 # Ackermann Parameters
-param set-default RA_WHEEL_BASE 0.5
+param set-default RA_WHEEL_BASE 0.321
 param set-default RA_ACC_RAD_GAIN 2
-param set-default RA_ACC_RAD_MAX 1.5
+param set-default RA_ACC_RAD_MAX 3
 param set-default RA_MAX_STR_ANG 0.5236
 param set-default RA_STR_RATE_LIM 360

-# Rate Control Parameters
-param set-default RO_YAW_RATE_I 0.01
-param set-default RO_YAW_RATE_P 0.25
-param set-default RO_YAW_RATE_LIM 130
-param set-default RO_YAW_ACCEL_LIM 800
-param set-default RO_YAW_DECEL_LIM 800
-param set-default RO_YAW_RATE_CORR 1
-param set-default RO_YAW_EXPO 0.85
-param set-default RO_YAW_SUPEXPO 0.3
+# Rover Control Parameters
+param set-default RO_ACCEL_LIM 3
+param set-default RO_DECEL_LIM 6
+param set-default RO_JERK_LIM 15
+param set-default RO_MAX_THR_SPEED 3.1

-# Attitude Control Parameters
+# Rover Rate Control Parameters
+param set-default RO_YAW_RATE_I 0.1
+param set-default RO_YAW_RATE_P 1
+param set-default RO_YAW_RATE_LIM 180
+param set-default RO_YAW_RATE_CORR 1
+
+# Rover Attitude Control Parameters
 param set-default RO_YAW_P 3

-# Velocity Control Parameters
-param set-default RO_ACCEL_LIM 4
-param set-default RO_DECEL_LIM 6
-param set-default RO_JERK_LIM 10
-param set-default RO_MAX_THR_SPEED 3.1
-param set-default RO_SPEED_LIM 2.5
-param set-default RO_SPEED_I 0.01
+# Rover Velocity Control Parameters
+param set-default RO_SPEED_LIM 3
+param set-default RO_SPEED_I 0.1
 param set-default RO_SPEED_P 1
 param set-default RO_SPEED_RED 1

@@ -50,8 +48,8 @@ param set-default PP_LOOKAHD_MIN 1

 # Wheels
 param set-default SIM_GZ_WH_FUNC1 101
-param set-default SIM_GZ_WH_MIN1 70
-param set-default SIM_GZ_WH_MAX1 130
+param set-default SIM_GZ_WH_MIN1 0
+param set-default SIM_GZ_WH_MAX1 200
 param set-default SIM_GZ_WH_DIS1 100

 # Steering
@@ -1,5 +1,5 @@
 #!/bin/sh
-# @name Generic Mecanum Rover
+# @name Aion Robotics R1 Rover
 # @type Rover
 # @class Rover

@@ -7,15 +7,14 @@

 PX4_SIMULATOR=${PX4_SIMULATOR:=gz}
 PX4_GZ_WORLD=${PX4_GZ_WORLD:=rover}
-PX4_SIM_MODEL=${PX4_SIM_MODEL:=rover_mecanum}
+PX4_SIM_MODEL=${PX4_SIM_MODEL:=r1_rover_mecanum}

 param set-default SIM_GZ_EN 1 # Gazebo bridge

 param set-default NAV_ACC_RAD 0.5

 # Mecanum Parameters
-param set-default RM_WHEEL_TRACK 0.6
-param set-default RM_YAW_STK_GAIN 0.6
+param set-default RM_WHEEL_TRACK 0.3

 # Rover Control Parameters
 param set-default RO_ACCEL_LIM 3
@@ -30,21 +29,15 @@ param set-default RO_YAW_RATE_LIM 120
 param set-default RO_YAW_ACCEL_LIM 240
 param set-default RO_YAW_DECEL_LIM 1000
 param set-default RO_YAW_RATE_CORR 1.75
-param set-default RO_YAW_EXPO 0.85
-param set-default RO_YAW_SUPEXPO 0.3

 # Rover Attitude Control Parameters
 param set-default RO_YAW_P 5

-# Velocity Control Parameters
-param set-default RO_ACCEL_LIM 4
-param set-default RO_DECEL_LIM 6
-param set-default RO_JERK_LIM 10
-param set-default RO_MAX_THR_SPEED 3.1
-param set-default RO_SPEED_LIM 2.5
-param set-default RO_SPEED_I 0.01
-param set-default RO_SPEED_P 0.1
-param set-default RO_SPEED_RED 0.5
+# Rover Velocity Control Parameters
+param set-default RO_SPEED_LIM 2
+param set-default RO_SPEED_I 0.5
+param set-default RO_SPEED_P 1
+param set-default RO_SPEED_RED 1

 # Pure Pursuit parameters
 param set-default PP_LOOKAHD_GAIN 0.5
@@ -55,24 +48,24 @@ param set-default PP_LOOKAHD_MIN 1
 param set-default SENS_EN_MAGSIM 1

 # Actuator mapping
-param set-default SIM_GZ_WH_FUNC1 104 # left wheel back
+param set-default SIM_GZ_WH_FUNC1 102 # right wheel front
 param set-default SIM_GZ_WH_MIN1 70
 param set-default SIM_GZ_WH_MAX1 130
 param set-default SIM_GZ_WH_DIS1 100

-param set-default SIM_GZ_WH_FUNC2 103 # right wheel back
+param set-default SIM_GZ_WH_FUNC2 101 # left wheel front
 param set-default SIM_GZ_WH_MIN2 70
 param set-default SIM_GZ_WH_MAX2 130
 param set-default SIM_GZ_WH_DIS2 100

-param set-default SIM_GZ_WH_FUNC3 102 # left wheel front
+param set-default SIM_GZ_WH_FUNC3 104 # right wheel back
 param set-default SIM_GZ_WH_MIN3 70
 param set-default SIM_GZ_WH_MAX3 130
 param set-default SIM_GZ_WH_DIS3 100

-param set-default SIM_GZ_WH_FUNC4 101 # right wheel front
+param set-default SIM_GZ_WH_FUNC4 103 # left wheel back
 param set-default SIM_GZ_WH_MIN4 70
 param set-default SIM_GZ_WH_MAX4 130
 param set-default SIM_GZ_WH_DIS4 100

-param set-default SIM_GZ_WH_REV 0
+param set-default SIM_GZ_WH_REV 10
@@ -17,7 +17,6 @@ param set-default NAV_ACC_RAD 0.5
 param set-default RD_WHEEL_TRACK 0.6
 param set-default RD_TRANS_DRV_TRN 0.785398
 param set-default RD_TRANS_TRN_DRV 0.174533
-param set-default RD_YAW_STK_GAIN 0.6

 # Rate Control Parameters
 param set-default RO_YAW_RATE_I 0.01
@@ -26,8 +25,6 @@ param set-default RO_YAW_RATE_LIM 250
 param set-default RO_YAW_ACCEL_LIM 400
 param set-default RO_YAW_DECEL_LIM 800
 param set-default RO_YAW_RATE_CORR 1
-param set-default RO_YAW_EXPO 0.85
-param set-default RO_YAW_SUPEXPO 0.3

 # Attitude Control Parameters
 param set-default RO_YAW_P 5
@@ -34,6 +34,7 @@ param set-default COM_LOW_BAT_ACT 0
 param set-default NAV_DLL_ACT 0
 param set-default GF_ACTION 1
 param set-default NAV_RCL_ACT 1
+param set-default COM_POSCTL_NAVL 2

 # disable attitude failure detection
 param set-default FD_FAIL_P 0
@@ -26,6 +26,7 @@ param set-default TRIG_INTERFACE 3
 param set-default TRIG_MODE 4
 param set-default MNT_MODE_IN 4
 param set-default MNT_MODE_OUT 2
+param set-default MAV_PROTO_VER 2

 param set-default CA_AIRFRAME 0
 param set-default CA_ROTOR_COUNT 6
@@ -1,21 +1,10 @@
 #!/bin/sh
 #
-# @name KTH-ATMOS
+# @name 3DoF Spacecraft Model
 #
-# @type Free-Flyer
-# @class Spacecraft
+# @type 2D Freeflyer with 8 thrusters - Planar motion
 #
-# @output Motor1 back left thruster, +x thrust
-# @output Motor2 front left thruster, -x thrust
-# @output Motor3 back right thruster, +x thrust
-# @output Motor4 front right thruster, -x thrust
-# @output Motor5 front left thruster, +y thrust
-# @output Motor6 front right thruster, -y thrust
-# @output Motor7 back left thruster, +y thrust
-# @output Motor8 back right thruster, -y thrust
-#
-# @maintainer discower-io
-# @url https://atmos.discower.io
+# @maintainer Pedro Roque <padr@kth.se>
 #

 . ${R}etc/init.d/rc.sc_defaults
@@ -45,6 +34,7 @@ param set-default COM_LOW_BAT_ACT 0
 param set-default NAV_DLL_ACT 0
 param set-default GF_ACTION 1
 param set-default NAV_RCL_ACT 1
+param set-default COM_POSCTL_NAVL 2

 # disable attitude failure detection
 param set-default FD_FAIL_P 0
@@ -80,8 +80,10 @@ px4_add_romfs_files(
 	4009_gz_r1_rover
 	4010_gz_x500_mono_cam
 	4011_gz_lawnmower
+	4012_gz_rover_ackermann
 	4013_gz_x500_lidar_2d
 	4014_gz_x500_mono_cam_down
+	4015_gz_r1_rover_mecanum
 	4016_gz_x500_lidar_down
 	4017_gz_x500_lidar_front
 	4018_gz_quadtailsitter
@@ -112,8 +114,6 @@ px4_add_romfs_files(
 	17002_flightgear_tf-g2

 	50000_gz_rover_differential
-	51000_gz_rover_ackermann
-	52000_gz_rover_mecanum

 	60002_gz_uuv_bluerov2_heavy

@@ -159,19 +159,24 @@ if [ -n "${PX4_SIM_MODEL#*gz_}" ] && [ -z "${PX4_GZ_MODEL_NAME}" ]; then
 	fi

 	# Set up camera to follow the model if requested
-	if [ -z "${PX4_GZ_NO_FOLLOW}" ]; then
+	if [ -n "${PX4_GZ_FOLLOW}" ]; then

 		echo "INFO  [init] Setting camera to follow ${MODEL_NAME_INSTANCE}"

+		# Set camera to follow the model
+		${gz_command} service -s "/gui/follow" --reqtype gz.msgs.StringMsg \
+				--reptype gz.msgs.Boolean --timeout 5000 \
+				--req "data: \"${MODEL_NAME_INSTANCE}\"" > /dev/null 2>&1
+
 		# Set default camera offset if not specified
 		follow_x=${PX4_GZ_FOLLOW_OFFSET_X:--2.0}
 		follow_y=${PX4_GZ_FOLLOW_OFFSET_Y:--2.0}
 		follow_z=${PX4_GZ_FOLLOW_OFFSET_Z:-2.0}

 		# Set camera offset
-		${gz_command} topic -t /gui/track -m gz.msgs.CameraTrack \
-				-p "track_mode: FOLLOW, follow_target: {name: '${MODEL_NAME_INSTANCE}'},\
-				 follow_offset: {x: ${follow_x}, y: ${follow_y}, z: ${follow_z}}, follow_pgain: 1.0, track_pgain: 1.0"
+		${gz_command} service -s "/gui/follow/offset" --reqtype gz.msgs.Vector3d \
+				--reptype gz.msgs.Boolean --timeout 5000 \
+				--req "x: ${follow_x}, y: ${follow_y}, z: ${follow_z}" > /dev/null 2>&1

 		echo "INFO  [init] Camera follow offset set to ${follow_x}, ${follow_y}, ${follow_z}"
 	fi
@@ -173,6 +173,7 @@ param set-default COM_RC_IN_MODE 1
 param set-default EKF2_REQ_GPS_H 0.5

 param set-default IMU_GYRO_FFT_EN 1
+param set-default MAV_PROTO_VER 2 # Ensures QGC does not drop the first few packets after a SITL restart due to MAVLINK 1 packets

 param set-default -s MC_AT_EN 1

@@ -323,11 +324,6 @@ fi

 uxrce_dds_client start -t udp -p $uxrce_dds_port $uxrce_dds_ns

-if param greater -s ZENOH_ENABLE 0
-then
-	zenoh start
-fi
-
 if param greater -s MNT_MODE_IN -1
 then
 	gimbal start
@@ -14,6 +14,7 @@

 param set UAVCAN_ENABLE 0

+param set-default CA_AIRFRAME 1
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3

@@ -40,6 +40,8 @@ param set-default FW_P_LIM_MAX 25
 param set-default FW_P_LIM_MIN -5
 param set-default FW_P_RMAX_NEG 20

+param set-default CA_AIRFRAME 1
+
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3

@@ -37,6 +37,8 @@ param set-default FW_P_LIM_MAX 25
 param set-default FW_P_LIM_MIN -5
 param set-default FW_P_RMAX_NEG 20

+param set-default CA_AIRFRAME 1
+
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3

@@ -10,6 +10,7 @@

 . ${R}etc/init.d/rc.fw_defaults

+param set-default CA_AIRFRAME 1
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.3
 param set-default CA_SV_CS_COUNT 4
@@ -32,6 +32,7 @@ param set-default FW_WR_IMAX 0.8
 param set-default FW_WR_P 1
 param set-default FW_W_RMAX 0

+param set-default CA_AIRFRAME 1
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_SV_CS_COUNT 7
 param set-default CA_SV_CS0_TRQ_R -0.5
@@ -10,6 +10,8 @@

 . ${R}etc/init.d/rc.fw_defaults

+param set-default CA_AIRFRAME 1
+
 param set-default CA_ROTOR_COUNT 1
 param set-default CA_ROTOR0_PX 0.15
 param set-default CA_SV_CS_COUNT 2
@@ -7,10 +7,6 @@
 #
 # @board px4_fmu-v2 exclude
 # @board px4_fmu-v5x exclude
-# @board auterion_fmu-v6s exclude
-# @board ark_fmu-v6x exclude
-# @board auterion_fmu-v6x exclude
-# @board px4_fmu-v6x exclude
 # @board bitcraze_crazyflie exclude
 #
 # @maintainer Iain Galloway <iain.galloway@nxp.com>
@@ -7,7 +7,6 @@
 #
 # @board px4_fmu-v2 exclude
 # @board bitcraze_crazyflie exclude
-# @board auterion_fmu-v6x exclude
 # @board px4_fmu-v6x exclude
 #

@@ -13,11 +13,6 @@
 # @board px4_fmu-v4pro exclude
 # @board px4_fmu-v5 exclude
 # @board px4_fmu-v5x exclude
-# @board auterion_fmu-v6s exclude
-# @board ark_fmu-v6x exclude
-# @board auterion_fmu-v6x exclude
-# @board px4_fmu-v6x exclude
-# @board px4_fmu-v6xrt exclude
 # @board bitcraze_crazyflie exclude
 #

@@ -10,7 +10,6 @@
 # @board cuav_x7pro exclude
 # @board px4_fmu-v4pro exclude
 # @board px4_fmu-v5x exclude
-# @board auterion_fmu-v6x exclude
 # @board px4_fmu-v6x exclude
 #

@@ -12,7 +12,6 @@
 # @board px4_fmu-v4pro exclude
 # @board px4_fmu-v5 exclude
 # @board px4_fmu-v5x exclude
-# @board auterion_fmu-v6x exclude
 # @board px4_fmu-v6x exclude
 # @board bitcraze_crazyflie exclude
 # @board cuav_x7pro exclude
@@ -10,7 +10,6 @@
 # @board px4_fmu-v4pro exclude
 # @board px4_fmu-v5 exclude
 # @board px4_fmu-v5x exclude
-# @board auterion_fmu-v6x exclude
 # @board px4_fmu-v6x exclude
 # @board bitcraze_crazyflie exclude
 # @board cuav_x7pro exclude
@@ -14,7 +14,6 @@
 # @board px4_fmu-v4pro exclude
 # @board px4_fmu-v5 exclude
 # @board px4_fmu-v5x exclude
-# @board auterion_fmu-v6x exclude
 # @board px4_fmu-v6x exclude
 # @board bitcraze_crazyflie exclude
 # @board diatone_mamba-f405-mk2 exclude
@@ -13,7 +13,6 @@
 # @board px4_fmu-v4pro exclude
 # @board px4_fmu-v5 exclude
 # @board px4_fmu-v5x exclude
-# @board auterion_fmu-v6x exclude
 # @board px4_fmu-v6x exclude
 # @board diatone_mamba-f405-mk2 exclude
 #
@@ -1,31 +0,0 @@
-#!/bin/sh
-#
-# @name NXP B3RB Rover Ackermann
-#
-# @type Rover
-# @class Rover
-#
-# @board px4_fmu-v2 exclude
-# @board bitcraze_crazyflie exclude
-#
-
-. ${R}etc/init.d/rc.rover_ackermann_defaults
-
-param set-default BAT1_N_CELLS 3
-
-# Set geometry & output configration
-param set-default PWM_MAIN_FUNC1 201
-param set-default PWM_MAIN_FUNC2 101
-param set-default PWM_MAIN_FUNC3 101
-param set-default PWM_MAIN_DIS1 1500
-param set-default PWM_MAIN_DIS2 0
-param set-default PWM_MAIN_DIS3 1500
-param set-default PWM_MAIN_MIN1 1000
-param set-default PWM_MAIN_MIN2 2500
-param set-default PWM_MAIN_MIN3 0
-param set-default PWM_MAIN_MAX1 2000
-param set-default PWM_MAIN_MAX2 2500
-param set-default PWM_MAIN_MAX3 50
-param set-default PWM_MAIN_TIM0 400
-param set-default PWM_MAIN_TIM1 400
-param set-default PWM_MAIN_TIM2 20000
@@ -45,6 +45,7 @@ param set-default COM_LOW_BAT_ACT 0
 param set-default NAV_DLL_ACT 0
 param set-default GF_ACTION 1
 param set-default NAV_RCL_ACT 1
+param set-default COM_POSCTL_NAVL 2

 # disable attitude failure detection
 param set-default FD_FAIL_P 0
@@ -5,17 +5,7 @@
 # @type Free-Flyer
 # @class Spacecraft
 #
-# @output Motor1 back left thruster, +x thrust
-# @output Motor2 front left thruster, -x thrust
-# @output Motor3 back right thruster, +x thrust
-# @output Motor4 front right thruster, -x thrust
-# @output Motor5 front left thruster, +y thrust
-# @output Motor6 front right thruster, -y thrust
-# @output Motor7 back left thruster, +y thrust
-# @output Motor8 back right thruster, -y thrust
-#
 # @maintainer DISCOWER
-# @url https://atmos.discower.io
 #

 . ${R}etc/init.d/rc.sc_defaults
@@ -35,6 +25,7 @@ param set-default COM_LOW_BAT_ACT 0
 param set-default NAV_DLL_ACT 0
 param set-default GF_ACTION 1
 param set-default NAV_RCL_ACT 1
+param set-default COM_POSCTL_NAVL 2

 # Set Mocap Vision frame
 param set EKF2_EV_CTRL 15
@@ -153,7 +153,6 @@ if(CONFIG_MODULES_ROVER_ACKERMANN)
 		# [51000, 51999] Ackermann rovers
 		51000_generic_rover_ackermann
 		51001_axial_scx10_2_trail_honcho
-		51002_nxp_b3rb
 	)
 endif()

@@ -10,8 +10,6 @@ set VEHICLE_TYPE fw
 # MAV_TYPE_FIXED_WING 1
 param set-default MAV_TYPE 1

-param set-default CA_AIRFRAME 1
-
 #
 # Default parameters for fixed wing UAVs.
 #
@@ -28,7 +26,6 @@ param set-default EKF2_MAG_ACCLIM 0
 param set-default EKF2_REQ_EPH 10
 param set-default EKF2_REQ_EPV 10
 param set-default EKF2_REQ_HDRIFT 0.5
-param set-default EKF2_REQ_PDOP 4
 param set-default EKF2_REQ_SACC 1
 param set-default EKF2_REQ_VDRIFT 1
 param set-default EKF2_RNG_QLTY_T 3
@@ -8,9 +8,6 @@
 #                 End Setup for board specific configurations.                #
 ###############################################################################

-#
-# Set SD logging mode
-#
 if param compare SDLOG_MODE 1
 then
 	set LOGGER_ARGS "${LOGGER_ARGS} -e"
@@ -31,28 +28,8 @@ then
 	set LOGGER_ARGS "${LOGGER_ARGS} -a"
 fi

-#
-# Set logging backend
-#
-if param compare SDLOG_BACKEND 1
-then
-	set LOGGER_ARGS "${LOGGER_ARGS} -m file"
-fi

-if param compare SDLOG_BACKEND 2
-then
-	set LOGGER_ARGS "${LOGGER_ARGS} -m mavlink"
-fi
-
-if param compare SDLOG_BACKEND 3
-then
-	set LOGGER_ARGS "${LOGGER_ARGS} -m all"
-fi
-
-#
-# Start logger if any logging backend is enabled
-#
-if ! param compare SDLOG_BACKEND 0
+if ! param compare SDLOG_MODE -1
 then
 	logger start -b ${LOGGER_BUF} -t ${LOGGER_ARGS}
 fi
@@ -154,12 +154,6 @@ then
 	fi
 fi

-# Microchip MCP9808 temperature sensor external I2C
-if param compare -s SENS_EN_MCP9808 1
-then
-	mcp9808 start -X
-fi
-
 # TE MS4515 differential pressure sensor external I2C
 if param compare -s SENS_EN_MS4515 1
 then
@@ -225,18 +219,6 @@ then
 	pcf8583 start -X -a 0x51
 fi

-# ADC sensor ADS7953 external SPI
-if param compare -s ADC_ADS7953_EN 1
-then
-	ads7953 start -S
-fi
-
-# ADC sensor tla2528 external I2C
-if param compare -s ADC_TLA2528_EN 1
-then
-	tla2528 start -X
-fi
-
 # probe for optional external I2C devices
 if param compare SENS_EXT_I2C_PRB 1
 then
@@ -255,7 +237,6 @@ then
 	qmc5883p -X -q start
 	rm3100 -X -q start
 	bmm350 -X -q start
-	iis2mdc -X -q start

 	# start last (wait for possible icm20948 passthrough mode)
 	ak09916 -X -q start
@@ -217,37 +217,30 @@ else
 	fi
 	unset BOARD_RC_DEFAULTS

-	#
-	# Optional additional init file: rc.additional_init
-	#
-	set BOARD_RC_ADDITIONAL_INIT ${R}etc/init.d/rc.additional_init
-	if [ -f $BOARD_RC_ADDITIONAL_INIT ]
+	# Load airframe configuration based on SYS_AUTOSTART parameter
+	if ! param compare SYS_AUTOSTART 0
 	then
-		echo "Board additional init: ${BOARD_RC_ADDITIONAL_INIT}"
-		. $BOARD_RC_ADDITIONAL_INIT
-	fi
-	unset BOARD_RC_ADDITIONAL_INIT
+		# rc.autostart directly run the right airframe script which sets the VEHICLE_TYPE
+		# Look for airframe in ROMFS
+		. ${R}etc/init.d/rc.autostart

-	# Load airframe configuration based on SYS_AUTOSTART parameter if successful VEHICLE_TYPE gets set
-	# Run autogenerated ROMFS airframe script
-	. ${R}etc/init.d/rc.autostart
-
-	if [ ${VEHICLE_TYPE} = none ]
-	then
-		# Run external airframe script on SD card
-		if [ $STORAGE_AVAILABLE = yes ]
+		if [ ${VEHICLE_TYPE} = none ]
 		then
-			. ${R}etc/init.d/rc.autostart_ext
-		else
-			echo "ERROR [init] SD not mounted, skipping external airframe"
+			# Use external startup file
+			if [ $STORAGE_AVAILABLE = yes ]
+			then
+				. ${R}etc/init.d/rc.autostart_ext
+			else
+				echo "ERROR [init] SD card not mounted - can't load external airframe"
+			fi
 		fi
-	fi

-	if [ ${VEHICLE_TYPE} = none ]
-	then
-		echo "ERROR [init] No airframe file found for SYS_AUTOSTART value"
-		param set SYS_AUTOSTART 0
-		tune_control play error
+		if [ ${VEHICLE_TYPE} = none ]
+		then
+			echo "ERROR [init] No airframe file found for SYS_AUTOSTART value"
+			param set SYS_AUTOSTART 0
+			tune_control play error
+		fi
 	fi

 	# Check parameter version and reset upon airframe configuration version mismatch.
@@ -620,7 +613,9 @@ else
 		. ${R}etc/init.d/rc.autostart.post
 	fi

-
+	#
+	# Bootloader upgrade (ROMFS)
+	#
 	set BOARD_BOOTLOADER_UPGRADE ${R}etc/init.d/rc.board_bootloader_upgrade
 	if [ -f $BOARD_BOOTLOADER_UPGRADE ]
 	then
@@ -628,6 +623,22 @@ else
 	fi
 	unset BOARD_BOOTLOADER_UPGRADE

+	#
+	# Bootloader upgrade (SD card)
+	#
+	if param compare -s SYS_BL_UPDATE 2
+	then
+		if [ -f "/fs/microsd/bl/bl.bin" ]
+		then
+			param set SYS_BL_UPDATE 0
+			param save
+			echo "bootloader update..."
+			bl_update "/fs/microsd/bl/bl.bin"
+			echo "bootloader update done, rebooting"
+			reboot
+		fi
+	fi
+
 	#
 	# Check if UAVCAN is enabled, default to it for ESCs.
 	#
@@ -15,4 +15,4 @@ ignore-exclude-errors-x
 lineend=linux
 exclude=EASTL
 add-brackets
-max-code-length=140
+max-code-length=120
@@ -39,5 +39,4 @@ exec find boards msg src platforms test \
    -path boards/modalai/voxl2/libfc-sensor-api -prune -o \
    -path src/drivers/actuators/vertiq_io/iq-module-communication-cpp -prune -o \
    -path src/lib/tensorflow_lite_micro/tflite_micro -prune -o \
-    -path src/drivers/ins/sbgecom/sbgECom -prune -o \
    \( -type f \( -name "*.c" -o -name "*.h" -o -name "*.cpp" -o -name "*.hpp" \) -print \) | grep $PATTERN
@@ -7,7 +7,6 @@ fi

 ssh_port=22
 ssh_user=root
-ssh_opts="-o UserKnownHostsFile=/dev/null -o StrictHostKeyChecking=no"

 while getopts ":f:c:d:p:u:r" opt; do
 	case ${opt} in
@@ -68,7 +67,7 @@ target_file_name="update-dev.tar"
 if [ "$revert" == true ]; then
 	# revert to the release version which was originally deployed
 	cmd="cp $target_dir/update.tar $target_dir/$target_file_name"
-	ssh $ssh_opts -t -p $ssh_port $ssh_user@$device "$cmd"
+	ssh -t -p $ssh_port $ssh_user@$device "$cmd"
 else
 	# create custom update-dev.tar
 	tmp_dir="$(mktemp -d)"
@@ -106,11 +105,11 @@ else
 	$tar_name -C "$tmp_dir" --sort=name --owner=root:0 --group=root:0 --mtime='2019-01-01 00:00:00' -cvf $target_file_name $firmware_path $config_path

 	# send it to the target to start flashing
-	scp $ssh_opts -P $ssh_port "$target_file_name" $ssh_user@"$device":$target_dir
+	scp -P $ssh_port "$target_file_name" $ssh_user@"$device":$target_dir
 	popd &>/dev/null
 	rm -rf "$tmp_dir"
 fi

 # grab status output for flashing progress
 cmd="tail --follow=name $target_dir/update_status 2>/dev/null || true"
-ssh $ssh_opts -t -p $ssh_port $ssh_user@$device "$cmd"
+ssh -t -p $ssh_port $ssh_user@$device "$cmd"
@@ -25,15 +25,15 @@ parser.add_argument('-p', '--pretty', dest='pretty', action='store_true',
                    help='Pretty output instead of a single line')
 parser.add_argument('-g', '--groups', dest='group', action='store_true',
                    help='Groups targets')
-parser.add_argument('-f', '--filter', dest='filter', help='comma separated list of build target name prefixes to include instead of all e.g. "px4_fmu-v5_"')
+parser.add_argument('-f', '--filter', dest='filter', help='comma separated list of board names to use instead of all')

 args = parser.parse_args()
 verbose = args.verbose

-target_filter = []
+board_filter = []
 if args.filter:
-    for target in args.filter.split(','):
-        target_filter.append(target)
+    for board in args.filter.split(','):
+        board_filter.append(board)

 default_container = 'ghcr.io/px4/px4-dev:v1.16.0-rc1-258-g0369abd556'
 build_configs = []
@@ -144,7 +144,7 @@ for manufacturer in os.scandir(os.path.join(source_dir, '../boards')):
                label = files.name[:-9]
                target_name = manufacturer.name + '_' + board.name + '_' + label

-                if target_filter and not any(target_name.startswith(f) for f in target_filter):
+                if board_filter and not board_name in board_filter:
                    if verbose: print(f'excluding board {board_name} ({target_name})')
                    continue

@@ -191,7 +191,7 @@ def main():
                        cur_history_index = len(command_history)
                    mav_serialport.write(cur_line+'\n')
                    cur_line = ''
-                elif ord(ch) == 8: # backspace
+                elif ord(ch) == 127: # backslash
                    if len(cur_line) > 0:
                        erase_last_n_chars(1)
                        cur_line = cur_line[:-1]
@@ -238,7 +238,6 @@ def get_actuator_output(yaml_config, output_functions, timer_config_file, verbos
            ( 'disarmed', 'Disarmed', 'DIS', False ),
            ( 'min', 'Minimum', 'MIN', False ),
            ( 'max', 'Maximum', 'MAX', False ),
-            ( 'center', 'Center\n(for Servos)', 'CENT', False ),
            ( 'failsafe', 'Failsafe', 'FAIL', True ),
            ]
        for key, label, param_suffix, advanced in standard_params_array:
@@ -284,9 +284,6 @@ Note that non-motor outputs might already be active in prearm state if COM_PREAR
 '''
        minimum_description = \
 '''Minimum output value (when not disarmed).
-'''
-        center_description = \
-'''Servo Center output value (when not disarmed).
 '''
        maximum_description = \
 '''Maxmimum output value (when not disarmed).
@@ -299,7 +296,6 @@ When set to -1 (default), the value depends on the function (see {:}).
        standard_params_array = [
            ( 'disarmed', 'Disarmed', 'DIS', disarmed_description ),
            ( 'min', 'Minimum', 'MIN', minimum_description ),
-            ( 'center', 'Center', 'CENT', center_description ),
            ( 'max', 'Maximum', 'MAX', maximum_description ),
            ( 'failsafe', 'Failsafe', 'FAIL', failsafe_description ),
            ]
@@ -316,10 +312,6 @@ When set to -1 (default), the value depends on the function (see {:}).
                    standard_params[key]['default'] = -1
                    standard_params[key]['min'] = -1

-                if key == 'center':
-                    standard_params[key]['default'] = -1
-                    standard_params[key]['min'] = -1
-
                param = {
                    'description': {
                        'short': channel_label+' ${i} '+label+' Value',
@@ -49,14 +49,14 @@ for field in spec.parsed_fields():
            (package, name) = genmsg.names.package_resource_name(field.base_type)
            package = package or spec.package # convert '' to package

-            print('typedef px4_msgs_msg_%s px4_msgs_msg_px4_msgs__msg__%s;' % (name,name))
+            print('typedef px4_msg_%s px4_msg_px4__msg__%s;' % (name,name))
 }@



-typedef struct @uorb_struct px4_msgs_msg_@(file_base_name);
+typedef struct @uorb_struct px4_msg_@(file_base_name);

-extern const struct dds_cdrstream_desc px4_msgs_msg_@(file_base_name)_cdrstream_desc;
+extern const struct dds_cdrstream_desc px4_msg_@(file_base_name)_cdrstream_desc;

 #ifdef __cplusplus
 }
@@ -1656,9 +1656,9 @@ sensor_baro_0['pressure'] = median_filter(sensor_baro_0['pressure'])
 # fit data
 median_pressure = np.median(sensor_baro_0['pressure'])
 if noResample:
-    coef_baro_0_x = np.polyfit(temp_rel,(sensor_baro_0['pressure']-median_pressure),5) # pressure in Pascal
+    coef_baro_0_x = np.polyfit(temp_rel,100*(sensor_baro_0['pressure']-median_pressure),5) # convert from hPa to Pa
 else:
-    temperature, baro = resampleWithDeltaX(temp_rel,(sensor_baro_0['pressure']-median_pressure)) # pressure in Pascal
+    temperature, baro = resampleWithDeltaX(temp_rel,100*(sensor_baro_0['pressure']-median_pressure)) # convert from hPa to Pa
    coef_baro_0_x = np.polyfit(temperature,baro,5)

 baro_0_params['TC_B0_X5'] = coef_baro_0_x[0]
@@ -1675,7 +1675,7 @@ baro_0_x_resample = fit_coef_baro_0_x(temp_rel_resample)
 plt.figure(13,figsize=(20,13))

 # draw plots
-plt.plot(sensor_baro_0['temperature'],sensor_baro_0['pressure']-median_pressure,'b')
+plt.plot(sensor_baro_0['temperature'],100*sensor_baro_0['pressure']-100*median_pressure,'b')
 plt.plot(temp_resample,baro_0_x_resample,'r')
 plt.title('Baro 0 ({}) Bias vs Temperature'.format(baro_0_params['TC_B0_ID']))
 plt.ylabel('Z bias (Pa)')
@@ -1717,9 +1717,9 @@ if num_baros >= 2:
    # fit data
    median_pressure = np.median(sensor_baro_1['pressure'])
    if noResample:
-        coef_baro_1_x = np.polyfit(temp_rel,(sensor_baro_1['pressure']-median_pressure),5) # pressure in Pascal
+        coef_baro_1_x = np.polyfit(temp_rel,100*(sensor_baro_1['pressure']-median_pressure),5) # convert from hPa to Pa
    else:
-        temperature, baro = resampleWithDeltaX(temp_rel,(sensor_baro_1['pressure']-median_pressure)) # pressure in Pascal
+        temperature, baro = resampleWithDeltaX(temp_rel,100*(sensor_baro_1['pressure']-median_pressure)) # convert from hPa to Pa
        coef_baro_1_x = np.polyfit(temperature,baro,5)

    baro_1_params['TC_B1_X5'] = coef_baro_1_x[0]
@@ -1736,7 +1736,7 @@ if num_baros >= 2:
    plt.figure(14,figsize=(20,13))

    # draw plots
-    plt.plot(sensor_baro_1['temperature'],sensor_baro_1['pressure']-median_pressure,'b')
+    plt.plot(sensor_baro_1['temperature'],100*sensor_baro_1['pressure']-100*median_pressure,'b')
    plt.plot(temp_resample,baro_1_x_resample,'r')
    plt.title('Baro 1 ({}) Bias vs Temperature'.format(baro_1_params['TC_B1_ID']))
    plt.ylabel('Z bias (Pa)')
@@ -1778,9 +1778,9 @@ if num_baros >= 3:
    # fit data
    median_pressure = np.median(sensor_baro_2['pressure'])
    if noResample:
-        coef_baro_2_x = np.polyfit(temp_rel,(sensor_baro_2['pressure']-median_pressure),5) # pressure in Pascal
+        coef_baro_2_x = np.polyfit(temp_rel,100*(sensor_baro_2['pressure']-median_pressure),5) # convert from hPa to Pa
    else:
-        temperature, baro = resampleWithDeltaX(temp_rel,(sensor_baro_2['pressure']-median_pressure)) # pressure in Pascal
+        temperature, baro = resampleWithDeltaX(temp_rel,100*(sensor_baro_2['pressure']-median_pressure)) # convert from hPa to Pa
        coef_baro_2_x = np.polyfit(temperature,baro,5)

    baro_2_params['TC_B2_X5'] = coef_baro_2_x[0]
@@ -1797,7 +1797,7 @@ if num_baros >= 3:
    plt.figure(15,figsize=(20,13))

    # draw plots
-    plt.plot(sensor_baro_2['temperature'],sensor_baro_2['pressure']-median_pressure,'b')
+    plt.plot(sensor_baro_2['temperature'],100*sensor_baro_2['pressure']-100*median_pressure,'b')
    plt.plot(temp_resample,baro_2_x_resample,'r')
    plt.title('Baro 2 ({}) Bias vs Temperature'.format(baro_2_params['TC_B2_ID']))
    plt.ylabel('Z bias (Pa)')
@@ -1838,7 +1838,7 @@ if num_baros >= 4:

    # fit data
    median_pressure = np.median(sensor_baro_3['pressure'])
-    coef_baro_3_x = np.polyfit(temp_rel,(sensor_baro_3['pressure']-median_pressure),5) # pressure in Pascal
+    coef_baro_3_x = np.polyfit(temp_rel,100*(sensor_baro_3['pressure']-median_pressure),5) # convert from hPa to Pa
    baro_3_params['TC_B3_X5'] = coef_baro_3_x[0]
    baro_3_params['TC_B3_X4'] = coef_baro_3_x[1]
    baro_3_params['TC_B3_X3'] = coef_baro_3_x[2]
@@ -1853,7 +1853,7 @@ if num_baros >= 4:
    plt.figure(16,figsize=(20,13))

    # draw plots
-    plt.plot(sensor_baro_3['temperature'],sensor_baro_3['pressure']-median_pressure,'b')
+    plt.plot(sensor_baro_3['temperature'],100*sensor_baro_3['pressure']-100*median_pressure,'b')
    plt.plot(temp_resample,baro_3_x_resample,'r')
    plt.title('Baro 3 ({}) Bias vs Temperature'.format(baro_3_params['TC_B3_ID']))
    plt.ylabel('Z bias (Pa)')
@@ -14,6 +14,7 @@ class AirframeGroup(object):
        self.af_class = af_class
        self.airframes = []

+
    def AddAirframe(self, airframe):
        """
        Add airframe to the airframe group
@@ -106,8 +107,6 @@ class AirframeGroup(object):
            return "Balloon"
        elif (self.type == "Vectored 6 DOF UUV"):
            return "Vectored6DofUUV"
-        elif self.type == "Free-Flyer":
-            return "FreeFlyer"
        return "AirframeUnknown"

    def GetAirframes(self):
@@ -15,7 +15,7 @@ class ModuleDocumentation(object):
    # TOC in https://github.com/PX4/PX4-Autopilot/blob/main/docs/en/SUMMARY.md
    valid_categories = ['driver', 'estimator', 'controller', 'system',
                        'communication', 'command', 'template', 'simulation', 'autotune']
-    valid_subcategories = ['', 'adc', 'camera', 'distance_sensor', 'imu', 'ins', 'airspeed_sensor',
+    valid_subcategories = ['', 'camera', 'distance_sensor', 'imu', 'ins', 'airspeed_sensor',
                           'magnetometer', 'baro', 'optical_flow', 'radio_control','rpm_sensor', 'transponder']

    max_line_length = 80 # wrap lines that are longer than this
@@ -6,7 +6,6 @@ future
 jinja2>=2.8
 jsonschema
 kconfiglib
-lark
 lxml
 matplotlib>=3.0
 numpy>=1.13
@@ -15,8 +14,8 @@ packaging
 pandas>=0.21
 pkgconfig
 psutil
-pycryptodome
 pygments
+wheel>=0.31.1
 pymavlink
 pyros-genmsg
 pyserial
@@ -25,6 +24,7 @@ pyyaml
 requests
 setuptools>=39.2.0
 six>=1.12.0
-sympy>=1.10.1
 toml>=0.9
-wheel>=0.31.1
+sympy>=1.10.1
+pycryptodome
+lark
@@ -54,22 +54,6 @@ if [[ ! -f "${DIR}/${REQUIREMENTS_FILE}" ]]; then
 	return 1
 fi

-# Linux Mint compatibility: use upstream Ubuntu values
-if [ -r /etc/upstream-release/lsb-release ]; then
-    . /etc/upstream-release/lsb-release
-    UBUNTU_CODENAME="${DISTRIB_CODENAME:-${UBUNTU_CODENAME:-}}"
-    UBUNTU_RELEASE="${DISTRIB_RELEASE:-${UBUNTU_RELEASE:-}}"
-
-    lsb_release() {
-        if [ "$1" = "-cs" ]; then
-            printf '%s' "$UBUNTU_CODENAME"
-        elif [ "$1" = "-rs" ]; then
-            printf '%s' "$UBUNTU_RELEASE"
-        else
-            command lsb_release "$@"
-        fi
-    }
-fi

 # check ubuntu version
 # otherwise warn and point to docker?
@@ -25,6 +25,10 @@ except ImportError as e:
    sys.exit(1)


+SERVER = 'https://logs.px4.io'
+#SERVER = 'http://localhost:5006' # for testing locally
+UPLOAD_URL = SERVER+'/upload'
+
 quiet = False

 def ask_value(text, default=None):
@@ -56,8 +60,6 @@ def main():
    parser = ArgumentParser(description=__doc__)
    parser.add_argument('--quiet', '-q', dest='quiet', action='store_true', default=False,
            help='Quiet mode: do not ask for values which were not provided as parameters')
-    parser.add_argument('--server', dest='server', type=str, default='https://logs.px4.io',
-                      help='Server URL (default: https://logs.px4.io), use http://localhost:5006 for testing locally')
    parser.add_argument("--description", dest="description", type=str,
                      help="Log description", default=None)
    parser.add_argument("--feedback", dest="feedback", type=str,
@@ -97,9 +99,6 @@ def main():
    else:
        email = args.email

-    server = args.server
-    upload_url = server + '/upload'
-
    payload = {'type': args.type, 'description': description,
               'feedback': feedback, 'email': email, 'source': args.source}

@@ -114,13 +113,13 @@ def main():
            print('Uploading '+file_name+'...')

        with open(file_name, 'rb') as f:
-            r = requests.post(upload_url, data=payload, files={'filearg': f},
+            r = requests.post(UPLOAD_URL, data=payload, files={'filearg': f},
                    allow_redirects=False)
            if r.status_code == 302: # redirect
                if 'Location'  in r.headers:
                    plot_url = r.headers['Location']
                    if len(plot_url) > 0 and plot_url[0] == '/':
-                        plot_url = server + plot_url
+                        plot_url = SERVER + plot_url
                    print('URL: '+plot_url)


@@ -42,7 +42,6 @@ import os
 import argparse
 import re
 import sys
-import json

 try:
    import em
@@ -125,7 +124,7 @@ def generate_by_template(output_file, template_file, em_globals):
    return True


-def generate_topics_list_file_from_files(files, outputdir, template_filename, templatedir, rihs_path):
+def generate_topics_list_file_from_files(files, outputdir, template_filename, templatedir):
    # generate cpp file with topics list
    filenames = []
    for filename in [os.path.basename(p) for p in files if os.path.basename(p).endswith(".msg")]:
@@ -139,27 +138,11 @@ def generate_topics_list_file_from_files(files, outputdir, template_filename, te
    for filename in [os.path.basename(p) for p in files if os.path.basename(p).endswith(".msg")]:
        full_base_names.append(filename.replace(".msg",""))

-    rihs01_hashes = dict()
-    if rihs_path != '':
-        for topic in full_base_names:
-            with open(rihs_path + "/msg/" + topic + ".json") as f:
-                d = json.load(f)
-                assert d['type_hashes'][0]['hash_string'][:7] == 'RIHS01_'
-
-                rihs01_hash = d['type_hashes'][0]['hash_string'][7:]
-
-                byte_array = [f"0x{rihs01_hash[i:i+2]}" for i in range(0, len(rihs01_hash), 2)]
-                c_code = f"{{ {', '.join(byte_array)} }};"
-                rihs01_hashes[topic] = c_code
-
    topics = []
-    datatypes_with_topics = dict()
    for msg_filename in files:
-        datatype = re.sub(r'(?<!^)(?=[A-Z])', '_', os.path.basename(msg_filename)).lower().replace(".msg","")
-        datatypes_with_topics[datatype] = get_topics(msg_filename)
-        topics.extend(datatypes_with_topics[datatype])
+        topics.extend(get_topics(msg_filename))

-    tl_globals = {"msgs": filenames, "topics": topics, "datatypes": datatypes, "full_base_names": full_base_names, "rihs01_hashes": rihs01_hashes, "datatypes_with_topics": datatypes_with_topics}
+    tl_globals = {"msgs": filenames, "topics": topics, "datatypes": datatypes, "full_base_names": full_base_names}
    tl_template_file = os.path.join(templatedir, template_filename)
    tl_out_file = os.path.join(outputdir, template_filename.replace(".em", ""))

@@ -179,15 +162,13 @@ if __name__ == "__main__":
    parser.add_argument('-p', dest='prefix', default='',
                        help='string added as prefix to the output file '
                        ' name when converting directories')
-    parser.add_argument('--rihs', dest='rihs', default='',
-                        help='path where rihs01 json files located')
    args = parser.parse_args()

    if args.zenoh_config:
-        generate_topics_list_file_from_files(args.file, args.outputdir, ZENOH_TEMPLATE_FILE[0], args.templatedir, args.rihs)
+        generate_topics_list_file_from_files(args.file, args.outputdir, ZENOH_TEMPLATE_FILE[0], args.templatedir)
        exit(0)
    elif args.zenoh_pub_sub:
-        generate_topics_list_file_from_files(args.file, args.outputdir, ZENOH_TEMPLATE_FILE[1], args.templatedir, args.rihs)
+        generate_topics_list_file_from_files(args.file, args.outputdir, ZENOH_TEMPLATE_FILE[1], args.templatedir)
        exit(0)
    else:
        print('Error: either --headers or --sources must be specified')
@@ -74,7 +74,7 @@ full_base_names.sort()

@[for idx, topic_name in enumerate(datatypes)]@
@{
-type_topic_count = len(datatypes_with_topics[topic_name])
+type_topic_count = len([e for e in topic_names_all if e.startswith(topic_name)])
 }@
 #ifdef CONFIG_ZENOH_PUBSUB_@(topic_name.upper())
 #  define CONFIG_ZENOH_PUBSUB_@(topic_name.upper())_COUNT @(type_topic_count)
@@ -88,28 +88,9 @@ type_topic_count = len(datatypes_with_topics[topic_name])
        CONFIG_ZENOH_PUBSUB_@(topic_name.upper())_COUNT + \
@[end for]        0

-@[for topic_name, rihs01_hash in rihs01_hashes.items()]@
-const uint8_t @(topic_name)_hash[32] = @(rihs01_hash)
-@[end for]
-
-@[for idx, topic_name in enumerate(datatypes)]@
-#ifdef CONFIG_ZENOH_PUBSUB_@(topic_name.upper())
-@{
-topic_names = datatypes_with_topics[topic_name]
-}@
-const orb_metadata* @(topic_name)_topic_meta[@(len(topic_names))] = {
-@[for topic_name_inst in topic_names]@
-	ORB_ID(@(topic_name_inst)),
-@[end for]};
-#endif
-@[end for]
-
 typedef struct {
-	const char *data_type_name;
 	const uint32_t *ops;
-	const uint8_t *hash;
-	const orb_metadata** orb_topic;
-	const uint8_t orb_topics_size;
+	const orb_metadata* orb_meta;
 } UorbPubSubTopicBinder;

 const UorbPubSubTopicBinder _topics[ZENOH_PUBSUB_COUNT] {
@@ -119,95 +100,54 @@ uorb_id_idx = 0
@[for idx, topic_name in enumerate(datatypes)]@
 #ifdef CONFIG_ZENOH_PUBSUB_@(topic_name.upper())
@{
-topic_names = datatypes_with_topics[topic_name]
+topic_names = [e for e in topic_names_all if e.startswith(topic_name)]
 }@
+@[for topic_name_inst in topic_names]@
 		{
-		  "@(topic_name)",
-		  px4_msgs_msg_@(topic_dict[topic_name])_cdrstream_desc.ops.ops,
-		  @(topic_dict[topic_name])_hash,
-		  @(topic_name)_topic_meta,
-		  @(len(topic_names)),
+		  px4_msg_@(topic_dict[topic_name])_cdrstream_desc.ops.ops,
+		  ORB_ID(@(topic_name_inst))
 		},
-#endif
+@{
+uorb_id_idx += 1
+}@
+@[end for]#endif
@[end for]
 };

-uORB_Zenoh_Publisher* genPublisher(const orb_metadata *meta, int instance) {
+uORB_Zenoh_Publisher* genPublisher(const orb_metadata *meta) {
    for (auto &pub : _topics) {
-        for(int i = 0; i < pub.orb_topics_size; i++) {
-            if(pub.orb_topic[i]->o_id == meta->o_id) {
-                return new uORB_Zenoh_Publisher(meta, pub.ops, instance);
-            }
+        if(pub.orb_meta->o_id == meta->o_id) {
+            return new uORB_Zenoh_Publisher(meta, pub.ops);
        }
    }
    return NULL;
 }


-uORB_Zenoh_Publisher* genPublisher(const char *name, int instance) {
+uORB_Zenoh_Publisher* genPublisher(const char *name) {
    for (auto &pub : _topics) {
-        for(int i = 0; i < pub.orb_topics_size; i++) {
-            if(strcmp(pub.orb_topic[i]->o_name, name) == 0) {
-                return new uORB_Zenoh_Publisher(pub.orb_topic[i], pub.ops, instance);
-            }
+        if(strcmp(pub.orb_meta->o_name, name) == 0) {
+            return new uORB_Zenoh_Publisher(pub.orb_meta, pub.ops);
        }
    }
    return NULL;
 }


-Zenoh_Subscriber* genSubscriber(const orb_metadata *meta, int instance) {
+Zenoh_Subscriber* genSubscriber(const orb_metadata *meta) {
    for (auto &sub : _topics) {
-        for(int i = 0; i < sub.orb_topics_size; i++) {
-            if(sub.orb_topic[i]->o_id == meta->o_id) {
-                return new uORB_Zenoh_Subscriber(meta, sub.ops, instance);
-            }
+        if(sub.orb_meta->o_id == meta->o_id) {
+            return new uORB_Zenoh_Subscriber(meta, sub.ops);
        }
    }
    return NULL;
 }


-Zenoh_Subscriber* genSubscriber(const char *name, int instance) {
+Zenoh_Subscriber* genSubscriber(const char *name) {
    for (auto &sub : _topics) {
-        for(int i = 0; i < sub.orb_topics_size; i++) {
-            if(strcmp(sub.orb_topic[i]->o_name, name) == 0) {
-                return new uORB_Zenoh_Subscriber(sub.orb_topic[i], sub.ops, instance);
-            }
-        }
-    }
-    return NULL;
-}
-
-const char* getTypeName(const char *name) {
-    for (auto &sub : _topics) {
-        for(int i = 0; i < sub.orb_topics_size; i++) {
-            if(strcmp(sub.orb_topic[i]->o_name, name) == 0) {
-                return sub.data_type_name;
-            }
-        }
-    }
-    return NULL;
-}
-
-
-const uint8_t* getRIHS01_Hash(const orb_metadata *meta) {
-    for (auto &sub : _topics) {
-        for(int i = 0; i < sub.orb_topics_size; i++) {
-            if(sub.orb_topic[i]->o_id == meta->o_id) {
-                return sub.hash;
-            }
-        }
-    }
-    return NULL;
-}
-
-const uint8_t* getRIHS01_Hash(const char *name) {
-    for (auto &sub : _topics) {
-        for(int i = 0; i < sub.orb_topics_size; i++) {
-            if(strcmp(sub.orb_topic[i]->o_name, name) == 0) {
-                return sub.hash;
-            }
+        if(strcmp(sub.orb_meta->o_name, name) == 0) {
+            return new uORB_Zenoh_Subscriber(sub.orb_meta, sub.ops);
        }
    }
    return NULL;
@@ -132,6 +132,7 @@ ENTRY(_stext)
 */
 EXTERN(abort)
 EXTERN(_bootdelay_signature)
+EXTERN(board_get_manifest)

 SECTIONS
 {
@@ -48,6 +48,7 @@ else()
 		i2c.cpp
 		init.c
 		led.c
+		mtd.cpp
 		spi.cpp
 		timer_config.cpp
 		usb.c
@@ -1,6 +1,6 @@
 /****************************************************************************
 *
- *   Copyright (C) 2020 PX4 Development Team. All rights reserved.
+ *   Copyright (C) 2025 PX4 Development Team. All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
@@ -30,12 +30,11 @@
 * POSSIBILITY OF SUCH DAMAGE.
 *
 ****************************************************************************/
-//TODO:Prepare for NxtDual

 #include <nuttx/spi/spi.h>
 #include <px4_platform_common/px4_manifest.h>
 //                                                              KiB BS    nB
-static const px4_mft_device_t spi2 = {             // FM25V02A on FMUM native: 32K X 8, emulated as (1024 Blocks of 32)
+static const px4_mft_device_t spi2 = {             // FM25V01A on FMUM native: 32K X 8, emulated as (1024 Blocks of 32)
 	.bus_type = px4_mft_device_t::SPI,
 	.devid    = SPIDEV_FLASH(0)
 };
@@ -47,15 +46,14 @@ static const px4_mtd_entry_t fmum_fram = {
 		{
 			.type = MTD_PARAMETERS,
 			.path = "/fs/mtd_params",
-			.nblocks = 1024
-		}
+			.nblocks = (32768 / (1 << CONFIG_RAMTRON_EMULATE_PAGE_SHIFT))
+		},
 	},
 };

-
 static const px4_mtd_manifest_t board_mtd_config = {
-	.nconfigs   = 1,
-	.entries = {
+	.nconfigs = 1,
+	.entries  = {
 		&fmum_fram
 	}
 };
@@ -67,6 +67,7 @@ CONFIG_MODULES_LOGGER=y
 CONFIG_MODULES_MAG_BIAS_ESTIMATOR=y
 CONFIG_MODULES_MANUAL_CONTROL=y
 CONFIG_MODULES_MAVLINK=y
+CONFIG_MAVLINK_DIALECT="development"
 CONFIG_MODULES_MC_ATT_CONTROL=y
 CONFIG_MODULES_MC_AUTOTUNE_ATTITUDE_CONTROL=y
 CONFIG_MODULES_MC_HOVER_THRUST_ESTIMATOR=y
@@ -3,13 +3,19 @@
 # board specific defaults
 #------------------------------------------------------------------------------

+# By disabling all 3 INA modules, we use the
+# i2c_launcher instead.
+param set - default SENS_EN_INA238 0
+param set - default SENS_EN_INA228 0
+param set - default SENS_EN_INA226 0
+
 # Mavlink ethernet (CFG 1000)
-param set-default MAV_2_CONFIG 1000
-param set-default MAV_2_BROADCAST 1
-param set-default MAV_2_MODE 0
-param set-default MAV_2_RADIO_CTL 0
-param set-default MAV_2_RATE 100000
-param set-default MAV_2_REMOTE_PRT 14550
-param set-default MAV_2_UDP_PRT 14550
+param set - default MAV_2_CONFIG 1000
+param set - default MAV_2_BROADCAST 1
+param set - default MAV_2_MODE 0
+param set - default MAV_2_RADIO_CTL 0
+param set - default MAV_2_RATE 100000
+param set - default MAV_2_REMOTE_PRT 14550
+param set - default MAV_2_UDP_PRT 14550

 safety_button start
@@ -75,6 +75,7 @@ CONFIG_MODULES_UUV_POS_CONTROL=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
+CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
 CONFIG_SYSTEMCMDS_GPIO=y
@@ -1,30 +0,0 @@
-CONFIG_BOARD_TOOLCHAIN="arm-none-eabi"
-CONFIG_BOARD_ARCHITECTURE="cortex-m4"
-CONFIG_BOARD_ROMFSROOT="cannode"
-CONFIG_BOARD_CONSTRAINED_FLASH=y
-CONFIG_BOARD_NO_HELP=y
-CONFIG_BOARD_CONSTRAINED_MEMORY=y
-CONFIG_DRIVERS_BOOTLOADERS=y
-CONFIG_DRIVERS_DISTANCE_SENSOR_BROADCOM_AFBRS50=y
-CONFIG_DRIVERS_IMU_INVENSENSE_IIM42653=y
-CONFIG_DRIVERS_OPTICAL_FLOW_PAA3905=y
-CONFIG_BOARD_UAVCAN_INTERFACES=1
-CONFIG_DRIVERS_UAVCANNODE=y
-CONFIG_UAVCANNODE_FLOW_MEASUREMENT=y
-CONFIG_UAVCANNODE_RANGE_SENSOR_MEASUREMENT=y
-CONFIG_UAVCANNODE_RAW_IMU=y
-CONFIG_MODULES_GYRO_CALIBRATION=y
-CONFIG_MODULES_SENSORS=y
-# CONFIG_SENSORS_VEHICLE_AIRSPEED is not set
-# CONFIG_SENSORS_VEHICLE_AIR_DATA is not set
-# CONFIG_SENSORS_VEHICLE_ACCELERATION is not set
-# CONFIG_SENSORS_VEHICLE_GPS_POSITION is not set
-# CONFIG_SENSORS_VEHICLE_MAGNETOMETER is not set
-CONFIG_SYSTEMCMDS_PARAM=y
-CONFIG_SYSTEMCMDS_PERF=y
-CONFIG_SYSTEMCMDS_REBOOT=y
-CONFIG_SYSTEMCMDS_TOP=y
-CONFIG_SYSTEMCMDS_TOPIC_LISTENER=y
-CONFIG_SYSTEMCMDS_UORB=y
-CONFIG_SYSTEMCMDS_VER=y
-CONFIG_SYSTEMCMDS_WORK_QUEUE=y
@@ -8,8 +8,9 @@ param set-default SENS_FLOW_RATE 150
 param set-default SENS_IMU_CLPNOTI 0

 param set-default SENS_AFBR_S_RATE 25
-param set-default SENS_AFBR_L_RATE 5
-param set-default SENS_AFBR_MODE 1
+param set-default SENS_AFBR_L_RATE 10
+param set-default SENS_AFBR_THRESH 8
+param set-default SENS_AFBR_HYSTER 2

 # Internal SPI
 paa3905 -s start -Y 180
--- a/Show More
+++ b/Show More