WIP: device tree MVP

.ci/Jenkinsfile-compile

@@ -60,8 +60,6 @@ pipeline {
                      "holybro_kakutef7_default",
                      "holybro_pix32v5_default",
                      "matek_h743-slim",
-                     "matek_gnss-m9n-f4_canbootloader",
-                     "matek_gnss-m9n-f4_default",
                      "modalai_fc-v1_default",
                      "modalai_fc-v1_rtps",
                      "modalai_fc-v2_default",

.ci/Jenkinsfile-hardware

@@ -73,8 +73,10 @@ pipeline {
                 }
               }
               post {
+                failure {
+                  sh 'cat /tmp/pyserial_spy_file.txt'
+                }
                 always {
-                  sh 'cat /tmp/pyserial_spy_file.txt || true'
                   sh './platforms/nuttx/Debug/jlink_gdb_backtrace_simple.sh build/cubepilot_cubeorange_test/cubepilot_cubeorange_test.elf || true'
                 }
               }
@@ -143,8 +145,10 @@ pipeline {
                 }
               }
               post {
+                failure {
+                  sh 'cat /tmp/pyserial_spy_file.txt'
+                }
                 always {
-                  sh 'cat /tmp/pyserial_spy_file.txt || true'
                   sh './platforms/nuttx/Debug/jlink_gdb_backtrace_simple.sh build/cuav_x7pro_test/cuav_x7pro_test.elf || true'
                 }
               }
@@ -213,8 +217,10 @@ pipeline {
                 }
               }
               post {
+                failure {
+                  sh 'cat /tmp/pyserial_spy_file.txt'
+                }
                 always {
-                  sh 'cat /tmp/pyserial_spy_file.txt || true'
                   sh './platforms/nuttx/Debug/jlink_gdb_backtrace_simple.sh build/px4_fmu-v3_test/px4_fmu-v3_test.elf || true'
                 }
               }
@@ -282,8 +288,10 @@ pipeline {
                 }
               }
               post {
+                failure {
+                  sh 'cat /tmp/pyserial_spy_file.txt'
+                }
                 always {
-                  sh 'cat /tmp/pyserial_spy_file.txt || true'
                   sh './platforms/nuttx/Debug/jlink_gdb_backtrace_simple.sh build/px4_fmu-v4_test/px4_fmu-v4_test.elf || true'
                 }
               }
@@ -352,8 +360,10 @@ pipeline {
                 }
               }
               post {
+                failure {
+                  sh 'cat /tmp/pyserial_spy_file.txt'
+                }
                 always {
-                  sh 'cat /tmp/pyserial_spy_file.txt || true'
                   sh './platforms/nuttx/Debug/jlink_gdb_backtrace_simple.sh build/px4_fmu-v4pro_test/px4_fmu-v4pro_test.elf || true'
                 }
               }
@@ -442,8 +452,10 @@ pipeline {
                 }
               }
               post {
+                failure {
+                  sh 'cat /tmp/pyserial_spy_file.txt'
+                }
                 always {
-                  sh 'cat /tmp/pyserial_spy_file.txt || true'
                   sh './platforms/nuttx/Debug/jlink_gdb_backtrace_simple.sh build/px4_fmu-v5_debug/px4_fmu-v5_debug.elf || true'
                 }
               }
@@ -524,8 +536,10 @@ pipeline {
                 }
               }
               post {
+                failure {
+                  sh 'cat /tmp/pyserial_spy_file.txt'
+                }
                 always {
-                  sh 'cat /tmp/pyserial_spy_file.txt || true'
                   sh './platforms/nuttx/Debug/jlink_gdb_backtrace_simple.sh build/px4_fmu-v5_stackcheck/px4_fmu-v5_stackcheck.elf || true'
                 }
               }
@@ -594,8 +608,10 @@ pipeline {
                 }
               }
               post {
+                failure {
+                  sh 'cat /tmp/pyserial_spy_file.txt'
+                }
                 always {
-                  sh 'cat /tmp/pyserial_spy_file.txt || true'
                   sh './platforms/nuttx/Debug/jlink_gdb_backtrace_simple.sh build/px4_fmu-v5_test/px4_fmu-v5_test.elf || true'
                 }
               }
@@ -664,8 +680,10 @@ pipeline {
                 }
               }
               post {
+                failure {
+                  sh 'cat /tmp/pyserial_spy_file.txt'
+                }
                 always {
-                  sh 'cat /tmp/pyserial_spy_file.txt || true'
                   sh './platforms/nuttx/Debug/jlink_gdb_backtrace_simple.sh build/nxp_fmuk66-v3_test/nxp_fmuk66-v3_test.elf || true'
                 }
               }
@@ -725,10 +743,8 @@ void checkStatus() {
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "param save"'
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "param status"'
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "param show SYS*"'
-  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "param dump"'
   sh './Tools/HIL/reboot.py --device `find /dev/serial -name *usb-*`' // reboot to apply
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "param show SYS*"'
-  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "param dump"'
 
   // run logger
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "logger on"'
@@ -762,7 +778,6 @@ void checkStatus() {
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "mavlink status" || true'
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "mount"'
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "mtd status"'
-  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "param dump"'
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "param show" || true'
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "param status"'
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "perf latency"'
@@ -774,8 +789,8 @@ void checkStatus() {
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "sensors status"'
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "top once"'
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "uavcan status" || true'
-  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "uorb status" || true'
-  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "uorb top -1 -a" || true'
+  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "uorb status"'
+  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "uorb top -1 -a"'
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "ver all"'
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "work_queue status"'
   // stop logger
@@ -797,8 +812,6 @@ void runTests() {
 
   sh './Tools/HIL/nsh_param_set.py --device `find /dev/serial -name *usb-*` --name "IMU_GYRO_CAL_EN" --value "0" || true' // disable during testing
   sh './Tools/HIL/nsh_param_set.py --device `find /dev/serial -name *usb-*` --name "IMU_GYRO_FFT_EN" --value "0" || true' // disable during testing
-  sh './Tools/HIL/nsh_param_set.py --device `find /dev/serial -name *usb-*` --name "SENS_IMU_AUTOCAL" --value "0" || true' // disable during testing
-  sh './Tools/HIL/nsh_param_set.py --device `find /dev/serial -name *usb-*` --name "SENS_MAG_AUTOCAL" --value "0" || true' // disable during testing
 
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "param save"'
   sh './Tools/HIL/reboot.py --device `find /dev/serial -name *usb-*`' // reboot to apply
@@ -844,7 +857,7 @@ void runTests() {
 void printTopics() {
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "ls /obj"'
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "uorb status"'
-  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "uorb top -1 -a" || true'
+  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "uorb top -1 -a"'
 
   // these are for casually inspecting the system, output failure doesn't matter
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "listener actuator_armed" || true'
@@ -861,7 +874,7 @@ void printTopics() {
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "listener cpuload" || true'
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "listener distance_sensor" || true'
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "listener ekf2_timestamps" || true'
-  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "listener estimator_gps_status" || true'
+  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "listener ekf_gps_drift" || true'
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "listener esc_status" || true'
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "listener estimator_attitude" || true'
   sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "listener estimator_baro_bias" || true'

.clusterfuzzlite/Dockerfile

@@ -1,7 +0,0 @@
-FROM gcr.io/oss-fuzz-base/base-builder:v1
-COPY . $SRC/PX4-Autopilot
-RUN apt-get install -y libjpeg8-dev zlib1g-dev
-RUN pip3 install --upgrade pip
-RUN python3 -m pip install -r $SRC/PX4-Autopilot/Tools/setup/requirements.txt
-WORKDIR $SRC/PX4-Autopilot
-COPY ./.clusterfuzzlite/build.sh $SRC/

.clusterfuzzlite/build.sh

@@ -1,4 +0,0 @@
-#!/usr/bin/env bash -eu
-
-PX4_FUZZ=1 make px4_sitl
-cp build/px4_sitl_default/bin/px4 $OUT/px4

.clusterfuzzlite/project.yaml

@@ -1 +0,0 @@
-language: c++

.github/workflows/cflite_batch.yml

@@ -1,34 +0,0 @@
-name: ClusterFuzzLite batch fuzzing
-on:
-  schedule:
-    - cron: '0 6 * * *'  # UTC 6am every day.
-permissions: read-all
-jobs:
-  BatchFuzzing:
-    runs-on: ubuntu-latest
-    strategy:
-      fail-fast: false
-      matrix:
-        sanitizer:
-        - address
-        - undefined
-        - memory
-    steps:
-    - name: Build Fuzzers (${{ matrix.sanitizer }})
-      id: build
-      uses: google/clusterfuzzlite/actions/build_fuzzers@v1
-      with:
-        sanitizer: ${{ matrix.sanitizer }}
-    - name: Run Fuzzers (${{ matrix.sanitizer }})
-      id: run
-      uses: google/clusterfuzzlite/actions/run_fuzzers@v1
-      with:
-        github-token: ${{ secrets.GITHUB_TOKEN }}
-        fuzz-seconds: 1800 # 30 mins
-        mode: 'batch'
-        sanitizer: ${{ matrix.sanitizer }}
-        # Optional but recommended: For storing certain artifacts from fuzzing.
-        # See later section on "Git repo for storage".
-        # storage-repo: https://${{ secrets.PERSONAL_ACCESS_TOKEN }}@github.com/OWNER/STORAGE-REPO-NAME.git
-        # storage-repo-branch: main   # Optional. Defaults to "main"
-        # storage-repo-branch-coverage: gh-pages  # Optional. Defaults to "gh-pages".

.github/workflows/compile_nuttx.yml

@@ -33,10 +33,8 @@ jobs:
           holybro_can-gps-v1,
           holybro_durandal-v1,
           holybro_kakutef7,
-          holybro_kakuteh7,
           holybro_pix32v5,
           matek_h743-slim,
-          matek_gnss-m9n-f4,
           modalai_fc-v1,
           modalai_fc-v2,
           mro_ctrl-zero-f7,

.gitmodules

@@ -64,3 +64,6 @@
 	path = src/lib/crypto/libtommath
 	url = https://github.com/PX4/libtommath.git
 	branch = px4
+[submodule "platforms/nuttx/src/px4/stm/hal_stm32"]
+	path = platforms/nuttx/src/px4/stm/hal_stm32
+	url = git@github.com:zephyrproject-rtos/hal_stm32.git

.vscode/cmake-variants.yaml

@@ -196,16 +196,6 @@ CONFIG:
       buildType: MinSizeRel
       settings:
         CONFIG: matek_h743-slim_default
-    matek_gnss-m9n-f4_canbootloader:
-      short: matek_gnss-m9n-f4_canbootloader
-      buildType: MiniSizeRel
-      settings:
-        CONFIG: matek_m9nf4can_canbootloader
-    matek_gnss-m9n-f4_default:
-      short: matek_gnss-m9n-f4_default
-      buildType: MiniSizeRel
-      settings:
-        CONFIG: matek_gnss-m9n-f4_default
     modalai_fc-v1_default:
       short: modalai_fc-v1
       buildType: MinSizeRel

CMakeLists.txt

@@ -125,11 +125,6 @@ define_property(GLOBAL PROPERTY PX4_MODULE_LIBRARIES
                  FULL_DOCS "List of all PX4 module libraries"
                  )
 
-define_property(GLOBAL PROPERTY PX4_KERNEL_MODULE_LIBRARIES
-                 BRIEF_DOCS "PX4 kernel side module libs"
-                 FULL_DOCS "List of all PX4 kernel module libraries"
-                 )
-
 define_property(GLOBAL PROPERTY PX4_MODULE_PATHS
                  BRIEF_DOCS "PX4 module paths"
                  FULL_DOCS "List of paths to all PX4 modules"
@@ -147,7 +142,6 @@ set(CONFIG "px4_sitl_default" CACHE STRING "desired configuration")
 
 include(px4_add_module)
 set(config_module_list)
-set(config_kernel_list)
 
 # Find Python
 # If using catkin, Python 2 is found since it points
@@ -412,7 +406,6 @@ endif()
 # subdirectories
 #
 add_library(parameters_interface INTERFACE)
-add_library(kernel_parameters_interface INTERFACE)
 
 include(px4_add_library)
 add_subdirectory(src/lib EXCLUDE_FROM_ALL)
@@ -420,6 +413,8 @@ add_subdirectory(src/lib EXCLUDE_FROM_ALL)
 add_subdirectory(platforms/${PX4_PLATFORM}/src/px4)
 add_subdirectory(platforms EXCLUDE_FROM_ALL)
 
+include(dts)
+
 if(EXISTS "${PX4_BOARD_DIR}/CMakeLists.txt")
 	add_subdirectory(${PX4_BOARD_DIR})
 endif()
@@ -435,13 +430,7 @@ add_subdirectory(src/lib/metadata EXCLUDE_FROM_ALL)
 
 # must be the last module before firmware
 add_subdirectory(src/lib/parameters EXCLUDE_FROM_ALL)
-
-if(${PX4_PLATFORM} STREQUAL "nuttx" AND NOT CONFIG_BUILD_FLAT)
-target_link_libraries(parameters_interface INTERFACE usr_parameters)
-target_link_libraries(kernel_parameters_interface INTERFACE parameters)
-else()
 target_link_libraries(parameters_interface INTERFACE parameters)
-endif()
 
 # firmware added last to generate the builtin for included modules
 add_subdirectory(platforms/${PX4_PLATFORM})

Kconfig

@@ -118,11 +118,6 @@ config BOARD_CRYPTO
     help
         Enable PX4 Crypto Support. Select the implementation under drivers
 
-config BOARD_PROTECTED
-    bool "Memory protection"
-    help
-        Enable memory protection via MPU/MMU
-
 menu "Serial ports"
 
     config BOARD_SERIAL_URT6

LICENSE

@@ -1,6 +1,6 @@
 BSD 3-Clause License
 
-Copyright (c) 2012 - 2022, PX4 Development Team
+Copyright (c) 2012 - 2021, PX4 Development Team
 All rights reserved.
 
 Redistribution and use in source and binary forms, with or without

Makefile

@@ -158,11 +158,6 @@ else
 		CMAKE_ARGS += -DCMAKE_BUILD_TYPE=UndefinedBehaviorSanitizer
 	endif
 
-	# Fuzz Testing
-	ifdef PX4_FUZZ
-		CMAKE_ARGS += -DCMAKE_BUILD_TYPE=FuzzTesting
-	endif
-
 endif
 
 # Pick up specific Python path if set

ROMFS/px4fmu_common/init.d-posix/airframes/1020_uuv_generic

@@ -8,5 +8,8 @@
 # disable circuit breaker for airspeed sensor
 param set-default CBRK_AIRSPD_CHK 162128
 
+set MAV_TYPE 12
+param set MAV_TYPE ${MAV_TYPE}
+
 set MIXER_FILE etc/mixers-sitl/uuv_x_sitl.main.mix
 set MIXER custom

ROMFS/px4fmu_common/init.d-posix/airframes/1021_uuv_hippocampus

@@ -8,5 +8,8 @@
 # disable circuit breaker for airspeed sensor
 param set-default CBRK_AIRSPD_CHK 162128
 
+set MAV_TYPE 12
+param set MAV_TYPE ${MAV_TYPE}
+
 set MIXER_FILE etc/mixers-sitl/uuv_x_sitl.main.mix
 set MIXER custom

ROMFS/px4fmu_common/init.d-posix/airframes/1022_uuv_bluerov2_heavy

@@ -67,3 +67,4 @@ param set-default PWM_MAIN_FUNC7 107
 param set-default PWM_MAIN_FUNC8 108
 
 set MIXER skip
+

ROMFS/px4fmu_common/init.d-posix/airframes/1037_believer

@@ -44,8 +44,6 @@ param set-default MIS_TAKEOFF_ALT 30
 param set-default NAV_ACC_RAD 15
 param set-default NAV_DLL_ACT 2
 
-param set-default FW_USE_NPFG 1
-
 param set-default RWTO_TKOFF 1
 
 set MIXER_FILE etc/mixers-sitl/plane_sitl.main.mix

ROMFS/px4fmu_common/init.d-posix/airframes/1040_standard_vtol

@@ -10,7 +10,7 @@
 # param set-default SYS_CTRL_ALLOC 1
 param set-default CA_AIRFRAME 2
 
-param set-default CA_ROTOR_COUNT 5
+param set-default CA_ROTOR_COUNT 4
 param set-default CA_ROTOR0_PX 0.1515
 param set-default CA_ROTOR0_PY 0.245
 param set-default CA_ROTOR0_KM 0.05
@@ -23,9 +23,6 @@ param set-default CA_ROTOR2_KM -0.05
 param set-default CA_ROTOR3_PX -0.1515
 param set-default CA_ROTOR3_PY 0.1875
 param set-default CA_ROTOR3_KM -0.05
-param set-default CA_ROTOR4_AX 1.0
-param set-default CA_ROTOR4_AZ 0.0
-param set-default CA_ROTOR4_PX 0.2
 
 param set-default CA_SV_CS_COUNT 3
 param set-default CA_SV_CS0_TYPE 1
@@ -80,5 +77,7 @@ param set-default VT_FW_MOT_OFFID 1234
 param set-default VT_B_TRANS_DUR 8
 param set-default VT_TYPE 2
 
+set MAV_TYPE 22
+
 set MIXER_FILE etc/mixers-sitl/standard_vtol_sitl.main.mix
 set MIXER custom

ROMFS/px4fmu_common/init.d-posix/airframes/1041_tailsitter

@@ -7,8 +7,6 @@
 
 . ${R}etc/init.d/rc.vtol_defaults
 
-param set-default MAV_TYPE 20
-
 # param set-default SYS_CTRL_ALLOC 1
 param set-default CA_AIRFRAME 4
 
@@ -80,5 +78,7 @@ param set-default VT_TYPE 0
 
 param set-default WV_EN 0
 
+set MAV_TYPE 20
+
 set MIXER_FILE etc/mixers-sitl/quad_x_vtol.main.mix
 set MIXER custom

ROMFS/px4fmu_common/init.d-posix/airframes/1042_tiltrotor

@@ -7,8 +7,6 @@
 
 . ${R}etc/init.d/rc.vtol_defaults
 
-param set-default MAV_TYPE 21
-
 # param set-default SYS_CTRL_ALLOC 1
 param set-default CA_AIRFRAME 3
 
@@ -90,5 +88,7 @@ param set-default VT_MOT_ID 1234
 param set-default VT_TILT_TRANS 0.6
 param set-default VT_TYPE 1
 
+set MAV_TYPE 21
+
 set MIXER_FILE etc/mixers-sitl/tiltrotor_sitl.main.mix
 set MIXER custom

ROMFS/px4fmu_common/init.d-posix/airframes/1043_standard_vtol_drop

@@ -51,5 +51,7 @@ param set-default RC_MAP_AUX1 8
 param set-default RC_MAP_AUX2 9
 param set-default RC_MAP_AUX3 10
 
+set MAV_TYPE 22
+
 set MIXER_FILE etc/mixers-sitl/standard_vtol_sitl.main.mix
 set MIXER custom

ROMFS/px4fmu_common/init.d-posix/airframes/1060_rover

@@ -37,4 +37,6 @@ param set-default PWM_MAIN_FUNC2 201
 param set-default PWM_MAIN_FUNC6 101
 param set-default PWM_MAIN_FUNC7 101
 
+set MAV_TYPE 10
+
 set MIXER_FILE skip

ROMFS/px4fmu_common/init.d-posix/airframes/1061_r1_rover

@@ -37,4 +37,6 @@ param set-default PWM_MAIN_FUNC2 101
 param set-default PWM_MAIN_FUNC6 102
 param set-default PWM_MAIN_FUNC7 102
 
+set MAV_TYPE 10
+
 set MIXER_FILE skip

ROMFS/px4fmu_common/init.d-posix/airframes/1062_tf-r1

@@ -10,8 +10,6 @@
 
 . ${R}etc/init.d/rc.rover_defaults
 
-param set-default MAV_TYPE 10
-
 param set-default GND_L1_DIST 5
 param set-default GND_SP_CTRL_MODE 1
 param set-default GND_SPEED_D 3
@@ -35,4 +33,6 @@ param set-default CBRK_AIRSPD_CHK 162128
 param set-default GND_MAX_ANG 0.6
 param set-default GND_WHEEL_BASE 3.0
 
+set MAV_TYPE 10
+
 set MIXER_FILE etc/mixers-sitl/rover_ackermann_sitl.main.mix

ROMFS/px4fmu_common/init.d-posix/airframes/1070_boat

@@ -47,4 +47,6 @@ param set-default CA_R_REV 3
 param set-default PWM_MAIN_FUNC1 101
 param set-default PWM_MAIN_FUNC2 102
 
+set MAV_TYPE 11
+
 set MIXER skip

ROMFS/px4fmu_common/init.d-posix/airframes/3011_hexarotor_x

@@ -9,8 +9,6 @@
 
 . ${R}etc/init.d/rc.mc_defaults
 
-param set-default MAV_TYPE 13
-
 param set-default MC_PITCHRATE_P 0.1
 param set-default MC_PITCHRATE_I 0.05
 param set-default MC_PITCH_P 6.0
@@ -26,4 +24,6 @@ param set-default TRIG_MODE 4
 param set-default MNT_MODE_IN 4
 param set-default MNT_DO_STAB 2
 
+set MAV_TYPE 13
+
 set MIXER hexa_x

ROMFS/px4fmu_common/init.d-posix/airframes/6011_typhoon_h480

@@ -7,8 +7,6 @@
 
 . ${R}etc/init.d/rc.mc_defaults
 
-param set-default MAV_TYPE 13
-
 param set-default MC_PITCHRATE_P 0.0800
 param set-default MC_PITCHRATE_I 0.0400
 param set-default MC_PITCHRATE_D 0.0010
@@ -28,4 +26,6 @@ param set-default MNT_MODE_IN 4
 param set-default MNT_MODE_OUT 2
 param set-default MAV_PROTO_VER 2
 
+set MAV_TYPE 13
+
 set MIXER hexa_x

ROMFS/px4fmu_common/init.d-posix/airframes/6012_typhoon_h480_ctrlalloc

@@ -7,8 +7,6 @@
 
 . ${R}etc/init.d/rc.mc_defaults
 
-param set-default MAV_TYPE 13
-
 param set-default SYS_CTRL_ALLOC 1
 
 param set-default MC_PITCHRATE_P 0.0800
@@ -60,5 +58,7 @@ param set-default PWM_MAIN_FUNC4 104
 param set-default PWM_MAIN_FUNC5 105
 param set-default PWM_MAIN_FUNC6 106
 
+set MAV_TYPE 13
+
 set MIXER skip
 set MIXER_AUX none

ROMFS/px4fmu_common/init.d-posix/rc.replay

@@ -10,7 +10,7 @@ fi
 
 if [ ! -f replay_params.txt ]; then
 	echo "Creating $(pwd)/replay_params.txt"
-	ulog_params -i "${replay}" -l ' ' | grep -e '^EKF2' > replay_params.txt
+	ulog_params -i "${replay}" -d ' ' | grep -e '^EKF2' > replay_params.txt
 fi
 
 publisher_rules_file="orb_publisher.rules"
@@ -21,7 +21,6 @@ ignore_others: false
 EOF
 
 param set SDLOG_DIRS_MAX 7
-param set SDLOG_PROFILE 3
 
 # apply all params before ekf starts, as some params cannot be changed after startup
 replay tryapplyparams

ROMFS/px4fmu_common/init.d-posix/rcS

@@ -24,6 +24,7 @@ fi
 
 # initialize script variables
 set IO_PRESENT                  no
+set MAV_TYPE                    none
 set MIXER                       none
 set MIXER_AUX                   none
 set MIXER_FILE                  none
@@ -233,7 +234,7 @@ fi
 
 if param greater -s MNT_MODE_IN -1
 then
-	gimbal start
+	vmount start
 fi
 
 if param greater -s TRIG_MODE 0

ROMFS/px4fmu_common/init.d/airframes/1000_rc_fw_easystar.hil

@@ -39,26 +39,6 @@ param set-default FW_RR_P 0.3
 
 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
-param set-default CA_SV_CS_COUNT 4
-param set-default CA_SV_CS0_TRQ_R 0.5
-param set-default CA_SV_CS0_TYPE 2
-param set-default CA_SV_CS1_TRQ_P 1.0
-param set-default CA_SV_CS1_TYPE 3
-param set-default CA_SV_CS2_TRQ_Y 1.0
-param set-default CA_SV_CS2_TYPE 4
-param set-default CA_SV_CS3_TYPE 10
-
-param set-default HIL_ACT_REV 2
-param set-default HIL_ACT_FUNC1 201
-param set-default HIL_ACT_FUNC2 202
-param set-default HIL_ACT_FUNC3 203
-param set-default HIL_ACT_FUNC4 101
-param set-default HIL_ACT_FUNC5 204
-param set-default HIL_ACT_FUNC6 400
-
 param set SYS_HITL 1
 
 # disable some checks to allow to fly

ROMFS/px4fmu_common/init.d/airframes/10016_3dr_iris

@@ -35,6 +35,6 @@ param set-default MC_YAWRATE_P 0.25
 param set-default MC_YAWRATE_I 0.25
 
 param set-default BAT1_V_DIV 12.27559
-param set-default BAT1_A_PER_V 15.391030303103
+param set-default BAT1_A_PER_V 15.39103
 
 set MIXER quad_w

ROMFS/px4fmu_common/init.d/airframes/10017_steadidrone_qu4d

@@ -36,5 +36,4 @@ param set-default MC_PITCHRATE_P 0.19
 param set-default MC_PITCHRATE_I 0.05
 param set-default MC_PITCHRATE_D 0.004
 param set-default MC_YAW_P 4
-
 set MIXER quad_w

ROMFS/px4fmu_common/init.d/airframes/1001_rc_quad_x.hil

@@ -15,23 +15,6 @@ set MIXER quad_x
 
 param set SYS_HITL 1
 
-param set-default CA_ROTOR_COUNT 4
-param set-default CA_ROTOR0_PX 0.15
-param set-default CA_ROTOR0_PY 0.15
-param set-default CA_ROTOR1_PX -0.15
-param set-default CA_ROTOR1_PY -0.15
-param set-default CA_ROTOR2_PX 0.15
-param set-default CA_ROTOR2_PY -0.15
-param set-default CA_ROTOR2_KM -0.05
-param set-default CA_ROTOR3_PX -0.15
-param set-default CA_ROTOR3_PY 0.15
-param set-default CA_ROTOR3_KM -0.05
-
-param set-default HIL_ACT_FUNC1 101
-param set-default HIL_ACT_FUNC2 102
-param set-default HIL_ACT_FUNC3 103
-param set-default HIL_ACT_FUNC4 104
-
 # disable some checks to allow to fly
 # - with usb
 param set-default CBRK_USB_CHK 197848

ROMFS/px4fmu_common/init.d/airframes/1002_standard_vtol.hil

@@ -61,37 +61,6 @@ param set-default VT_MOT_ID 1234
 param set-default VT_FW_MOT_OFFID 1234
 param set-default VT_TYPE 2
 
-param set-default CA_AIRFRAME 2
-param set-default CA_ROTOR_COUNT 5
-param set-default CA_ROTOR0_PX 0.15
-param set-default CA_ROTOR0_PY 0.15
-param set-default CA_ROTOR1_PX -0.15
-param set-default CA_ROTOR1_PY -0.15
-param set-default CA_ROTOR2_PX 0.15
-param set-default CA_ROTOR2_PY -0.15
-param set-default CA_ROTOR2_KM -0.05
-param set-default CA_ROTOR3_PX -0.15
-param set-default CA_ROTOR3_PY 0.15
-param set-default CA_ROTOR3_KM -0.05
-param set-default CA_ROTOR4_AX 1.0
-param set-default CA_ROTOR4_AZ 0.0
-param set-default CA_ROTOR4_PX 0.2
-
-param set-default CA_SV_CS_COUNT 3
-param set-default CA_SV_CS1_TRQ_R 0.5
-param set-default CA_SV_CS1_TYPE 2
-param set-default CA_SV_CS2_TRQ_P 1.0
-param set-default CA_SV_CS2_TYPE 3
-
-param set-default HIL_ACT_FUNC1 101
-param set-default HIL_ACT_FUNC2 102
-param set-default HIL_ACT_FUNC3 103
-param set-default HIL_ACT_FUNC4 104
-param set-default HIL_ACT_FUNC5 105
-param set-default HIL_ACT_FUNC6 201
-param set-default HIL_ACT_FUNC7 202
-param set-default HIL_ACT_FUNC8 203
-
 
 param set SYS_HITL 1
 
@@ -104,7 +73,7 @@ param set-default CBRK_SUPPLY_CHK 894281
 param set-default COM_PREARM_MODE 0
 param set-default CBRK_IO_SAFETY 22027
 
-param set-default MAV_TYPE 22
+set MAV_TYPE 22
 
 set MIXER standard_vtol_hitl
 

ROMFS/px4fmu_common/init.d/airframes/1100_rc_quad_x_sih.hil

@@ -15,25 +15,6 @@
 set MIXER quad_x
 set PWM_OUT 1234
 
-param set UAVCAN_ENABLE 0
-
-param set-default CA_ROTOR_COUNT 4
-param set-default CA_ROTOR0_PX 0.15
-param set-default CA_ROTOR0_PY 0.15
-param set-default CA_ROTOR1_PX -0.15
-param set-default CA_ROTOR1_PY -0.15
-param set-default CA_ROTOR2_PX 0.15
-param set-default CA_ROTOR2_PY -0.15
-param set-default CA_ROTOR2_KM -0.05
-param set-default CA_ROTOR3_PX -0.15
-param set-default CA_ROTOR3_PY 0.15
-param set-default CA_ROTOR3_KM -0.05
-
-param set-default HIL_ACT_FUNC1 101
-param set-default HIL_ACT_FUNC2 102
-param set-default HIL_ACT_FUNC3 103
-param set-default HIL_ACT_FUNC4 104
-
 # set SYS_HITL to 2 to start the SIH and avoid sensors startup
 param set SYS_HITL 2
 

ROMFS/px4fmu_common/init.d/airframes/1101_rc_plane_sih.hil

@@ -15,28 +15,6 @@
 set MIXER AERT
 set PWM_OUT 1234
 
-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
-param set-default CA_SV_CS_COUNT 4
-param set-default CA_SV_CS0_TRQ_R 0.5
-param set-default CA_SV_CS0_TYPE 2
-param set-default CA_SV_CS1_TRQ_P 1.0
-param set-default CA_SV_CS1_TYPE 3
-param set-default CA_SV_CS2_TRQ_Y 1.0
-param set-default CA_SV_CS2_TYPE 4
-param set-default CA_SV_CS3_TYPE 10
-
-param set-default HIL_ACT_REV 2
-param set-default HIL_ACT_FUNC1 201
-param set-default HIL_ACT_FUNC2 202
-param set-default HIL_ACT_FUNC3 203
-param set-default HIL_ACT_FUNC4 101
-param set-default HIL_ACT_FUNC5 204
-param set-default HIL_ACT_FUNC6 400
-
 # set SYS_HITL to 2 to start the SIH and avoid sensors startup
 param set-default SYS_HITL 2
 

ROMFS/px4fmu_common/init.d/airframes/1102_tailsitter_duo_sih.hil

@@ -1,81 +0,0 @@
-#!/bin/sh
-#
-# @name SIH Tailsitter Duo
-#
-# @type Simulation
-# @class VTOL
-#
-# @output MAIN1 motor right
-# @output MAIN2 motor left
-# @output MAIN5 elevon right
-# @output MAIN6 elevon left
-#
-# @maintainer Romain Chiappinelli <romain.chiap@gmail.com>
-#
-# @board px4_fmu-v2 exclude
-#
-
-. ${R}etc/init.d/rc.vtol_defaults
-
-param set UAVCAN_ENABLE 0
-param set-default VT_ELEV_MC_LOCK 0
-param set-default VT_MOT_COUNT 2
-param set-default VT_TYPE 0
-param set-default VT_FW_DIFTHR_EN 1
-param set-default VT_FW_DIFTHR_SC 0.3
-param set-default MPC_MAN_Y_MAX 60
-param set-default MC_PITCH_P 5
-
-param set-default CA_AIRFRAME 4
-param set-default CA_ROTOR_COUNT 2
-param set-default CA_ROTOR0_KM -0.05
-param set-default CA_ROTOR0_PY 0.2
-param set-default CA_ROTOR1_KM -0.05
-param set-default CA_ROTOR1_PY -0.2
-param set-default CA_SV_CS_COUNT 2
-param set-default CA_SV_CS0_TRQ_P 0.3
-param set-default CA_SV_CS0_TRQ_Y 0.3
-param set-default CA_SV_CS0_TYPE 5
-param set-default CA_SV_CS1_TRQ_P 0.3
-param set-default CA_SV_CS1_TRQ_Y -0.3
-param set-default CA_SV_CS1_TYPE 6
-
-param set-default HIL_ACT_FUNC1 101
-param set-default HIL_ACT_FUNC2 102
-param set-default HIL_ACT_FUNC5 202
-param set-default HIL_ACT_FUNC6 201
-param set-default HIL_ACT_REV 32
-
-param set-default MAV_TYPE 19
-
-set MIXER vtol_tailsitter_duo_sat
-
-set PWM_OUT 1234
-
-# set SYS_HITL to 2 to start the SIH and avoid sensors startup
-param set-default SYS_HITL 2
-
-# disable some checks to allow to fly:
-# - with usb
-param set-default CBRK_USB_CHK 197848
-# - without real battery
-param set-default CBRK_SUPPLY_CHK 894281
-# - without safety switch
-param set-default COM_PREARM_MODE 0
-param set-default CBRK_IO_SAFETY 22027
-
-param set-default BAT_N_CELLS 3
-
-param set SIH_T_MAX 2.0
-param set SIH_Q_MAX 0.0165
-param set SIH_MASS 0.2
-# IXX and IZZ are inverted from the thesis as the body frame is pitched by 90 deg
-param set SIH_IXX 0.00354
-param set SIH_IYY 0.000625
-param set SIH_IZZ 0.00300
-param set SIH_IXZ 0.0
-param set SIH_KDV 0.2
-param set SIH_L_ROLL 0.145
-
-# sih as tailsitter
-param set SIH_VEHICLE_TYPE 2

ROMFS/px4fmu_common/init.d/airframes/13000_generic_vtol_standard

@@ -24,38 +24,13 @@
 
 . ${R}etc/init.d/rc.vtol_defaults
 
-param set-default CA_AIRFRAME 2
-param set-default CA_ROTOR_COUNT 5
-param set-default CA_ROTOR0_PX 0.15
-param set-default CA_ROTOR0_PY 0.15
-param set-default CA_ROTOR1_PX -0.15
-param set-default CA_ROTOR1_PY -0.15
-param set-default CA_ROTOR2_PX 0.15
-param set-default CA_ROTOR2_PY -0.15
-param set-default CA_ROTOR2_KM -0.05
-param set-default CA_ROTOR3_PX -0.15
-param set-default CA_ROTOR3_PY 0.15
-param set-default CA_ROTOR3_KM -0.05
-param set-default CA_ROTOR4_AX 1.0
-param set-default CA_ROTOR4_AZ 0.0
-param set-default CA_ROTOR4_PX 0.2
-param set-default CA_SV_CS_COUNT 4
-param set-default CA_SV_CS0_TYPE 1
-param set-default CA_SV_CS0_TRQ_R -0.5
-param set-default CA_SV_CS1_TYPE 2
-param set-default CA_SV_CS1_TRQ_R 0.5
-param set-default CA_SV_CS2_TYPE 3
-param set-default CA_SV_CS2_TRQ_P 1.0
-param set-default CA_SV_CS3_TRQ_Y 1.0
-param set-default CA_SV_CS3_TYPE 4
 
 param set-default PWM_AUX_DIS5 950
 
 param set-default VT_TYPE 2
 param set-default VT_MOT_ID 1234
 param set-default VT_FW_MOT_OFFID 1234
-
-param set-default MAV_TYPE 22
+set MAV_TYPE 22
 
 set MIXER quad_x
 set MIXER_AUX vtol_AAERT

ROMFS/px4fmu_common/init.d/airframes/13001_caipirinha_vtol

@@ -19,6 +19,7 @@
 
 . ${R}etc/init.d/rc.vtol_defaults
 
+
 param set-default MAV_TYPE 19
 
 param set-default MC_ROLL_P 6
@@ -37,6 +38,7 @@ param set-default VT_IDLE_PWM_MC  1080
 param set-default VT_ELEV_MC_LOCK 0
 param set-default VT_MOT_ID 12
 param set-default VT_TYPE 0
+set MAV_TYPE 19
 
 set MIXER vtol_tailsitter_duo
 

ROMFS/px4fmu_common/init.d/airframes/13002_firefly6

@@ -23,7 +23,6 @@
 
 . ${R}etc/init.d/rc.vtol_defaults
 
-param set-default MAV_TYPE 21
 
 param set-default MC_ROLL_P 7
 param set-default MC_ROLLRATE_P 0.19
@@ -46,6 +45,7 @@ param set-default VT_TILT_TRANS 0.5
 param set-default VT_TILT_FW 0.9
 param set-default VT_ELEV_MC_LOCK 0
 param set-default VT_TYPE 1
+set MAV_TYPE 21
 
 set MIXER firefly6
 set MIXER_AUX firefly6

ROMFS/px4fmu_common/init.d/airframes/13003_quad_tailsitter

@@ -13,33 +13,13 @@
 
 . ${R}etc/init.d/rc.vtol_defaults
 
-param set-default MAV_TYPE 20
-
-param set-default CA_AIRFRAME 4
-param set-default CA_ROTOR_COUNT 4
-param set-default CA_ROTOR0_PX 0.15
-param set-default CA_ROTOR0_PY 0.15
-param set-default CA_ROTOR1_PX -0.15
-param set-default CA_ROTOR1_PY -0.15
-param set-default CA_ROTOR2_PX 0.15
-param set-default CA_ROTOR2_PY -0.15
-param set-default CA_ROTOR2_KM -0.05
-param set-default CA_ROTOR3_PX -0.15
-param set-default CA_ROTOR3_PY 0.15
-param set-default CA_ROTOR3_KM -0.05
-param set-default CA_SV_CS_COUNT 2
-param set-default CA_SV_CS0_TRQ_P 0.5
-param set-default CA_SV_CS0_TRQ_Y 0.5
-param set-default CA_SV_CS0_TYPE 5
-param set-default CA_SV_CS1_TRQ_P 0.5
-param set-default CA_SV_CS1_TRQ_Y -0.5
-param set-default CA_SV_CS1_TYPE 6
 
 param set-default PWM_MAIN_MAX 2000
 
 param set-default VT_MOT_ID 1234
 param set-default VT_IDLE_PWM_MC  1080
 param set-default VT_TYPE 0
+set MAV_TYPE 20
 
 set MIXER quad_x_vtol
 

ROMFS/px4fmu_common/init.d/airframes/13004_quad+_tailsitter

@@ -22,13 +22,13 @@
 
 . ${R}etc/init.d/rc.vtol_defaults
 
-param set-default MAV_TYPE 20
-
 param set-default PWM_MAIN_MAX 2000
 
 param set-default VT_IDLE_PWM_MC  1080
 param set-default VT_TYPE 0
 
+set MAV_TYPE 20
+
 set MIXER quad_+_vtol
 
 set PWM_OUT 1234

ROMFS/px4fmu_common/init.d/airframes/13005_vtol_AAERT_quad

@@ -52,6 +52,7 @@ param set-default VT_MOT_ID 1234
 param set-default VT_FW_MOT_OFFID 1234
 param set-default VT_IDLE_PWM_MC 1080
 param set-default VT_TYPE 2
+set MAV_TYPE 22
 
 set MIXER quad_x
 set MIXER_AUX vtol_AAERT

ROMFS/px4fmu_common/init.d/airframes/13006_vtol_standard_delta

@@ -41,6 +41,7 @@ param set-default VT_FW_MOT_OFFID 1234
 param set-default VT_F_TRANS_THR 0.75
 param set-default VT_IDLE_PWM_MC 1080
 param set-default VT_TYPE 2
+set MAV_TYPE 22
 
 set MIXER quad_x
 set MIXER_AUX vtol_delta

ROMFS/px4fmu_common/init.d/airframes/13007_vtol_AAVVT_quad

@@ -33,6 +33,7 @@ param set-default VT_MOT_ID 1234
 param set-default VT_FW_MOT_OFFID 1234
 param set-default VT_IDLE_PWM_MC 1080
 param set-default VT_TYPE 2
+set MAV_TYPE 22
 
 set MIXER quad_x
 set MIXER_AUX vtol_AAVVT

ROMFS/px4fmu_common/init.d/airframes/13008_QuadRanger

@@ -46,6 +46,7 @@ param set-default VT_IDLE_PWM_MC 1080
 param set-default VT_MOT_ID 1234
 param set-default VT_FW_MOT_OFFID 1234
 param set-default VT_TYPE 2
+set MAV_TYPE 22
 
 set MIXER quad_x
 set MIXER_AUX vtol_AAERT

ROMFS/px4fmu_common/init.d/airframes/13009_vtol_spt_ranger

@@ -77,6 +77,8 @@ param set-default VT_TRANS_MIN_TM 5
 param set-default VT_TRANS_TIMEOUT    30
 param set-default VT_TYPE 2
 
+set MAV_TYPE 22
+
 set MIXER quad_x
 set MIXER_AUX vtol_AAERT
 

ROMFS/px4fmu_common/init.d/airframes/13010_claire

@@ -13,8 +13,6 @@
 
 . ${R}etc/init.d/rc.vtol_defaults
 
-param set-defualt MAV_TYPE 21
-
 param set-default PWM_AUX_DISARM 1000
 param set-default PWM_AUX_MAX 2000
 param set-default PWM_AUX_MIN 1000
@@ -30,6 +28,7 @@ param set-default VT_TILT_MC 0.08
 param set-default VT_TILT_TRANS 0.5
 param set-default VT_ELEV_MC_LOCK 0
 param set-default VT_TYPE 1
+set MAV_TYPE 21
 
 set MIXER claire
 set MIXER_AUX claire

ROMFS/px4fmu_common/init.d/airframes/13012_convergence

@@ -22,8 +22,6 @@
 
 . ${R}etc/init.d/rc.vtol_defaults
 
-param set-defualt MAV_TYPE 21
-
 param set-default CBRK_AIRSPD_CHK 162128
 
 param set-default FW_ARSP_MODE 1
@@ -66,6 +64,7 @@ param set-default VT_TRANS_MIN_TM 1.2
 param set-default VT_TRANS_P2_DUR 1.3
 param set-default VT_ELEV_MC_LOCK 0
 param set-default VT_TYPE 1
+set MAV_TYPE 21
 
 set MIXER vtol_convergence
 

ROMFS/px4fmu_common/init.d/airframes/13013_deltaquad

@@ -22,8 +22,6 @@
 
 . ${R}etc/init.d/rc.vtol_defaults
 
-param set-default MAV_TYPE 22
-
 param set-default BAT1_CAPACITY 23000
 param set-default BAT1_N_CELLS 4
 param set-default BAT1_R_INTERNAL 0.0025
@@ -136,6 +134,7 @@ param set-default VT_TRANS_TIMEOUT 22
 param set-default VT_F_TRANS_RAMP 4
 
 param set-default COM_RC_OVERRIDE 0
+set MAV_TYPE 22
 
 set MIXER deltaquad
 set MIXER_AUX pass

ROMFS/px4fmu_common/init.d/airframes/13014_vtol_babyshark

@@ -23,8 +23,6 @@
 
 . ${R}etc/init.d/rc.vtol_defaults
 
-param set-default MAV_TYPE 22
-
 param set-default BAT1_N_CELLS 6
 
 param set-default FW_AIRSPD_MAX 30
@@ -96,6 +94,8 @@ param set-default VT_PSHER_RMP_DT 2
 param set-default VT_TRANS_MIN_TM 4
 param set-default VT_TYPE 2
 
+set MAV_TYPE 22
+
 set MIXER babyshark
 set MIXER_AUX pass
 

ROMFS/px4fmu_common/init.d/airframes/13030_generic_vtol_quad_tiltrotor

@@ -27,37 +27,11 @@
 
 . ${R}etc/init.d/rc.vtol_defaults
 
-param set-default MAV_TYPE 21
-
 param set-default VT_IDLE_PWM_MC 1100
 param set-default VT_TYPE 1
 param set-default VT_MOT_ID 1234
 param set-default VT_FW_MOT_OFFID 24
-
-param set-default CA_AIRFRAME 3
-param set-default CA_ROTOR_COUNT 4
-param set-default CA_ROTOR0_PX 0.15
-param set-default CA_ROTOR0_PY 0.15
-param set-default CA_ROTOR0_TILT 1
-param set-default CA_ROTOR1_PX -0.15
-param set-default CA_ROTOR1_PY -0.15
-param set-default CA_ROTOR1_TILT 2
-param set-default CA_ROTOR2_PX 0.15
-param set-default CA_ROTOR2_PY -0.15
-param set-default CA_ROTOR2_KM -0.05
-param set-default CA_ROTOR2_TILT 3
-param set-default CA_ROTOR3_PX -0.15
-param set-default CA_ROTOR3_PY 0.15
-param set-default CA_ROTOR3_KM -0.05
-param set-default CA_ROTOR3_TILT 4
-param set-default CA_SV_CS_COUNT 4
-param set-default CA_SV_CS1_TRQ_R 0.5
-param set-default CA_SV_CS1_TYPE 2
-param set-default CA_SV_CS2_TRQ_P 1.0
-param set-default CA_SV_CS2_TYPE 3
-param set-default CA_SV_CS3_TRQ_Y 1.0
-param set-default CA_SV_CS3_TYPE 4
-param set-default CA_SV_TL_COUNT 4
+set MAV_TYPE 21
 
 set MIXER quad_x
 set MIXER_AUX vtol_TTTTAAER

ROMFS/px4fmu_common/init.d/airframes/13050_generic_vtol_octo

@@ -31,6 +31,7 @@ param set-default PWM_AUX_DIS5 950
 param set-default VT_TYPE 2
 param set-default VT_MOT_ID 12345678
 param set-default VT_FW_MOT_OFFID 12345678
+set MAV_TYPE 22
 
 set MIXER octo_cox
 set MIXER_AUX vtol_AAERT

ROMFS/px4fmu_common/init.d/airframes/13200_generic_vtol_tailsitter

@@ -19,26 +19,12 @@
 
 . ${R}etc/init.d/rc.vtol_defaults
 
-param set-default MAV_TYPE 19
-
 param set-default VT_ELEV_MC_LOCK 0
 param set-default VT_MOT_COUNT 2
 param set-default VT_TYPE 0
 
-param set-default CA_AIRFRAME 4
-param set-default CA_ROTOR_COUNT 2
-param set-default CA_ROTOR0_KM -0.05
-param set-default CA_ROTOR0_PY 0.2
-param set-default CA_ROTOR1_KM -0.05
-param set-default CA_ROTOR1_PY -0.2
-param set-default CA_SV_CS_COUNT 2
-param set-default CA_SV_CS0_TRQ_P 0.5
-param set-default CA_SV_CS0_TRQ_Y 0.5
-param set-default CA_SV_CS0_TYPE 5
-param set-default CA_SV_CS1_TRQ_P 0.5
-param set-default CA_SV_CS1_TRQ_Y -0.5
-param set-default CA_SV_CS1_TYPE 6
-
+param set-default MAV_TYPE 19
+set MAV_TYPE 19
 set MIXER vtol_tailsitter_duo
 
 set PWM_OUT 1234

ROMFS/px4fmu_common/init.d/airframes/14001_tri_y_yaw+

@@ -18,7 +18,4 @@
 
 . ${R}etc/init.d/rc.mc_defaults
 
-# MAV_TYPE_TRICOPTER 15
-param set-default MAV_TYPE 15
-
 set MIXER tri_y_yaw+

ROMFS/px4fmu_common/init.d/airframes/14002_tri_y_yaw-

@@ -18,7 +18,4 @@
 
 . ${R}etc/init.d/rc.mc_defaults
 
-# MAV_TYPE_TRICOPTER 15
-param set-default MAV_TYPE 15
-
 set MIXER tri_y_yaw-

ROMFS/px4fmu_common/init.d/airframes/15001_coax_heli

@@ -17,9 +17,7 @@
 #
 
 . ${R}etc/init.d/rc.mc_defaults
-
-# MAV_TYPE_COAXIAL 3
-param set-default MAV_TYPE 3
+set MIXER coax
 
 param set-default MC_ROLLRATE_P 0.17
 param set-default MC_ROLLRATE_I 0.05
@@ -38,9 +36,6 @@ param set-default PWM_MAIN_RATE 400
 
 param set-default RTL_RETURN_ALT 30
 param set-default RTL_DESCEND_ALT 10
-
-set MIXER coax
-
 # This is the gimbal pass mixer
 set MIXER_AUX pass
 

ROMFS/px4fmu_common/init.d/airframes/16001_helicopter

@@ -20,7 +20,7 @@
 . ${R}etc/init.d/rc.mc_defaults
 
 # Configure as helicopter (number 4 defined in commander_helper.cpp)
-param set-default MAV_TYPE 4
+set MAV_TYPE 4
 
 set MIXER blade130
 

ROMFS/px4fmu_common/init.d/airframes/17003_TF-G2

@@ -41,6 +41,5 @@ param set-default FW_R_LIM 40
 param set-default FW_P_LIM_MAX 25
 param set-default FW_P_LIM_MIN -5
 param set-default FW_P_RMAX_NEG 20
-
 set MIXER TF-G2
 set MIXER_AUX pass

ROMFS/px4fmu_common/init.d/airframes/18001_TF-B1

@@ -24,5 +24,8 @@ param set-default MAV_0_CONFIG 102
 param set-default GPS_UBX_DYNMODEL 8
 param set-default SER_TEL2_BAUD 9600
 
+set MAV_TYPE 8
+param set MAV_TYPE ${MAV_TYPE}
+
 set MIXER IO_pass
 set MIXER_AUX pass

ROMFS/px4fmu_common/init.d/airframes/2100_standard_plane

@@ -23,18 +23,6 @@
 
 . ${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
-param set-default CA_SV_CS0_TRQ_R -0.5
-param set-default CA_SV_CS1_TRQ_R 0.5
-param set-default CA_SV_CS1_TYPE 2
-param set-default CA_SV_CS2_TRQ_P 1.0
-param set-default CA_SV_CS2_TYPE 3
-param set-default CA_SV_CS3_TRQ_Y 1.0
-param set-default CA_SV_CS3_TYPE 4
-
 param set-default PWM_AUX_RATE 50
 param set-default PWM_MAIN_RATE 50
 

ROMFS/px4fmu_common/init.d/airframes/24001_dodeca_cox

@@ -26,7 +26,7 @@
 # @board px4_fmu-v2 exclude
 #
 
-. ${R}etc/init.d/rc.mc_defaults
+set VEHICLE_TYPE mc
 
 param set-default NAV_ACC_RAD 2
 
@@ -39,7 +39,6 @@ param set-default PWM_MAIN_RATE 400
 
 param set-default RTL_DESCEND_ALT 10
 param set-default RTL_RETURN_ALT 30
-
 set MIXER dodeca_top_cox
 set MIXER_AUX dodeca_bottom_cox
 

ROMFS/px4fmu_common/init.d/airframes/3033_wingwing

@@ -41,6 +41,9 @@ param set-default FW_RR_P 0.04
 
 param set-default PWM_MAIN_DISARM 1000
 
+# Configure this as plane.
+set MAV_TYPE 1
+
 # Set mixer.
 set MIXER fw_generic_wing
 

ROMFS/px4fmu_common/init.d/airframes/4001_quad_x

@@ -21,16 +21,3 @@
 #
 
 . ${R}etc/init.d/rc.mc_defaults
-
-param set-default CA_ROTOR_COUNT 4
-param set-default CA_ROTOR0_PX 0.15
-param set-default CA_ROTOR0_PY 0.15
-param set-default CA_ROTOR1_PX -0.15
-param set-default CA_ROTOR1_PY -0.15
-param set-default CA_ROTOR2_PX 0.15
-param set-default CA_ROTOR2_PY -0.15
-param set-default CA_ROTOR2_KM -0.05
-param set-default CA_ROTOR3_PX -0.15
-param set-default CA_ROTOR3_PY 0.15
-param set-default CA_ROTOR3_KM -0.05
-

ROMFS/px4fmu_common/init.d/airframes/4018_s500_ctrlalloc

@@ -0,0 +1,39 @@
+#!/bin/sh
+#
+# @name S500 with control allocation
+#
+# @type Quadrotor x
+# @class Copter
+#
+# @maintainer Silvan Fuhrer
+#
+# @board px4_fmu-v2 exclude
+#
+
+. ${R}etc/init.d/rc.mc_defaults
+
+set MIXER skip
+set MIXER_AUX none
+
+param set-default SYS_CTRL_ALLOC 1
+
+param set-default CA_AIRFRAME 0
+
+param set-default CA_ROTOR_COUNT 4
+param set-default CA_ROTOR0_PX 0.177
+param set-default CA_ROTOR0_PY 0.177
+param set-default CA_ROTOR0_KM 0.05
+param set-default CA_ROTOR1_PX -0.177
+param set-default CA_ROTOR1_PY -0.177
+param set-default CA_ROTOR1_KM 0.05
+param set-default CA_ROTOR2_PX 0.177
+param set-default CA_ROTOR2_PY -0.177
+param set-default CA_ROTOR2_KM -0.05
+param set-default CA_ROTOR3_PX -0.177
+param set-default CA_ROTOR3_PY 0.177
+param set-default CA_ROTOR3_KM -0.05
+
+param set-default PWM_MAIN_FUNC1 101
+param set-default PWM_MAIN_FUNC2 102
+param set-default PWM_MAIN_FUNC3 103
+param set-default PWM_MAIN_FUNC4 104

ROMFS/px4fmu_common/init.d/airframes/4019_x500_v2

@@ -1,23 +0,0 @@
-#!/bin/sh
-#
-# @name Holybro X500 V2
-#
-# @type Quadrotor x
-# @class Copter
-#
-# @maintainer Farhang Naderi <farhang.nba@gmail.com>
-#
-# @board px4_fmu-v2 exclude
-# @board bitcraze_crazyflie exclude
-#
-
-. ${R}etc/init.d/rc.mc_defaults
-
-param set-default IMU_GYRO_CUTOFF 30
-
-param set-default MC_ROLLRATE_P 0.14
-param set-default MC_PITCHRATE_P 0.14
-param set-default MC_ROLLRATE_I 0.3
-param set-default MC_PITCHRATE_I 0.3
-param set-default MC_ROLLRATE_D 0.004
-param set-default MC_PITCHRATE_D 0.004

ROMFS/px4fmu_common/init.d/airframes/4051_s250aq

@@ -24,6 +24,8 @@
 
 set MIXER quad_s250aq
 
+set MAV_TYPE 2
+
 param set-default ATT_BIAS_MAX 0
 
 param set-default CBRK_IO_SAFETY 22027

ROMFS/px4fmu_common/init.d/airframes/4061_atl_mantis_edu

@@ -16,10 +16,8 @@
 
 . ${R}etc/init.d/rc.mc_defaults
 
-# We set the mixer and ESC manually.
-set MIXER skip
-set MIXER_AUX skip
-set MIXER_FILE ""
+set MIXER none
+set MIXER_AUX none
 
 # Battery settings
 param set-default BAT_CRIT_THR 0.20
@@ -35,18 +33,17 @@ param set-default CBRK_SUPPLY_CHK 894281
 
 param set-default COM_DISARM_LAND 0.1
 param set-default COM_DISARM_PRFLT 3
-param set-default COM_DL_LOSS_T 10
-param set-default COM_FLTMODE1  2
+param set-default COM_FLTMODE1 -1
 param set-default COM_FLTMODE2 -1
 param set-default COM_FLTMODE3 -1
-param set-default COM_FLTMODE4 -1
+param set-default COM_FLTMODE4  2
 param set-default COM_FLTMODE5 -1
-param set-default COM_FLTMODE6  1
+param set-default COM_FLTMODE6  6
 param set-default COM_RC_LOSS_T 3
 
 
 # ekf2
-param set-default EKF2_AID_MASK 33
+param set-default EKF2_AID_MASK 35
 param set-default EKF2_BARO_DELAY 0
 param set-default EKF2_BARO_NOISE 2.0
 
@@ -71,9 +68,6 @@ param set-default EKF2_OF_GATE 2.0
 param set-default EKF2_OF_POS_X -0.035
 param set-default EKF2_OF_POS_Y 0.0
 param set-default EKF2_OF_POS_Z 0.033
-param set-default EKF2_OF_MIN_RNG 0.01
-param set-default EKF2_OF_A_HMAX 7.0
-param set-default EKF2_OF_QMIN 30
 
 param set-default EKF2_PCOEF_XN -0.3
 param set-default EKF2_PCOEF_XP -0.4
@@ -147,33 +141,58 @@ param set-default MPC_Z_VEL_P 0.27
 
 
 # gimbal configuration
-param set-default MNT_MODE_IN 0
-param set-default MNT_MODE_OUT 1
-param set-default MNT_MAN_PITCH 2
-param set-default MNT_RC_IN_MODE 1
-param set-default MNT_RATE_PITCH 30
+param set-default MNT_MODE_IN 1
+param set-default MNT_MODE_OUT 2
+param set-default MNT_MAN_PITCH 1
+
 
 # RC
 param set-default RC_CHAN_CNT       12
 
 param set-default RC_MAP_THROTTLE   1
-param set-default RC_MAP_YAW        2
+param set-default RC_MAP_ROLL       2
 param set-default RC_MAP_PITCH      3
-param set-default RC_MAP_ROLL       4
-param set-default RC_MAP_AUX2       5
-param set-default RC_MAP_AUX3       10
-param set-default RC_MAP_AUX4       8
-param set-default RC_MAP_FLTMODE    6
-param set-default RC_MAP_RETURN_SW  7
+param set-default RC_MAP_YAW        4
+param set-default RC_MAP_FLTMODE    5
+param set-default RC_MAP_AUX1       7
 
-param set-default RC1_TRIM          1000
+param set-default RC1_DZ            10
+param set-default RC1_MAX           3413
+param set-default RC1_MIN           683
+param set-default RC1_REV           1
+param set-default RC1_TRIM          683
+param set-default RC2_DZ            10
+param set-default RC2_MAX           3413
+param set-default RC2_MIN           683
+param set-default RC2_REV           -1
+param set-default RC2_TRIM          2048
+param set-default RC3_DZ            10
+param set-default RC3_MAX           3413
+param set-default RC3_MIN           683
+param set-default RC3_REV           1
+param set-default RC3_TRIM          2048
+param set-default RC4_DZ            10
+param set-default RC4_MAX           3413
+param set-default RC4_MIN           683
+param set-default RC4_REV           -1
+param set-default RC4_TRIM          2048
+param set-default RC5_DZ            10
+param set-default RC5_MAX           3414
+param set-default RC5_MIN           2048
+param set-default RC5_REV           1
+param set-default RC5_TRIM          2048
+param set-default RC7_DZ            10
+param set-default RC7_MAX           3413
+param set-default RC7_MIN           683
+param set-default RC7_REV           1
+param set-default RC7_TRIM          2048
 
 
 # optical flow
 param set-default SENS_FLOW_MAXR   7.4
 param set-default SENS_FLOW_MINHGT 0.15
 param set-default SENS_FLOW_MAXHGT 5.0
-param set-default SENS_FLOW_ROT    0
+param set-default SENS_FLOW_ROT    4
 
-# ignore the SD card errors and use normal startup sound
-set STARTUP_TUNE "1"
+
+mixer load /dev/tap_esc /etc/mixers/quad_x.main.mix

ROMFS/px4fmu_common/init.d/airframes/4071_ifo

@@ -21,7 +21,10 @@
 # @board cuav_x7pro exclude
 #
 
-. ${R}etc/init.d/rc.mc_defaults
+set VEHICLE_TYPE mc
+set MIXER quad_x
+set PWM_OUT 1234
+
 
 # Attitude & rate gains
 param set-default MC_ROLLRATE_D 0.0013

ROMFS/px4fmu_common/init.d/airframes/4073_ifo-s

@@ -21,7 +21,10 @@
 # @maintainer Hyon Lim <lim@uvify.com>
 #
 
-. ${R}etc/init.d/rc.mc_defaults
+set VEHICLE_TYPE mc
+set MIXER quad_x
+set PWM_OUT 1234
+
 
 # Attitude & rate gains
 param set-default MC_ROLLRATE_D 0.0013

ROMFS/px4fmu_common/init.d/airframes/4100_tiltquadrotor

@@ -24,6 +24,10 @@
 
 . ${R}etc/init.d/rc.mc_defaults
 
+
+# Configure this as Quadrotor
+# set MAV_TYPE 14
+
 # Set mixer
 set MIXER tilt_quad
 set MIXER_AUX tilt_quad

ROMFS/px4fmu_common/init.d/airframes/50000_generic_ground_vehicle

@@ -48,6 +48,8 @@ param set-default NAV_ACC_RAD 0.5
 param set-default PWM_MAIN_DISARM 1500
 param set-default PWM_MAIN_MAX 2000
 param set-default PWM_MAIN_MIN 1000
+# Configure this as rover
+set MAV_TYPE 10
 
 # Set mixer
 set MIXER rover_generic

ROMFS/px4fmu_common/init.d/airframes/50003_aion_robotics_r1_rover

@@ -76,6 +76,9 @@ param set-default RBCLW_SER_CFG 104
 # Start this driver after setting parameters, because the driver uses some of those parameters.
 # roboclaw start /dev/ttyS3
 
+# Configure this as rover
+set MAV_TYPE 10
+
 # Set mixer
 set MIXER generic_diff_rover
 

ROMFS/px4fmu_common/init.d/airframes/50004_nxpcup_car_dfrobot_gpx

@@ -65,6 +65,9 @@ param set-default PWM_MAIN_MIN4 970
 # Enable Airspeed check circuit breaker because Rovers will have no airspeed sensor
 param set-default CBRK_AIRSPD_CHK 162128
 
+# Configure this as rover
+set MAV_TYPE 10
+
 # Set mixer
 set MIXER rover_diff_and_servo
 

ROMFS/px4fmu_common/init.d/airframes/60000_uuv_generic

@@ -16,4 +16,7 @@
 # disable circuit breaker for airspeed sensor
 param set-default CBRK_AIRSPD_CHK 162128
 
+set MAV_TYPE 12
+param set MAV_TYPE ${MAV_TYPE}
+
 set MIXER uuv_x

ROMFS/px4fmu_common/init.d/airframes/60001_uuv_hippocampus

@@ -16,4 +16,7 @@
 # disable circuit breaker for airspeed sensor
 param set-default CBRK_AIRSPD_CHK 162128
 
+set MAV_TYPE 12
+param set MAV_TYPE ${MAV_TYPE}
+
 set MIXER uuv_x

ROMFS/px4fmu_common/init.d/airframes/6001_hexa_x

@@ -23,26 +23,6 @@
 
 . ${R}etc/init.d/rc.mc_defaults
 
-# MAV_TYPE_HEXAROTOR 13
-param set-default MAV_TYPE 13
-
-param set-default CA_ROTOR_COUNT 6
-param set-default CA_ROTOR0_PX 0.0
-param set-default CA_ROTOR0_PY 0.5
-param set-default CA_ROTOR0_KM -0.05
-param set-default CA_ROTOR1_PX 0.0
-param set-default CA_ROTOR1_PY -0.5
-param set-default CA_ROTOR2_PX 0.43
-param set-default CA_ROTOR2_PY -0.25
-param set-default CA_ROTOR2_KM -0.05
-param set-default CA_ROTOR3_PX -0.43
-param set-default CA_ROTOR3_PY 0.25
-param set-default CA_ROTOR4_PX 0.43
-param set-default CA_ROTOR4_PY 0.25
-param set-default CA_ROTOR5_PX -0.43
-param set-default CA_ROTOR5_PY -0.25
-param set-default CA_ROTOR5_KM -0.05
-
 set MIXER hexa_x
 
 # Need to set all 8 channels

ROMFS/px4fmu_common/init.d/airframes/6002_draco_r

@@ -27,8 +27,9 @@
 
 . ${R}etc/init.d/rc.mc_defaults
 
-# MAV_TYPE_HEXAROTOR 13
-param set-default MAV_TYPE 13
+set MIXER hexa_x
+set PWM_OUT 12345678
+
 
 ###############################################
 # Attitude & rate gains
@@ -119,7 +120,3 @@ param set-default MAV_1_MODE 2
 param set-default MAV_1_FORWARD 1
 param set-default MAV_1_RATE 800000
 param set-default SER_TEL2_BAUD 921600
-
-
-set MIXER hexa_x
-set PWM_OUT 12345678

ROMFS/px4fmu_common/init.d/airframes/6003_hexa_x_ctrlalloc

@@ -0,0 +1,52 @@
+#!/bin/sh
+#
+# @name Hex X with control allocation
+#
+# @type Hexarotor x
+# @class Copter
+#
+# @maintainer Silvan Fuhrer
+#
+# @board px4_fmu-v2 exclude
+#
+
+. ${R}etc/init.d/rc.mc_defaults
+
+param set-default SYS_CTRL_ALLOC 1
+
+param set-default CA_AIRFRAME 0
+param set-default CA_ROTOR_COUNT 6
+
+param set-default CA_ROTOR0_PX 0.0
+param set-default CA_ROTOR0_PY 0.275
+param set-default CA_ROTOR0_KM -0.05
+
+param set-default CA_ROTOR1_PX 0.0
+param set-default CA_ROTOR1_PY -0.275
+param set-default CA_ROTOR1_KM 0.05
+
+param set-default CA_ROTOR2_PX 0.238
+param set-default CA_ROTOR2_PY -0.1375
+param set-default CA_ROTOR2_KM -0.05
+
+param set-default CA_ROTOR3_PX -0.238
+param set-default CA_ROTOR3_PY 0.1375
+param set-default CA_ROTOR3_KM 0.05
+
+param set-default CA_ROTOR4_PX 0.238
+param set-default CA_ROTOR4_PY 0.1375
+param set-default CA_ROTOR4_KM 0.05
+
+param set-default CA_ROTOR5_PX -0.238
+param set-default CA_ROTOR5_PY -0.1375
+param set-default CA_ROTOR5_KM -0.05
+
+param set-default PWM_MAIN_FUNC1 101
+param set-default PWM_MAIN_FUNC2 102
+param set-default PWM_MAIN_FUNC3 103
+param set-default PWM_MAIN_FUNC4 104
+param set-default PWM_MAIN_FUNC5 105
+param set-default PWM_MAIN_FUNC6 106
+
+set MIXER skip
+set MIXER_AUX none

ROMFS/px4fmu_common/init.d/airframes/7001_hexa_+

@@ -23,26 +23,6 @@
 
 . ${R}etc/init.d/rc.mc_defaults
 
-# MAV_TYPE_HEXAROTOR 13
-param set-default MAV_TYPE 13
-
-param set-default CA_ROTOR_COUNT 6
-param set-default CA_ROTOR0_PX 0.5
-param set-default CA_ROTOR0_PY 0.0
-param set-default CA_ROTOR0_KM -0.05
-param set-default CA_ROTOR1_PX -0.5
-param set-default CA_ROTOR1_PY 0.0
-param set-default CA_ROTOR2_PX -0.25
-param set-default CA_ROTOR2_PY -0.43
-param set-default CA_ROTOR2_KM -0.05
-param set-default CA_ROTOR3_PX 0.25
-param set-default CA_ROTOR3_PY 0.43
-param set-default CA_ROTOR4_PX 0.25
-param set-default CA_ROTOR4_PY -0.43
-param set-default CA_ROTOR5_PX -0.25
-param set-default CA_ROTOR5_PY 0.43
-param set-default CA_ROTOR5_KM -0.05
-
 set MIXER hexa_+
 
 # Need to set all 8 channels

ROMFS/px4fmu_common/init.d/airframes/8001_octo_x

@@ -25,31 +25,6 @@
 
 . ${R}etc/init.d/rc.mc_defaults
 
-# MAV_TYPE_OCTOROTOR 14
-param set-default MAV_TYPE 14
-
-param set-default CA_ROTOR_COUNT 8
-param set-default CA_ROTOR0_KM -0.05
-param set-default CA_ROTOR0_PX 0.46
-param set-default CA_ROTOR0_PY 0.19
-param set-default CA_ROTOR1_KM -0.05
-param set-default CA_ROTOR1_PX -0.46
-param set-default CA_ROTOR1_PY -0.19
-param set-default CA_ROTOR2_PX 0.19
-param set-default CA_ROTOR2_PY 0.46
-param set-default CA_ROTOR3_PX -0.46
-param set-default CA_ROTOR3_PY 0.19
-param set-default CA_ROTOR4_PX 0.46
-param set-default CA_ROTOR4_PY -0.19
-param set-default CA_ROTOR5_PX -0.19
-param set-default CA_ROTOR5_PY -0.46
-param set-default CA_ROTOR6_KM -0.05
-param set-default CA_ROTOR6_PX 0.19
-param set-default CA_ROTOR6_PY -0.46
-param set-default CA_ROTOR7_KM -0.05
-param set-default CA_ROTOR7_PX -0.19
-param set-default CA_ROTOR7_PY 0.46
-
 set MIXER octo_x
 
 set PWM_OUT 12345678

ROMFS/px4fmu_common/init.d/airframes/9001_octo_+

@@ -25,9 +25,6 @@
 
 . ${R}etc/init.d/rc.mc_defaults
 
-# MAV_TYPE_OCTOROTOR 14
-param set-default MAV_TYPE 14
-
 set MIXER octo_+
 
 set PWM_OUT 12345678

ROMFS/px4fmu_common/init.d/airframes/CMakeLists.txt

@@ -40,7 +40,6 @@ px4_add_romfs_files(
 	1002_standard_vtol.hil
 	1100_rc_quad_x_sih.hil
 	1101_rc_plane_sih.hil
-	1102_tailsitter_duo_sih.hil
 
 	# [2000, 2999] Standard planes"
 	2100_standard_plane
@@ -72,7 +71,7 @@ px4_add_romfs_files(
 	4015_holybro_s500
 	4016_holybro_px4vision
 	4017_nxp_hovergames
-	4019_x500_v2
+	4018_s500_ctrlalloc
 	4030_3dr_solo
 	4031_3dr_quad
 	4040_reaper
@@ -99,6 +98,7 @@ px4_add_romfs_files(
 	# [6000, 6999] Hexarotor x"
 	6001_hexa_x
 	6002_draco_r
+	6003_hexa_x_ctrlalloc
 
 	# [7000, 7999] Hexarotor +"
 	7001_hexa_+

ROMFS/px4fmu_common/init.d/rc.airship_defaults

@@ -7,9 +7,6 @@
 
 set VEHICLE_TYPE airship
 
-# MAV_TYPE_AIRSHIP 7
-param set-default MAV_TYPE 7
-
 #
 # This is the gimbal pass mixer.
 #

ROMFS/px4fmu_common/init.d/rc.balloon_defaults

@@ -7,9 +7,6 @@
 
 set VEHICLE_TYPE fw
 
-# MAV_TYPE_FREE_BALLOON 8
-param set-default MAV_TYPE 8
-
 #
 # Default parameters for balloon UAVs.
 #

ROMFS/px4fmu_common/init.d/rc.boat_defaults

@@ -7,9 +7,6 @@
 
 set VEHICLE_TYPE rover
 
-# MAV_TYPE_SURFACE_BOAT 11
-param set-default MAV_TYPE 11
-
 #
 # Default parameters for UGVs.
 #

ROMFS/px4fmu_common/init.d/rc.fw_defaults

@@ -7,9 +7,6 @@
 
 set VEHICLE_TYPE fw
 
-# MAV_TYPE_FIXED_WING 1
-param set-default MAV_TYPE 1
-
 #
 # Default parameters for fixed wing UAVs.
 #

ROMFS/px4fmu_common/init.d/rc.interface

@@ -45,7 +45,7 @@ fi
 #
 # Set the default output mode if none was set.
 #
-if [ $OUTPUT_MODE = none -a $OUTPUT_MODE != skip ]
+if [ $OUTPUT_MODE = none ]
 then
 	if [ $USE_IO = yes ]
 	then
@@ -72,7 +72,7 @@ fi
 #
 # If OUTPUT_MODE = none then something is wrong with setup and we shouldn't try to enable output.
 #
-if [ $OUTPUT_MODE != none -a $OUTPUT_MODE != skip ]
+if [ $OUTPUT_MODE != none ]
 then
 
 	if [ $OUTPUT_MODE = hil -o $OUTPUT_MODE = sim ]

ROMFS/px4fmu_common/init.d/rc.mc_defaults

@@ -7,13 +7,7 @@
 
 set VEHICLE_TYPE mc
 
-# MAV_TYPE_QUADROTOR 2
-param set-default MAV_TYPE 2
-
-if param compare IMU_GYRO_RATEMAX 400
-then
-	param set-default IMU_GYRO_RATEMAX 800
-fi
+param set-default IMU_GYRO_RATEMAX 800
 
 param set-default NAV_ACC_RAD 2
 

ROMFS/px4fmu_common/init.d/rc.rover_defaults

@@ -7,9 +7,6 @@
 
 set VEHICLE_TYPE rover
 
-# MAV_TYPE_GROUND_ROVER 10
-param set-default MAV_TYPE 10
-
 #
 # Default parameters for UGVs.
 #

ROMFS/px4fmu_common/init.d/rc.sensors

@@ -130,13 +130,6 @@ then
 	fi
 fi
 
-# SHT3x temperature and hygrometer sensor, external I2C
-if param compare -s SENS_EN_SHT3X 1
-then
-	sht3x start -X
-	sht3x start -X -a 0x45
-fi
-
 # TE MS4525 differential pressure sensor external I2C
 if param compare -s SENS_EN_MS4525 1
 then
@@ -149,26 +142,6 @@ then
 	ms5525_airspeed start -X
 fi
 
-# IR-LOCK sensor external I2C
-if param compare -s SENS_EN_IRLOCK 1
-then
-	irlock start -X
-fi
-
-# SPL06 sensor external I2C
-if param compare -s SENS_EN_SPL06 1
-then
-	spl06 -X start
-	spl06 -X -a 0x77 start
-fi
-
-# PCF8583 counter (RPM sensor)
-if param compare -s SENS_EN_PCF8583 1
-then
-	pcf8583 start -X
-	pcf8583 start -X -a 0x51
-fi
-
 # probe for optional external I2C devices
 if param compare SENS_EXT_I2C_PRB 1
 then

ROMFS/px4fmu_common/init.d/rc.uuv_defaults

@@ -7,9 +7,6 @@
 
 set VEHICLE_TYPE uuv
 
-# MAV_TYPE_SUBMARINE 12
-param set-default MAV_TYPE 12
-
 param set-default PWM_MAIN_MAX 1950
 param set-default PWM_MAIN_MIN 1050
 param set-default PWM_MAIN_DISARM 1500

ROMFS/px4fmu_common/init.d/rc.vehicle_setup

@@ -12,9 +12,19 @@ if [ $VEHICLE_TYPE = fw ]
 then
 	if [ $MIXER = none ]
 	then
-		echo "FW mixer undefined"
+		# Set default mixer for fixed wing if not defined.
+		set MIXER AERT
 	fi
 
+	if [ $MAV_TYPE = none ]
+	then
+		# Set a default MAV_TYPE = 1 if not defined.
+		set MAV_TYPE 1
+	fi
+
+	# Set the mav type parameter.
+	param set MAV_TYPE ${MAV_TYPE}
+
 	# Load mixer and configure outputs.
 	. ${R}etc/init.d/rc.interface
 
@@ -32,6 +42,41 @@ then
 		echo "MC mixer undefined"
 	fi
 
+	if [ $MAV_TYPE = none ]
+	then
+		# Set a default MAV_TYPE = 2 if not defined.
+		set MAV_TYPE 2
+
+		# Use mixer to detect vehicle type
+		if [ $MIXER = coax ]
+		then
+			set MAV_TYPE 3
+		fi
+		if [ $MIXER = hexa_x -o $MIXER = hexa_+ ]
+		then
+			set MAV_TYPE 13
+		fi
+		if [ $MIXER = hexa_cox ]
+		then
+			set MAV_TYPE 13
+		fi
+		if [ $MIXER = octo_x -o $MIXER = octo_+ ]
+		then
+			set MAV_TYPE 14
+		fi
+		if [ $MIXER = octo_cox -o $MIXER = octo_cox_w ]
+		then
+			set MAV_TYPE 14
+		fi
+		if [ $MIXER = tri_y_yaw- -o $MIXER = tri_y_yaw+ ]
+		then
+			set MAV_TYPE 15
+		fi
+	fi
+
+	# Set the mav type parameter.
+	param set MAV_TYPE ${MAV_TYPE}
+
 	# Load mixer and configure outputs.
 	. ${R}etc/init.d/rc.interface
 
@@ -46,9 +91,19 @@ if [ $VEHICLE_TYPE = rover ]
 then
 	if [ $MIXER = none ]
 	then
-		echo "rover mixer undefined"
+		# Set default mixer for UGV if not defined.
+		set MIXER rover_generic
 	fi
 
+	if [ $MAV_TYPE = none ]
+	then
+		# Set a default MAV_TYPE = 10 if not defined.
+		set MAV_TYPE 10
+	fi
+
+	# Set the mav type parameter.
+	param set MAV_TYPE ${MAV_TYPE}
+
 	# Load mixer and configure outputs.
 	. ${R}etc/init.d/rc.interface
 
@@ -66,6 +121,25 @@ then
 		echo "VTOL mixer undefined"
 	fi
 
+	if [ $MAV_TYPE = none ]
+	then
+		# Set a default MAV_TYPE = 19 if not defined.
+		set MAV_TYPE 19
+
+		# Use mixer to detect vehicle type.
+		if [ $MIXER = firefly6 ]
+		then
+			set MAV_TYPE 21
+		fi
+		if [ $MIXER = quad_x_pusher_vtol ]
+		then
+			set MAV_TYPE 22
+		fi
+	fi
+
+	# Set the mav type parameter.
+	param set MAV_TYPE ${MAV_TYPE}
+
 	# Load mixer and configure outputs.
 	. ${R}etc/init.d/rc.interface
 
@@ -83,6 +157,15 @@ then
 		echo "Airship mixer undefined"
 	fi
 
+	if [ $MAV_TYPE = none ]
+	then
+		# Set a default MAV_TYPE = 7 if not defined.
+		set MAV_TYPE 7
+	fi
+
+	# Set the mav type parameter.
+	param set MAV_TYPE ${MAV_TYPE}
+
 	# Load mixer and configure outputs.
 	. ${R}etc/init.d/rc.interface
 
@@ -100,11 +183,19 @@ then
 		echo "UUV mixer undefined"
 	fi
 
+	if [ $MAV_TYPE = none ]
+	then
+		# Set default MAV_TYPE to submarine if not defined
+		set MAV_TYPE 12
+	fi
+
+	param set MAV_TYPE ${MAV_TYPE}
 	# Load mixer and configure outputs.
 	. ${R}etc/init.d/rc.interface
 
 	# Start standard vtol apps.
 	. ${R}etc/init.d/rc.uuv_apps
+
 fi
 
 

ROMFS/px4fmu_common/init.d/rc.vtol_defaults

@@ -7,9 +7,6 @@
 
 set VEHICLE_TYPE vtol
 
-# MAV_TYPE_VTOL_RESERVED2 22
-param set-default MAV_TYPE 22
-
 param set-default MIS_TAKEOFF_ALT 20
 param set-default MIS_YAW_TMT 10
 

ROMFS/px4fmu_common/init.d/rcS

@@ -29,6 +29,7 @@ set IOFW "/etc/extras/px4_io-v2_default.bin"
 set IO_PRESENT no
 set LOGGER_ARGS ""
 set LOGGER_BUF 8
+set MAV_TYPE none
 set MIXER none
 set MIXER_AUX none
 set MIXER_FILE none
@@ -290,9 +291,15 @@ else
 		# Start core UAVCAN module.
 		if uavcan start
 		then
-			if param greater UAVCAN_ENABLE 2
+			if param greater UAVCAN_ENABLE 1
 			then
-				set OUTPUT_MODE uavcan_esc
+				# Start UAVCAN firmware update server and dynamic node ID allocation server.
+				uavcan start fw
+
+				if param greater UAVCAN_ENABLE 2
+				then
+					set OUTPUT_MODE uavcan_esc
+				fi
 			fi
 		else
 			tune_control play error
@@ -408,6 +415,17 @@ else
 		commander start
 	fi
 
+
+	#
+	# Play the startup tune (if not disabled or there is an error)
+	#
+	param compare CBRK_BUZZER 782090
+	if [ $? != 0 -o $STARTUP_TUNE != 1 ]
+	then
+		tune_control play -t $STARTUP_TUNE
+	fi
+
+
 	# Pre-takeoff continuous magnetometer calibration
 	if param compare -s MBE_ENABLE 1
 	then
@@ -426,7 +444,7 @@ else
 	set BOARD_RC_MAVLINK ${R}etc/init.d/rc.board_mavlink
 	if [ -f $BOARD_RC_MAVLINK ]
 	then
-		echo "Board mavlink: ${BOARD_RC_MAVLINK}"
+		echo "Board extras: ${BOARD_RC_MAVLINK}"
 		. $BOARD_RC_MAVLINK
 	fi
 	unset BOARD_RC_MAVLINK
@@ -465,15 +483,6 @@ else
 	#
 	. ${R}etc/init.d/rc.vehicle_setup
 
-	#
-	# Play the startup tune (if not disabled or there is an error)
-	#
-	param compare CBRK_BUZZER 782090
-	if [ "$?" != "0" -o "$STARTUP_TUNE" != "1" ]
-	then
-		tune_control play -t $STARTUP_TUNE
-	fi
-
 	#
 	# Start the navigator.
 	#
@@ -485,11 +494,11 @@ else
 	. ${R}etc/init.d/rc.thermal_cal
 
 	#
-	# Start gimbal to control mounts such as gimbals, disabled by default.
+	# Start vmount to control mounts such as gimbals, disabled by default.
 	#
 	if param greater -s MNT_MODE_IN -1
 	then
-		gimbal start
+		vmount start
 	fi
 
 	# Check for flow sensor
@@ -572,6 +581,7 @@ unset IO_PRESENT
 unset IOFW
 unset LOGGER_ARGS
 unset LOGGER_BUF
+unset MAV_TYPE
 unset MIXER
 unset MIXER_AUX
 unset MIXER_FILE

ROMFS/px4fmu_common/mixers/CMakeLists.txt

@@ -90,5 +90,4 @@ px4_add_romfs_files(
 	vtol_convergence.main.mix
 	vtol_delta.aux.mix
 	vtol_tailsitter_duo.main.mix
-	vtol_tailsitter_duo_sat.main.mix
 )

ROMFS/px4fmu_common/mixers/quad_x_vtol.main.mix

@@ -1,7 +1,5 @@
 Mixer for Tailsitter with x motor configuration and elevons
 ===========================================================
-# @board px4_fmu-v2 exclude
-# @board omnibus_f4sd exclude
 
 This file defines a single mixer for tailsitter with motors in X configuration.  All controls
 are mixed 100%.

ROMFS/px4fmu_common/mixers/vtol_tailsitter_duo_sat.main.mix

@@ -1,39 +0,0 @@
-Tailsitter duo mixer
-============================
-
-This file defines a mixer for a generic duo tailsitter VTOL (eg TBS Caipirinha tailsitter edition). This vehicle
-has two motors in total, one attached to each wing. It also has two elevons which
-are located in the slipstream of the propellers. This mixer generates 4 PWM outputs
-on the main PWM ouput port, two at 400Hz for the motors, and two at 50Hz for the
-elevon servos. Channels 1-4 are configured to run at 400Hz, while channels 5-8 run
-at the default rate of 50Hz. Note that channels 3 and 4 are assigned but not used.
-
-Motor mixer
-------------
-Channel 1 connects to the right (starboard) motor.
-Channel 2 connects to the left (port) motor.
-
-R: 2-
-
-Zero mixer (2x)
----------------
-Channels 3,4 are unused.
-
-Z:
-
-Z:
-
-Elevons mixer
---------------
-Channel 5 connects to the right (starboard) elevon.
-Channel 6 connects to the left (port) elevon.
-Here we saturate the elevons before their full range
-to avoid roll-pitch-yaw coupling during faster maneuvers
-
-M: 2
-S: 1 0   10000   10000    0 -6000  6000
-S: 1 1   10000   10000    0 -6000  6000
-
-M: 2
-S: 1 0   10000   10000    0 -6000  6000
-S: 1 1  -10000  -10000    0 -6000  6000

Tools/HIL/test_airframes.sh

@@ -21,25 +21,13 @@ echo "airframes: ${ALL_AIRFRAMES}"
 for airframe in $ALL_AIRFRAMES
 do
 	echo
-	echo
-	echo
-	echo "########################################################################################################################"
+	echo "##########################################################################################"
 	echo " Airframe: $airframe"
-	echo "########################################################################################################################"
+	echo "##########################################################################################"
 	echo
 
 	${DIR}/nsh_param_set.py --device ${SERIAL_DEVICE} --name SYS_AUTOSTART  --value $airframe
 	${DIR}/nsh_param_set.py --device ${SERIAL_DEVICE} --name CBRK_BUZZER    --value 782097
-
-	# enable all mavlink instances
-	${DIR}/run_nsh_cmd.py --device ${SERIAL_DEVICE} --cmd 'param set MAV_0_CONFIG 101' || true
-	${DIR}/run_nsh_cmd.py --device ${SERIAL_DEVICE} --cmd 'param set MAV_1_CONFIG 102' || true
-	${DIR}/run_nsh_cmd.py --device ${SERIAL_DEVICE} --cmd 'param set MAV_2_CONFIG 103' || true
-
-	# enable all GPS
-	${DIR}/run_nsh_cmd.py --device ${SERIAL_DEVICE} --cmd 'param set GPS_1_CONFIG 201' || true
-	${DIR}/run_nsh_cmd.py --device ${SERIAL_DEVICE} --cmd 'param set GPS_1_CONFIG 202' || true
-
 	${DIR}/run_nsh_cmd.py --device ${SERIAL_DEVICE} --cmd 'param reset SYS_HITL'
 	${DIR}/run_nsh_cmd.py --device ${SERIAL_DEVICE} --cmd 'param status'
 	${DIR}/run_nsh_cmd.py --device ${SERIAL_DEVICE} --cmd 'param save'
@@ -47,16 +35,13 @@ do
 
 	${DIR}/reboot.py --device ${SERIAL_DEVICE}
 
-	${DIR}/run_nsh_cmd.py --device ${SERIAL_DEVICE} --cmd 'param status'
 	${DIR}/run_nsh_cmd.py --device ${SERIAL_DEVICE} --cmd 'param dump /fs/mtd_params' || true
 	${DIR}/run_nsh_cmd.py --device ${SERIAL_DEVICE} --cmd 'param dump /fs/microsd/parameters_backup.bson' || true
+	${DIR}/run_nsh_cmd.py --device ${SERIAL_DEVICE} --cmd 'param dump /fs/microsd/param_import_fail.bson' || true
 
 	${DIR}/run_nsh_cmd.py --device ${SERIAL_DEVICE} --cmd 'ps'
 	${DIR}/run_nsh_cmd.py --device ${SERIAL_DEVICE} --cmd 'work_queue status'
 
 	${DIR}/run_nsh_cmd.py --device ${SERIAL_DEVICE} --cmd 'pwm info'
 
-	${DIR}/run_nsh_cmd.py --device ${SERIAL_DEVICE} --cmd 'mavlink stop-all'
-	${DIR}/run_nsh_cmd.py --device ${SERIAL_DEVICE} --cmd 'gps stop'
-
 done