drivers/device/nuttx/I2C: add transfer failure details

mavsdk_tests: update MAVSDK dependency
This should fix the CI issue where the test just hangs trying to connect.
2026-05-24 01:57:34 +08:00 · 2022-04-20 15:08:37 -04:00 · 2022-04-20 11:48:53 -04:00 · 2022-04-19 15:29:25 +02:00 · 2022-04-19 15:29:25 +02:00 · 2022-04-19 15:29:25 +02:00
580 changed files with 65540 additions and 11031 deletions
@@ -28,7 +28,7 @@ pipeline {
          ]

          def base_builds = [
-            target: ["px4_sitl_rtps"],
+            target: ["px4_sitl_default"],
            image: docker_images.base,
            archive: false
          ]
@@ -58,6 +58,7 @@ pipeline {
                     "holybro_can-gps-v1_default",
                     "holybro_durandal-v1_default",
                     "holybro_kakutef7_default",
+                     "holybro_kakuteh7_default",
                     "holybro_pix32v5_default",
                     "matek_h743-slim",
                     "matek_gnss-m9n-f4_canbootloader",
@@ -705,18 +705,21 @@ void quickCalibrate() {

  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "gyro_calibration status || true"'

-  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "commander calibrate accel quick"'
+  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "commander calibrate accel quick; sleep 1"'
  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "param show CAL_ACC*"'

-  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "commander calibrate gyro"'
+  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "commander calibrate gyro; sleep 2"'
  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "param show CAL_GYRO*"'

-  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "commander calibrate level"'
+  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "commander calibrate level; sleep 2"'
  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "param show SENS*"'

-  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "commander calibrate mag quick"'
+  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "commander calibrate mag quick; sleep 1"'
  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "param show CAL_MAG*"'

+  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "commander calibrate baro; sleep 5"'
+  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "param show CAL_BARO*"'
+
  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "param show CAL_*"' // parameters after
  sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-*` --cmd "sensors status"'
 }
@@ -20,6 +20,7 @@ jobs:
          ark_can-flow,
          ark_can-gps,
          ark_can-rtk-gps,
+          ark_cannode,
          atl_mantis-edu,
          av_x-v1,
          bitcraze_crazyflie,
@@ -29,9 +29,9 @@ jobs:
        token: ${{ secrets.ACCESS_TOKEN }}

    - name: Download MAVSDK
-      run: wget "https://github.com/mavlink/MAVSDK/releases/download/v$(cat test/mavsdk_tests/MAVSDK_VERSION)/mavsdk_$(cat test/mavsdk_tests/MAVSDK_VERSION)_ubuntu20.04_amd64.deb"
+      run: wget "https://github.com/mavlink/MAVSDK/releases/download/v$(cat test/mavsdk_tests/MAVSDK_VERSION)/libmavsdk-dev_$(cat test/mavsdk_tests/MAVSDK_VERSION)_ubuntu20.04_amd64.deb"
    - name: Install MAVSDK
-      run: dpkg -i "mavsdk_$(cat test/mavsdk_tests/MAVSDK_VERSION)_ubuntu20.04_amd64.deb"
+      run: dpkg -i "libmavsdk-dev_$(cat test/mavsdk_tests/MAVSDK_VERSION)_ubuntu20.04_amd64.deb"

    - name: Prepare ccache timestamp
      id: ccache_cache_timestamp
@@ -24,8 +24,8 @@
 	branch = master
 [submodule "platforms/nuttx/NuttX/nuttx"]
 	path = platforms/nuttx/NuttX/nuttx
-	url = https://github.com/JacobCrabill/incubator-nuttx.git
-	branch = dev-h7-socketcan
+	url = https://github.com/PX4/NuttX.git
+	branch = px4_firmware_nuttx-10.1.0+
 [submodule "platforms/nuttx/NuttX/apps"]
 	path = platforms/nuttx/NuttX/apps
 	url = https://github.com/PX4/NuttX-apps.git
@@ -64,3 +64,6 @@
 	path = src/lib/crypto/libtommath
 	url = https://github.com/PX4/libtommath.git
 	branch = px4
+[submodule "src/modules/microdds_client/Micro-XRCE-DDS-Client"]
+	path = src/modules/microdds_client/Micro-XRCE-DDS-Client
+	url = https://github.com/eProsima/Micro-XRCE-DDS-Client.git
@@ -121,6 +121,16 @@ CONFIG:
      buildType: MinSizeRel
      settings:
        CONFIG: ark_can-rtk-gps_canbootloader
+    ark_cannode_default:
+      short: ark_cannode_default
+      buildType: MinSizeRel
+      settings:
+        CONFIG: ark_cannode_default
+    ark_cannode_canbootloader:
+      short: ark_cannode_canbootloader
+      buildType: MinSizeRel
+      settings:
+        CONFIG: ark_cannode_canbootloader
    atl_mantis-edu_default:
      short: atl_mantis-edu
      buildType: MinSizeRel
@@ -412,6 +412,7 @@ endif()
 # subdirectories
 #
 add_library(parameters_interface INTERFACE)
+add_library(kernel_parameters_interface INTERFACE)

 include(px4_add_library)
 add_subdirectory(src/lib EXCLUDE_FROM_ALL)
@@ -434,7 +435,13 @@ 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})
@@ -10,6 +10,7 @@
 # enable fusion of landing target velocity
 param set-default LTEST_MODE 1
 param set-default PLD_HACC_RAD 0.1
+param set-default RTL_PLD_MD 2

 # Start up Landing Target Estimator module
 landing_target_estimator start
@@ -8,8 +8,5 @@
 # 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
@@ -8,8 +8,5 @@
 # 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
@@ -67,4 +67,3 @@ param set-default PWM_MAIN_FUNC7 107
 param set-default PWM_MAIN_FUNC8 108

 set MIXER skip
-
@@ -71,7 +71,6 @@ param set-default MPC_XY_VEL_I_ACC 4
 param set-default MPC_XY_VEL_D_ACC 0.1

 param set-default NAV_ACC_RAD 5
-param set-default NAV_LOITER_RAD 80

 param set-default VT_FWD_THRUST_EN 4
 param set-default VT_F_TRANS_THR 0.75
@@ -80,7 +79,5 @@ 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
@@ -7,6 +7,8 @@

 . ${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

@@ -68,7 +70,6 @@ param set-default MPC_XY_VEL_I_ACC 4
 param set-default MPC_XY_VEL_D_ACC 0.1

 param set-default NAV_ACC_RAD 5
-param set-default NAV_LOITER_RAD 80

 param set-default VT_FW_DIFTHR_EN 1
 param set-default VT_FW_DIFTHR_SC 0.5
@@ -78,7 +79,5 @@ 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
@@ -7,6 +7,8 @@

 . ${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

@@ -80,7 +82,6 @@ param set-default MPC_XY_VEL_I_ACC 4
 param set-default MPC_XY_VEL_D_ACC 0.1

 param set-default NAV_ACC_RAD 5
-param set-default NAV_LOITER_RAD 80

 param set-default VT_B_TRANS_DUR 8
 param set-default VT_FWD_THRUST_EN 4
@@ -88,7 +89,5 @@ 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
@@ -38,7 +38,6 @@ param set-default MPC_XY_VEL_I_ACC 4
 param set-default MPC_XY_VEL_D_ACC 0.1

 param set-default NAV_ACC_RAD 5
-param set-default NAV_LOITER_RAD 80

 param set-default VT_FWD_THRUST_EN 4
 param set-default VT_F_TRANS_THR 0.75
@@ -51,7 +50,5 @@ 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
@@ -37,6 +37,4 @@ 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
@@ -37,6 +37,4 @@ 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
@@ -10,6 +10,8 @@

 . ${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
@@ -33,6 +35,4 @@ 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
@@ -47,6 +47,4 @@ 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
@@ -9,6 +9,8 @@

 . ${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
@@ -24,6 +26,4 @@ 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
@@ -7,6 +7,8 @@

 . ${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
@@ -26,6 +28,4 @@ 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
@@ -7,6 +7,8 @@

 . ${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
@@ -58,7 +60,5 @@ 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
@@ -24,7 +24,6 @@ fi

 # initialize script variables
 set IO_PRESENT                  no
-set MAV_TYPE                    none
 set MIXER                       none
 set MIXER_AUX                   none
 set MIXER_FILE                  none
@@ -224,6 +223,13 @@ rc_update start
 manual_control start
 sensors start
 commander start
+
+# Configure vehicle type specific parameters.
+# Note: rc.vehicle_setup is the entry point for rc.interface,
+#       rc.fw_apps, rc.mc_apps, rc.rover_apps, and rc.vtol_apps.
+#
+. ${R}etc/init.d/rc.vehicle_setup
+
 navigator start

 # Try to start the micrortps_client with UDP transport if module exists
@@ -253,12 +259,6 @@ then
 	gyro_calibration start
 fi

-# Configure vehicle type specific parameters.
-# Note: rc.vehicle_setup is the entry point for rc.interface,
-#       rc.fw_apps, rc.mc_apps, rc.rover_apps, and rc.vtol_apps.
-#
-. ${R}etc/init.d/rc.vehicle_setup
-
 #user defined mavlink streams for instances can be in PATH
 . px4-rc.mavlink

@@ -36,4 +36,5 @@ 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
@@ -49,7 +49,6 @@ param set-default MPC_Z_VEL_MAX_DN 1.5

 param set-default NAV_ACC_RAD 5
 param set-default NAV_DLL_ACT 2
-param set-default NAV_LOITER_RAD 80

 param set-default RTL_DESCEND_ALT 10
 param set-default RTL_RETURN_ALT 30
@@ -104,7 +103,7 @@ param set-default CBRK_SUPPLY_CHK 894281
 param set-default COM_PREARM_MODE 0
 param set-default CBRK_IO_SAFETY 22027

-set MAV_TYPE 22
+param set-default MAV_TYPE 22

 set MIXER standard_vtol_hitl

@@ -47,7 +47,7 @@ param set-default HIL_ACT_FUNC6 201
 param set-default HIL_ACT_REV 32

 param set-default MAV_TYPE 19
-set MAV_TYPE 19
+
 set MIXER vtol_tailsitter_duo_sat

 set PWM_OUT 1234
@@ -54,7 +54,8 @@ 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
-set MAV_TYPE 22
+
+param set-default MAV_TYPE 22

 set MIXER quad_x
 set MIXER_AUX vtol_AAERT
@@ -19,7 +19,6 @@

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

-
 param set-default MAV_TYPE 19

 param set-default MC_ROLL_P 6
@@ -38,7 +37,6 @@ 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

@@ -23,6 +23,7 @@

 . ${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
@@ -45,7 +46,6 @@ 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
@@ -13,6 +13,8 @@

 . ${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
@@ -38,7 +40,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

@@ -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
@@ -52,7 +52,6 @@ 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
@@ -41,7 +41,6 @@ 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
@@ -33,7 +33,6 @@ 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
@@ -46,7 +46,6 @@ 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
@@ -77,8 +77,6 @@ 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

@@ -13,6 +13,8 @@

 . ${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
@@ -28,7 +30,6 @@ 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
@@ -22,6 +22,8 @@

 . ${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
@@ -64,7 +66,6 @@ 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

@@ -22,6 +22,8 @@

 . ${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
@@ -134,7 +136,6 @@ 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
@@ -23,6 +23,8 @@

 . ${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
@@ -94,8 +96,6 @@ 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

@@ -27,6 +27,8 @@

 . ${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
@@ -57,8 +59,6 @@ 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

@@ -31,7 +31,6 @@ 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
@@ -19,6 +19,8 @@

 . ${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
@@ -37,8 +39,6 @@ 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
@@ -18,4 +18,7 @@

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

+# MAV_TYPE_TRICOPTER 15
+param set-default MAV_TYPE 15
+
 set MIXER tri_y_yaw+
@@ -18,4 +18,7 @@

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

+# MAV_TYPE_TRICOPTER 15
+param set-default MAV_TYPE 15
+
 set MIXER tri_y_yaw-
@@ -17,7 +17,9 @@
 #

 . ${R}etc/init.d/rc.mc_defaults
-set MIXER coax
+
+# MAV_TYPE_COAXIAL 3
+param set-default MAV_TYPE 3

 param set-default MC_ROLLRATE_P 0.17
 param set-default MC_ROLLRATE_I 0.05
@@ -36,6 +38,9 @@ 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

@@ -20,7 +20,7 @@
 . ${R}etc/init.d/rc.mc_defaults

 # Configure as helicopter (number 4 defined in commander_helper.cpp)
-set MAV_TYPE 4
+param set-default MAV_TYPE 4

 set MIXER blade130

@@ -41,5 +41,6 @@ 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
@@ -24,8 +24,5 @@ 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
@@ -26,7 +26,7 @@
 # @board px4_fmu-v2 exclude
 #

-set VEHICLE_TYPE mc
+. ${R}etc/init.d/rc.mc_defaults

 param set-default NAV_ACC_RAD 2

@@ -39,6 +39,7 @@ 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

@@ -41,9 +41,6 @@ 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

@@ -24,8 +24,6 @@

 set MIXER quad_s250aq

-set MAV_TYPE 2
-
 param set-default ATT_BIAS_MAX 0

 param set-default CBRK_IO_SAFETY 22027
@@ -21,10 +21,7 @@
 # @board cuav_x7pro exclude
 #

-set VEHICLE_TYPE mc
-set MIXER quad_x
-set PWM_OUT 1234
-
+. ${R}etc/init.d/rc.mc_defaults

 # Attitude & rate gains
 param set-default MC_ROLLRATE_D 0.0013
@@ -21,10 +21,7 @@
 # @maintainer Hyon Lim <lim@uvify.com>
 #

-set VEHICLE_TYPE mc
-set MIXER quad_x
-set PWM_OUT 1234
-
+. ${R}etc/init.d/rc.mc_defaults

 # Attitude & rate gains
 param set-default MC_ROLLRATE_D 0.0013
@@ -24,10 +24,6 @@

 . ${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
@@ -48,8 +48,6 @@ 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
@@ -76,9 +76,6 @@ 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

@@ -65,9 +65,6 @@ 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

@@ -16,7 +16,4 @@
 # 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
@@ -16,7 +16,4 @@
 # 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
@@ -23,6 +23,9 @@

 . ${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
@@ -27,9 +27,8 @@

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

-set MIXER hexa_x
-set PWM_OUT 12345678
-
+# MAV_TYPE_HEXAROTOR 13
+param set-default MAV_TYPE 13

 ###############################################
 # Attitude & rate gains
@@ -120,3 +119,7 @@ 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
@@ -23,6 +23,9 @@

 . ${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
@@ -25,6 +25,9 @@

 . ${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
@@ -25,6 +25,9 @@

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

+# MAV_TYPE_OCTOROTOR 14
+param set-default MAV_TYPE 14
+
 set MIXER octo_+

 set PWM_OUT 12345678
@@ -7,6 +7,9 @@

 set VEHICLE_TYPE airship

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

 set VEHICLE_TYPE fw

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

 set VEHICLE_TYPE rover

+# MAV_TYPE_SURFACE_BOAT 11
+param set-default MAV_TYPE 11
+
 #
 # Default parameters for UGVs.
 #
@@ -7,14 +7,15 @@

 set VEHICLE_TYPE fw

+# MAV_TYPE_FIXED_WING 1
+param set-default MAV_TYPE 1
+
 #
 # Default parameters for fixed wing UAVs.
 #
 param set-default COM_POS_FS_DELAY 5
 param set-default COM_POS_FS_EPH 15
 param set-default COM_POS_FS_EPV 30
-param set-default COM_POS_FS_GAIN 0
-param set-default COM_POS_FS_PROB 1
 param set-default COM_VEL_FS_EVH 5
 # Disable preflight disarm to not interfere with external launching
 param set-default COM_DISARM_PRFLT -1
@@ -7,6 +7,9 @@

 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
@@ -7,6 +7,9 @@

 set VEHICLE_TYPE rover

+# MAV_TYPE_GROUND_ROVER 10
+param set-default MAV_TYPE 10
+
 #
 # Default parameters for UGVs.
 #
@@ -83,16 +83,28 @@ then
 	teraranger start -X
 fi

-# Possible external pmw3901 optical flow sensor
+# paa3905 optical flow sensor (external SPI)
+if param greater -s SENS_EN_PAA3905 0
+then
+	paa3905 -S start
+fi
+
+# paw3902 optical flow sensor (external SPI)
+if param greater -s SENS_EN_PAW3902 0
+then
+	paw3902 -S start
+fi
+
+# pmw3901 optical flow sensor (external SPI)
 if param greater -s SENS_EN_PMW3901 0
 then
 	pmw3901 -S start
 fi

-# Possible external paw3902 optical flow sensor
-if param greater -s SENS_EN_PAW3902 0
+# Check for px4flow sensor
+if param compare -s SENS_EN_PX4FLOW 1
 then
-	paw3902 -S start
+	px4flow start -X
 fi

 # vl53l1x i2c distance sensor
@@ -155,6 +167,13 @@ 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
@@ -7,6 +7,9 @@

 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
@@ -12,19 +12,9 @@ if [ $VEHICLE_TYPE = fw ]
 then
 	if [ $MIXER = none ]
 	then
-		# Set default mixer for fixed wing if not defined.
-		set MIXER AERT
+		echo "FW mixer undefined"
 	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

@@ -42,41 +32,6 @@ 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

@@ -91,19 +46,9 @@ if [ $VEHICLE_TYPE = rover ]
 then
 	if [ $MIXER = none ]
 	then
-		# Set default mixer for UGV if not defined.
-		set MIXER rover_generic
+		echo "rover mixer undefined"
 	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

@@ -121,25 +66,6 @@ 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

@@ -157,15 +83,6 @@ 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

@@ -183,19 +100,11 @@ 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


@@ -7,6 +7,9 @@

 set VEHICLE_TYPE vtol

+# MAV_TYPE_VTOL_FIXEDROTOR 22
+param set-default MAV_TYPE 22
+
 param set-default MIS_TAKEOFF_ALT 20
 param set-default MIS_YAW_TMT 10

@@ -29,7 +29,6 @@ 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
@@ -409,6 +408,13 @@ else
 		commander start
 	fi

+	#
+	# Configure vehicle type specific parameters.
+	# Note: rc.vehicle_setup is the entry point for rc.interface,
+	#       rc.fw_apps, rc.mc_apps, rc.rover_apps, and rc.vtol_apps.
+	#
+	. ${R}etc/init.d/rc.vehicle_setup
+
 	# Pre-takeoff continuous magnetometer calibration
 	if param compare -s MBE_ENABLE 1
 	then
@@ -459,13 +465,6 @@ else
 		fi
 	fi

-	#
-	# Configure vehicle type specific parameters.
-	# Note: rc.vehicle_setup is the entry point for rc.interface,
-	#       rc.fw_apps, rc.mc_apps, rc.rover_apps, and rc.vtol_apps.
-	#
-	. ${R}etc/init.d/rc.vehicle_setup
-
 	#
 	# Play the startup tune (if not disabled or there is an error)
 	#
@@ -493,12 +492,6 @@ else
 		gimbal start
 	fi

-	# Check for flow sensor
-	if param compare -s SENS_EN_PX4FLOW 1
-	then
-		px4flow start -X
-	fi
-
 	# Blacksheep telemetry
 	if param compare -s TEL_BST_EN 1
 	then
@@ -573,7 +566,6 @@ unset IO_PRESENT
 unset IOFW
 unset LOGGER_ARGS
 unset LOGGER_BUF
-unset MAV_TYPE
 unset MIXER
 unset MIXER_AUX
 unset MIXER_FILE
@@ -1,5 +1,7 @@
 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%.
@@ -27,4 +27,5 @@ exec find boards msg src platforms test \
    -path src/lib/crypto/monocypher -prune -o \
    -path src/lib/crypto/libtomcrypt -prune -o \
    -path src/lib/crypto/libtommath -prune -o \
+    -path src/modules/microdds_client/Micro-XRCE-DDS-Client -prune -o \
    -type f \( -name "*.c" -o -name "*.h" -o -name "*.cpp" -o -name "*.hpp" \) | grep $PATTERN
@@ -55,7 +55,7 @@ def perform_imu_checks(

    # perform the vibration check
    imu_status['imu_vibration_check'] = 'Pass'
-    for imu_vibr_metric in ['imu_coning', 'imu_hfdang', 'imu_hfdvel']:
+    for imu_vibr_metric in ['imu_coning', 'imu_hfgyro', 'imu_hfaccel']:
        mean_metric = '{:s}_mean'.format(imu_vibr_metric)
        peak_metric = '{:s}_peak'.format(imu_vibr_metric)
        if imu_metrics[mean_metric] > check_levels['{:s}_warn'.format(mean_metric)] \
@@ -144,17 +144,27 @@ def calculate_imu_metrics(ulog: ULog, multi_instance, in_air_no_ground_effects:
        imu_metrics[result] = calculate_stat_from_signal(
            estimator_status_data, 'estimator_status', signal, in_air_no_ground_effects, np.median)

+
    # calculates peak and mean for IMU vibration checks
-    for signal, result in [('vibe[0]', 'imu_coning'),
-                           ('vibe[1]', 'imu_hfdang'),
-                           ('vibe[2]', 'imu_hfdvel')]:
-        peak = calculate_stat_from_signal(
-            estimator_status_data, 'estimator_status', signal, in_air_no_ground_effects, np.amax)
-        if peak > 0.0:
-            imu_metrics['{:s}_peak'.format(result)] = peak
-            imu_metrics['{:s}_mean'.format(result)] = calculate_stat_from_signal(
-                estimator_status_data, 'estimator_status', signal,
-                in_air_no_ground_effects, np.mean)
+    for imu_status_instance in range(4):
+        try:
+            vehicle_imu_status_data = ulog.get_dataset('vehicle_imu_status', imu_status_instance).data
+
+            if vehicle_imu_status_data['accel_device_id'][0] == estimator_status_data['accel_device_id'][0]:
+
+                for signal, result in [('delta_angle_coning_metric', 'imu_coning'),
+                                       ('gyro_vibration_metric', 'imu_hfgyro'),
+                                       ('accel_vibration_metric', 'imu_hfaccel')]:
+
+                    peak = calculate_stat_from_signal(vehicle_imu_status_data, 'vehicle_imu_status', signal, in_air_no_ground_effects, np.amax)
+
+                    if peak > 0.0:
+                        imu_metrics['{:s}_peak'.format(result)] = peak
+                        imu_metrics['{:s}_mean'.format(result)] = calculate_stat_from_signal(vehicle_imu_status_data, 'vehicle_imu_status', signal, in_air_no_ground_effects, np.mean)
+
+        except:
+            pass
+

    # IMU bias checks
    estimator_states_data = ulog.get_dataset('estimator_states', multi_instance).data
@@ -48,7 +48,7 @@ for filename in os.listdir(metadata_directory):

 #        # print out the check levels
 #        print('\n'+'The following metadata loaded from '+filename+' were used'+'\n')
-#        val = population_data.get(filename, {}).get('imu_hfdang_mean')
+#        val = population_data.get(filename, {}).get('imu_hfgyro_mean')
 #        print(val)

 # Open pdf file for plotting
@@ -90,10 +90,10 @@ population_results = {
 'ofy_fail_pct_avg':[float('NaN'),'The mean percentage of innovation test fails for the Y axis optical flow sensor'],
 'imu_coning_max_avg':[float('NaN'),'The mean of the maximum in-flight values of the IMU delta angle coning vibration level (mrad)'],
 'imu_coning_mean_avg':[float('NaN'),'The mean of the mean in-flight value of the IMU delta angle coning vibration level (mrad)'],
-'imu_hfdang_max_avg':[float('NaN'),'The mean of the maximum in-flight values of the IMU high frequency delta angle vibration level (mrad)'],
-'imu_hfdang_mean_avg':[float('NaN'),'The mean of the mean in-flight value of the IMU delta high frequency delta angle vibration level (mrad)'],
-'imu_hfdvel_max_avg':[float('NaN'),'The mean of the maximum in-flight values of the IMU high frequency delta velocity vibration level (m/s)'],
-'imu_hfdvel_mean_avg':[float('NaN'),'The mean of the mean in-flight value of the IMU delta high frequency delta velocity vibration level (m/s)'],
+'imu_hfgyro_max_avg':[float('NaN'),'The mean of the maximum in-flight values of the IMU high frequency gyro vibration level (rad/s)'],
+'imu_hfgyro_mean_avg':[float('NaN'),'The mean of the mean in-flight value of the IMU delta high frequency gyro vibration level (rad/s)'],
+'imu_hfaccel_max_avg':[float('NaN'),'The mean of the maximum in-flight values of the IMU high frequency accel vibration level (m/s/s)'],
+'imu_hfaccel_mean_avg':[float('NaN'),'The mean of the mean in-flight value of the IMU delta high frequency accel vibration level (m/s/s)'],
 'obs_ang_median_avg':[float('NaN'),'The mean of the median in-flight value of the output observer angular tracking error magnitude (mrad)'],
 'obs_vel_median_avg':[float('NaN'),'The mean of the median in-flight value of the output observer velocity tracking error magnitude (m/s)'],
 'obs_pos_median_avg':[float('NaN'),'The mean of the median in-flight value of the output observer position tracking error magnitude (m)'],
@@ -360,54 +360,54 @@ if (len(result1) > 0 and len(result2) > 0):
    plt.close(8)

 # IMU high frequency delta angle vibration levels
-temp = np.asarray([population_data[k].get('imu_hfdang_peak') for k in found_keys])
+temp = np.asarray([population_data[k].get('imu_hfgyro_peak') for k in found_keys])
 result1 = 1000.0 * temp[np.isfinite(temp)]
-temp = np.asarray([population_data[k].get('imu_hfdang_mean') for k in found_keys])
+temp = np.asarray([population_data[k].get('imu_hfgyro_mean') for k in found_keys])
 result2 = 1000.0 * temp[np.isfinite(temp)]

 if (len(result1) > 0 and len(result2) > 0):
-    population_results['imu_hfdang_max_avg'][0] = np.mean(result1)
-    population_results['imu_hfdang_mean_avg'][0] = np.mean(result2)
+    population_results['imu_hfgyro_max_avg'][0] = np.mean(result1)
+    population_results['imu_hfgyro_mean_avg'][0] = np.mean(result2)

    plt.figure(9,figsize=(20,13))

    plt.subplot(2,1,1)
    plt.hist(result1)
-    plt.title("Gaussian Histogram - IMU HF Delta Angle Vibration Peak")
-    plt.xlabel("imu_hfdang_max (mrad)")
+    plt.title("Gaussian Histogram - IMU HF Gyroscope Vibration Peak")
+    plt.xlabel("imu_hfgyro_max (rad/s)")
    plt.ylabel("Frequency")

    plt.subplot(2,1,2)
    plt.hist(result2)
-    plt.title("Gaussian Histogram - IMU HF Delta Angle Vibration Mean")
-    plt.xlabel("imu_hfdang_mean (mrad)")
+    plt.title("Gaussian Histogram - IMU HF Gyroscope Vibration Mean")
+    plt.xlabel("imu_hfgyro_mean (rad/s)")
    plt.ylabel("Frequency")

    pp.savefig()
    plt.close(9)

-# IMU high frequency delta velocity vibration levels
-temp = np.asarray([population_data[k].get('imu_hfdvel_peak') for k in found_keys])
+# IMU high frequency accel vibration levels
+temp = np.asarray([population_data[k].get('imu_hfaccel_peak') for k in found_keys])
 result1 = temp[np.isfinite(temp)]
-temp = np.asarray([population_data[k].get('imu_hfdvel_mean') for k in found_keys])
+temp = np.asarray([population_data[k].get('imu_hfaccel_mean') for k in found_keys])
 result2 = temp[np.isfinite(temp)]

 if (len(result1) > 0 and len(result2) > 0):
-    population_results['imu_hfdvel_max_avg'][0] = np.mean(result1)
-    population_results['imu_hfdvel_mean_avg'][0] = np.mean(result2)
+    population_results['imu_hfaccel_max_avg'][0] = np.mean(result1)
+    population_results['imu_hfaccel_mean_avg'][0] = np.mean(result2)

    plt.figure(10,figsize=(20,13))

    plt.subplot(2,1,1)
    plt.hist(result1)
-    plt.title("Gaussian Histogram - IMU HF Delta Velocity Vibration Peak")
-    plt.xlabel("imu_hfdvel_max (m/s)")
+    plt.title("Gaussian Histogram - IMU HF Accelerometer Vibration Peak")
+    plt.xlabel("imu_hfaccel_max (m/s/s)")
    plt.ylabel("Frequency")

    plt.subplot(2,1,2)
    plt.hist(result2)
-    plt.title("Gaussian Histogram - IMU HF Delta Velocity Vibration Mean")
-    plt.xlabel("imu_hfdvel_mean (m/s)")
+    plt.title("Gaussian Histogram - IMU HF Accelerometer Vibration Mean")
+    plt.xlabel("imu_hfaccel_mean (m/s/s)")
    plt.ylabel("Frequency")

    pp.savefig()
@@ -535,12 +535,12 @@ single_log_results = {
 'hgt_sensor_status':['Pass','Height sensor check summary. This sensor data can be sourced from either Baro, GPS, range fidner or external vision system. A Fail result indicates a significant error that caused a significant reduction in vehicle navigation performance was detected. A Warning result indicates that error levels higher than normal were detected but these errors did not significantly impact navigation performance. A Pass result indicates that no amonalies were detected and no further investigation is required'],
 'hgt_test_max':[float('NaN'),'The maximum in-flight value of the height sensor innovation consistency test ratio.'],
 'hgt_test_mean':[float('NaN'),'The mean in-flight value of the height sensor innovation consistency test ratio.'],
-'imu_coning_mean':[float('NaN'),'Mean in-flight value of the IMU delta angle coning vibration metric (rad)'],
-'imu_coning_peak':[float('NaN'),'Peak in-flight value of the IMU delta angle coning vibration metric (rad)'],
-'imu_hfdang_mean':[float('NaN'),'Mean in-flight value of the IMU delta angle high frequency vibration metric (rad)'],
-'imu_hfdang_peak':[float('NaN'),'Peak in-flight value of the IMU delta angle high frequency vibration metric (rad)'],
-'imu_hfdvel_mean':[float('NaN'),'Mean in-flight value of the IMU delta velocity high frequency vibration metric (m/s)'],
-'imu_hfdvel_peak':[float('NaN'),'Peak in-flight value of the IMU delta velocity high frequency vibration metric (m/s)'],
+'imu_coning_mean':[float('NaN'),'Mean in-flight value of the IMU delta angle coning vibration metric (rad^2)'],
+'imu_coning_peak':[float('NaN'),'Peak in-flight value of the IMU delta angle coning vibration metric (rad^2)'],
+'imu_hfgyro_mean':[float('NaN'),'Mean in-flight value of the IMU gyro high frequency vibration metric (rad/s)'],
+'imu_hfgyro_peak':[float('NaN'),'Peak in-flight value of the IMU gyro high frequency vibration metric (rad/s)'],
+'imu_hfaccel_mean':[float('NaN'),'Mean in-flight value of the IMU accel high frequency vibration metric (m/s/s)'],
+'imu_hfaccel_peak':[float('NaN'),'Peak in-flight value of the IMU accel high frequency vibration metric (m/s/s)'],
 'imu_sensor_status':['Pass','IMU sensor check summary. A Fail result indicates a significant error that caused a significant reduction in vehicle navigation performance was detected. A Warning result indicates that error levels higher than normal were detected but these errors did not significantly impact navigation performance. A Pass result indicates that no amonalies were detected and no further investigation is required'],
 'in_air_transition_time':[float('NaN'),'The time in seconds measured from startup that the EKF transtioned into in-air mode. Set to a nan if a transition event is not detected.'],
 'mag_percentage_amber':[float('NaN'),'The percentage of in-flight consolidated magnetic field sensor innovation consistency test values > 0.5.'],
@@ -21,10 +21,10 @@ hagl_amber_warn_pct,5.0
 tas_amber_warn_pct,5.0
 imu_coning_peak_warn,1.8E-5
 imu_coning_mean_warn,3.6E-6
-imu_hfdang_peak_warn,3.0E-3
-imu_hfdang_mean_warn,6.0E-4
-imu_hfdvel_peak_warn,9.0E-2
-imu_hfdvel_mean_warn,1.8E-2
+imu_hfgyro_peak_warn,12
+imu_hfgyro_mean_warn,2.4
+imu_hfaccel_peak_warn,360
+imu_hfaccel_mean_warn,72
 obs_ang_err_median_warn,8.0E-3
 obs_vel_err_median_warn,0.05
 obs_pos_err_median_warn,0.15
@@ -49,12 +49,12 @@ hagl_test_mean, The mean in-flight value of the height above ground sensor innov
 ofx_fail_percentage, The percentage of in-flight recorded failure events for the optical flow sensor X-axis innovation consistency test.
 ofy_fail_percentage, The percentage of in-flight recorded failure events for the optical flow sensor Y-axis innovation consistency test.
 filter_faults_max, Largest recorded value of the filter internal fault bitmask. Should always be zero.
-imu_coning_peak, Peak in-flight value of the IMU delta angle coning vibration metric (rad)
-imu_coning_mean, Mean in-flight value of the IMU delta angle coning vibration metric (rad)
-imu_hfdang_peak, Peak in-flight value of the IMU delta angle high frequency vibration metric (rad)
-imu_hfdang_mean, Mean in-flight value of the IMU delta angle high frequency vibration metric (rad)
-imu_hfdvel_peak, Peak in-flight value of the IMU delta velocity high frequency vibration metric (m/s)
-imu_hfdvel_mean, Mean in-flight value of the IMU delta velocity high frequency vibration metric (m/s)
+imu_coning_peak, Peak in-flight value of the IMU delta angle coning vibration metric (rad^2)
+imu_coning_mean, Mean in-flight value of the IMU delta angle coning vibration metric (rad^2)
+imu_hfgyro_peak, Peak in-flight value of the IMU accel high frequency vibration metric (rad/s)
+imu_hfgyro_mean, Mean in-flight value of the IMU accel high frequency vibration metric (rad/s)
+imu_hfaccel_peak, Peak in-flight value of the IMU accel high frequency vibration metric (m/s/s)
+imu_hfaccel_mean, Mean in-flight value of the IMU accel high frequency vibration metric (m/s/s)
 output_obs_ang_err_median, Median in-flight value of the output observer angular error (rad)
 output_obs_vel_err_median, Median in-flight value of the output observer velocity error (m/s)
 output_obs_pos_err_median, Median in-flight value of the output observer position error (m)
@@ -0,0 +1,55 @@
+#!/usr/bin/env python
+# -*- coding: utf-8 -*-
+"""
+    Copyright (c) 2022 PX4 Development Team
+    Redistribution and use in source and binary forms, with or without
+    modification, are permitted provided that the following conditions
+    are met:
+
+    1. Redistributions of source code must retain the above copyright
+    notice, this list of conditions and the following disclaimer.
+    2. Redistributions in binary form must reproduce the above copyright
+    notice, this list of conditions and the following disclaimer in
+    the documentation and/or other materials provided with the
+    distribution.
+    3. Neither the name PX4 nor the names of its contributors may be
+    used to endorse or promote products derived from this software
+    without specific prior written permission.
+
+    THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+    "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+    LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
+    FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
+    COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
+    INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
+    BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
+    OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
+    AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+    LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
+    ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+    POSSIBILITY OF SUCH DAMAGE.
+
+File: frag_fusion_symbolic.py
+Author: Mathieu Bresciani <mathieu@auterion.com>
+License: BSD 3-Clause
+Description:
+"""
+
+from sympy import *
+
+V = Symbol("V", real=True)
+rho = Symbol("rho", real=True)
+rho_n = Symbol("rho_n", real=True)
+Mcoef = Symbol("Mcoef", real=True)
+Bcoef = Symbol("Bcoef", real=True)
+a = Symbol("a", real=True)
+
+f1 = 0.5 * rho / Bcoef * V**2 + rho_n * Mcoef * V - a
+
+print("If Bcoef > 0 and Mcoef > 0")
+print("V =")
+res_V = solve(f1, V)
+res_V = res_V[0]
+pprint(res_V)
+print("a_pred =")
+pprint(solve(f1, a))
@@ -0,0 +1,202 @@
+#!/usr/bin/env python
+# -*- coding: utf-8 -*-
+"""
+    Copyright (c) 2022 PX4 Development Team
+    Redistribution and use in source and binary forms, with or without
+    modification, are permitted provided that the following conditions
+    are met:
+
+    1. Redistributions of source code must retain the above copyright
+    notice, this list of conditions and the following disclaimer.
+    2. Redistributions in binary form must reproduce the above copyright
+    notice, this list of conditions and the following disclaimer in
+    the documentation and/or other materials provided with the
+    distribution.
+    3. Neither the name PX4 nor the names of its contributors may be
+    used to endorse or promote products derived from this software
+    without specific prior written permission.
+
+    THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+    "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+    LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
+    FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
+    COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
+    INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
+    BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
+    OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
+    AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+    LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
+    ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+    POSSIBILITY OF SUCH DAMAGE.
+
+File: drag_replay.py
+Author: Mathieu Bresciani <mathieu@auterion.com>
+License: BSD 3-Clause
+Description:
+    Find the best ballistic and momentum drag coefficients for wind estimation
+    using EKF2 replay data.
+    NOTE: this script currently assumes no wind.
+"""
+
+import matplotlib.pylab as plt
+from pyulog import ULog
+from pyulog.px4 import PX4ULog
+import numpy as np
+import quaternion
+from scipy import optimize
+
+def getAllData(logfile):
+    log = ULog(logfile)
+
+    v_local = np.matrix([getData(log, 'vehicle_local_position', 'vx'),
+              getData(log, 'vehicle_local_position', 'vy'),
+              getData(log, 'vehicle_local_position', 'vz')])
+
+    t_v_local = ms2s(getData(log, 'vehicle_local_position', 'timestamp'))
+
+    accel = np.matrix([getData(log, 'sensor_combined', 'accelerometer_m_s2[0]'),
+              getData(log, 'sensor_combined', 'accelerometer_m_s2[1]'),
+              getData(log, 'sensor_combined', 'accelerometer_m_s2[2]')])
+    t_accel = ms2s(getData(log, 'sensor_combined', 'timestamp'))
+
+    q = np.matrix([getData(log, 'vehicle_attitude', 'q[0]'),
+              getData(log, 'vehicle_attitude', 'q[1]'),
+              getData(log, 'vehicle_attitude', 'q[2]'),
+              getData(log, 'vehicle_attitude', 'q[3]')])
+    t_q = ms2s(getData(log, 'vehicle_attitude', 'timestamp'))
+
+    dist_bottom = getData(log, 'vehicle_local_position', 'dist_bottom')
+    t_dist_bottom = ms2s(getData(log, 'vehicle_local_position', 'timestamp'))
+
+    (t_aligned, v_body_aligned, accel_aligned) = alignData(t_v_local, v_local, t_accel, accel, t_q, q, t_dist_bottom, dist_bottom)
+
+    t_aligned -= t_aligned[0]
+
+    return (t_aligned, v_body_aligned, accel_aligned)
+
+def alignData(t_v, v_local, t_accel, accel, t_q, q, t_dist_bottom, dist_bottom):
+    len_accel = len(t_accel)
+    len_q = len(t_q)
+    len_db = len(t_dist_bottom)
+    i_a = 0
+    i_q = 0
+    i_db = 0
+    v_body_aligned = np.empty((3,0))
+    accel_aligned = np.empty((3,0))
+    t_aligned = []
+
+    for i_v in range(len(t_v)):
+        t = t_v[i_v]
+        accel_sum = np.zeros((3,1))
+        accel_count = 0
+        while t_accel[i_a] < t and i_a < len_accel-1:
+            accel_sum += accel[:, i_a] # Integrate accel samples between 2 velocity samples
+            accel_count += 1
+            i_a += 1
+        while t_q[i_q] < t and i_q < len_q-1:
+            i_q += 1
+        while t_dist_bottom[i_db] < t and i_db < len_db-1:
+            i_db += 1
+
+        # Only use in air data
+        if dist_bottom[i_db] < 1.0 or accel_count == 0:
+            continue
+
+        qk = np.quaternion(q[0, i_q],q[1, i_q],q[2, i_q],q[3, i_q])
+        q_vl = np.quaternion(0, v_local[0, i_v], v_local[1, i_v], v_local[2, i_v])
+        q_vb = qk.conjugate() * q_vl * qk # Get velocity in body frame
+        vb = quaternion.as_float_array(q_vb)[1:4]
+
+        v_body_aligned = np.append(v_body_aligned, [[vb[0]], [vb[1]], [vb[2]]], axis=1)
+        accel_aligned = np.append(accel_aligned, accel_sum / accel_count, axis=1)
+        t_aligned.append(t)
+
+    return (t_aligned, v_body_aligned, np.asarray(accel_aligned))
+
+def getData(log, topic_name, variable_name, instance=0):
+    variable_data = np.array([])
+    for elem in log.data_list:
+        if elem.name == topic_name:
+            if instance == elem.multi_id:
+                variable_data = elem.data[variable_name]
+                break
+
+    return variable_data
+
+def ms2s(time_ms):
+    return time_ms * 1e-6
+
+def run(logfile):
+    (t, v_body, a_body) = getAllData(logfile)
+
+    rho = 1.15 # air densitiy
+    rho15 = 1.225 # air density at 15 degC
+
+    # x[0]: momentum drag, scales with v
+    # x[1]: inverse of ballistic coefficient (X body axis), scales with v^2
+    # x[2]: inverse of ballistic coefficient (Y body axis), scales with v^2
+    predict_acc_x = lambda x: -v_body[0] * x[0] - 0.5 * rho * v_body[0]**2 * np.sign(v_body[0]) * x[1]
+    predict_acc_y = lambda x: -v_body[1] * x[0] - 0.5 * rho * v_body[1]**2 * np.sign(v_body[1]) * x[2]
+
+    J = lambda x: np.sum(np.power(abs(a_body[0]-predict_acc_x(x)), 2.0) + np.power(abs(a_body[1]-predict_acc_y(x)), 2.0)) # cost function
+
+    x0 = [0.15, 1/100, 1/100] # initial conditions
+    res = optimize.minimize(J, x0, method='nelder-mead', bounds=[(0,1),(0,10),(0,10)], options={'disp': True})
+
+    # Convert results to parameters
+    innov_var = J(res.x) / (len(v_body[0]) + len(v_body[1]))
+    mcoef = res.x[0] / np.sqrt(rho / rho15)
+
+    bcoef_x = 0.0
+    bcoef_y = 0.0
+
+    if res.x[1] > 1/200:
+        bcoef_x = 1/res.x[1]
+
+    if res.x[2] > 1/200:
+        bcoef_y = 1/res.x[2]
+
+    print(f"param set EKF2_BCOEF_X {bcoef_x:.1f}")
+    print(f"param set EKF2_BCOEF_Y {bcoef_y:.1f}")
+    print(f"param set EKF2_MCOEF {mcoef:.2f}")
+    print(f"/!\EXPERIMENTAL param set EKF2_DRAG_NOISE {innov_var:.2f}")
+
+    # Plot data
+    plt.figure(1)
+    plt.suptitle(logfile.split('/')[-1])
+    ax1 = plt.subplot(2, 1, 1)
+    ax1.plot(t, v_body[0])
+    ax1.plot(t, v_body[1])
+    ax1.set_xlabel("time (s)")
+    ax1.set_ylabel("velocity (m/s)")
+    ax1.legend(["forward", "right"])
+
+    ax2 = plt.subplot(2, 1, 2, sharex=ax1)
+    ax2.set_title(f"BCoef_x = {bcoef_x:.1f}, BCoef_y = {bcoef_y:.1f}, MCoef = {mcoef:.4f}", loc="right")
+    ax2.plot(t, a_body[0])
+    ax2.plot(t, a_body[1])
+    ax2.plot(t, predict_acc_x(res.x))
+    ax2.plot(t, predict_acc_y(res.x))
+    ax2.set_xlabel("time (s)")
+    ax2.set_ylabel("acceleration (m/s^2)")
+    ax2.legend(["meas_forward", "meas_right", "predicted_forward", "predicted_right"])
+    plt.show()
+
+if __name__ == '__main__':
+    import os
+    import argparse
+
+    # Get the path of this script (without file name)
+    script_path = os.path.split(os.path.realpath(__file__))[0]
+
+    # Parse arguments
+    parser = argparse.ArgumentParser(
+        description='Estimate mag biases from ULog file')
+
+    # Provide parameter file path and name
+    parser.add_argument('logfile', help='Full ulog file path, name and extension', type=str)
+    args = parser.parse_args()
+
+    logfile = os.path.abspath(args.logfile) # Convert to absolute path
+
+    run(logfile)
@@ -0,0 +1,32 @@
+# PX4 Drag fusion parameter tuning algorithm
+In PX4, drag fusion can be enabled in order to estimate the wind when flying a multirotor, assuming that the body vertical acceleration is produced by the rotors and that the lateral forces are produced by drag.
+The model assumes a combination of:
+1. momentum drag: created by the rotors changing the direction of the incoming air, linear to the relative airspeed. Parameter `EKF2_MCOEF`
+2. bluff body drag: created by the wetted area of the aircraft, quadratic to the relative airspeed. Parameters `EKF2_BCOEF_X` and `EKF2_BCOEF_Y`
+
+The python script was created to automate the tuning of the aforementioned parameters using flight test data.
+
+## How to use this script
+First, a flight log with enough information is required in order to accurately estimate the parameters.
+The best way to do this is to fly the drone in altitude mode, accelerate to a moderate-high speed and let the drone slow-down by its own drag.
+Repeat the same maneuver in all directions and several times to obtain a good dataset.
+
+/!\ NOTE: the current state of this script assumes no wind. Some modifications are required to estimate both the wind and the parameters at the same time.
+
+Then, install the required python packages:
+```
+pip install -r requirements.txt
+```
+and run the script and give it the log file as an argument:
+```
+python drag_replay.py <logfilename.ulg>
+```
+
+The estimated parameters are displayed in the console and the fit quality is shown in a plot:
+```
+param set EKF2_BCOEF_X 0.0
+param set EKF2_BCOEF_Y 62.1
+param set EKF2_MCOEF 0.16
+/!\EXPERIMENTAL param set EKF2_DRAG_NOISE 0.31
+```
+![DeepinScreenshot_matplotlib_20220329100027](https://user-images.githubusercontent.com/14822839/160563024-efddd100-d7db-46f7-8676-cf4296e9f737.png)
@@ -0,0 +1,6 @@
+matplotlib==3.5.1
+numpy==1.22.2
+pyulog==0.9.0
+quaternion==3.5.2.post4
+scipy==1.8.0
+sympy==1.10.1
@@ -250,18 +250,32 @@ def create_pdf_report(ulog: ULog, multi_instance: int, output_plot_filename: str
        data_plot.save()
        data_plot.close()

+
        # Plot the EKF IMU vibration metrics
-        scaled_estimator_status = {'vibe[0]': 1000. * estimator_status['vibe[0]'],
-                                   'vibe[1]': 1000. * estimator_status['vibe[1]'],
-                                   'vibe[2]': estimator_status['vibe[2]']
-                                   }
-        data_plot = CheckFlagsPlot(
-            status_time, scaled_estimator_status, [['vibe[0]'], ['vibe[1]'], ['vibe[2]']],
-            x_label='time (sec)', y_labels=['Del Ang Coning (mrad)', 'HF Del Ang (mrad)',
-                                            'HF Del Vel (m/s)'], plot_title='IMU Vibration Metrics',
-            pdf_handle=pdf_pages, annotate=True)
-        data_plot.save()
-        data_plot.close()
+        for imu_status_instance in range(4):
+            try:
+                vehicle_imu_status_data = ulog.get_dataset('vehicle_imu_status', imu_status_instance).data
+
+                imu_status_time = 1e-6 * vehicle_imu_status_data['timestamp']
+
+                if vehicle_imu_status_data['accel_device_id'][0] == estimator_status['accel_device_id'][0]:
+
+                    scaled_estimator_status = {'delta_angle_coning_metric': 1000. * vehicle_imu_status_data['delta_angle_coning_metric'],
+                                               'gyro_vibration_metric': vehicle_imu_status_data['gyro_vibration_metric'],
+                                               'accel_vibration_metric': vehicle_imu_status_data['accel_vibration_metric']
+                                              }
+                    data_plot = CheckFlagsPlot(
+                        imu_status_time, scaled_estimator_status, [['delta_angle_coning_metric'], ['gyro_vibration_metric'], ['accel_vibration_metric']],
+                        x_label='time (sec)',
+                        y_labels=['Del Ang Coning (mrad^2)', 'HF Gyro (rad/s)', 'HF accel (m/s/s)'],
+                        plot_title='IMU Vibration Metrics',
+                        pdf_handle=pdf_pages, annotate=True)
+                    data_plot.save()
+                    data_plot.close()
+
+            except:
+                pass
+

        # Plot the EKF output observer tracking errors
        scaled_innovations = {
@@ -139,6 +139,7 @@ mc_hover_thrust_estimator,CONFIG_MODULES_MC_HOVER_THRUST_ESTIMATOR=y
 mc_pos_control,CONFIG_MODULES_MC_POS_CONTROL=y
 mc_rate_control,CONFIG_MODULES_MC_RATE_CONTROL=y
 micrortps_bridge,CONFIG_MODULES_MICRORTPS_BRIDGE=y
+microdds_client,CONFIG_MODULES_MICRODDS_CLIENT=y
 navigator,CONFIG_MODULES_NAVIGATOR=y
 px4iofirmware,CONFIG_MODULES_PX4IOFIRMWARE=y
 rc_update,CONFIG_MODULES_RC_UPDATE=y
@@ -0,0 +1,6 @@
+CONFIG_BOARD_TOOLCHAIN="arm-none-eabi"
+CONFIG_BOARD_ARCHITECTURE="cortex-m4"
+CONFIG_BOARD_ROMFSROOT=""
+CONFIG_BOARD_CONSTRAINED_MEMORY=y
+CONFIG_DRIVERS_BOOTLOADERS=y
+CONFIG_NSH_BUILTIN_APPS=y
@@ -0,0 +1,37 @@
+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_BOARD_EXTERNAL_METADATA=y
+CONFIG_COMMON_BAROMETERS=y
+CONFIG_COMMON_DIFFERENTIAL_PRESSURE=y
+CONFIG_COMMON_DISTANCE_SENSOR=y
+CONFIG_COMMON_HYGROMETERS=y
+CONFIG_COMMON_MAGNETOMETER=y
+CONFIG_COMMON_LIGHT=y
+CONFIG_DRIVERS_BATT_SMBUS=y
+CONFIG_DRIVERS_BOOTLOADERS=y
+CONFIG_DRIVERS_GPS=y
+CONFIG_DRIVERS_IMU_ANALOG_DEVICES_ADIS16448=y
+CONFIG_DRIVERS_IMU_INVENSENSE_ICM20948=y
+CONFIG_DRIVERS_IMU_INVENSENSE_ICM42688P=y
+CONFIG_DRIVERS_IRLOCK=y
+CONFIG_DRIVERS_PWM_OUT=y
+CONFIG_BOARD_UAVCAN_INTERFACES=1
+CONFIG_DRIVERS_UAVCANNODE=y
+CONFIG_MODULES_CONTROL_ALLOCATOR=y
+#CONFIG_MODULES_SENSORS=y
+CONFIG_NSH_BUILTIN_APPS=y
+CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
+CONFIG_SYSTEMCMDS_I2CDETECT=y
+CONFIG_SYSTEMCMDS_LED_CONTROL=y
+CONFIG_SYSTEMCMDS_MIXER=y
+CONFIG_SYSTEMCMDS_UORB=y
+CONFIG_SYSTEMCMDS_PARAM=y
+CONFIG_SYSTEMCMDS_TOP=y
+CONFIG_SYSTEMCMDS_TOPIC_LISTENER=y
+CONFIG_SYSTEMCMDS_PWM=y
+CONFIG_SYSTEMCMDS_REBOOT=y
+CONFIG_SYSTEMCMDS_WORK_QUEUE=y
@@ -0,0 +1,13 @@
+{
+    "board_id": 83,
+    "magic": "PX4FWv1",
+    "description": "Firmware for the ARK CANnode board",
+    "image": "",
+    "build_time": 0,
+    "summary": "ARKCANNODE",
+    "version": "0.1",
+    "image_size": 0,
+    "image_maxsize": 2080768,
+    "git_identity": "",
+    "board_revision": 0
+}
@@ -0,0 +1,7 @@
+#!/bin/sh
+#
+# board specific defaults
+#------------------------------------------------------------------------------
+pwm_out start
+
+control_allocator start
@@ -0,0 +1,118 @@
+#!/bin/sh
+#
+# board sensors init
+#------------------------------------------------------------------------------
+icm42688p -R 0 -s start
+
+if param compare -s SENS_EN_BATT 1
+then
+	batt_smbus start -X
+fi
+
+# Lidar-Lite on I2C
+if param compare -s SENS_EN_LL40LS 2
+then
+	ll40ls start -X
+fi
+
+# mappydot lidar sensor
+if param compare -s SENS_EN_MPDT 1
+then
+	mappydot start -X
+fi
+
+# mb12xx sonar sensor
+if param greater -s SENS_EN_MB12XX 0
+then
+	mb12xx start -X
+fi
+
+# Lightware i2c lidar sensor
+if param greater -s SENS_EN_SF1XX 0
+then
+	lightware_laser_i2c start -X
+fi
+
+# vl53l1x i2c distance sensor
+if param compare -s SENS_EN_VL53L1X 1
+then
+	vl53l1x start -X
+fi
+
+# ADIS16448 spi external IMU
+if param compare -s SENS_EN_ADIS164X 1
+then
+	if param compare -s SENS_OR_ADIS164X 0
+	then
+		adis16448 -S start
+	fi
+	if param compare -s SENS_OR_ADIS164X 4
+	then
+		adis16448 -S start -R 4
+	fi
+fi
+
+# Eagle Tree airspeed sensor external I2C
+if param compare -s SENS_EN_ETSASPD 1
+then
+	ets_airspeed start -X
+fi
+
+# Sensirion SDP3X differential pressure sensor external I2C
+if param compare -s SENS_EN_SDP3X 1
+then
+	if ! sdp3x_airspeed start -X
+	then
+		# try another common address
+		sdp3x_airspeed start -X -a 0x22
+	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
+	ms4525_airspeed start -X
+fi
+
+# TE MS5525 differential pressure sensor external I2C
+if param compare -s SENS_EN_MS5525 1
+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
+
+gps start -d /dev/ttyS0 -p ubx
+
+# probe for optional external I2C devices
+icm20948_i2c_passthrough -X -q start
+
+# compasses
+hmc5883 -T -X -q start
+ist8308 -X -q start
+ist8310 -X -q start
+lis2mdl -X -q start
+lis3mdl -X -q start
+qmc5883l -X -q start
+rm3100 -X -q start
+
+# start last (wait for possible icm20948 passthrough mode)
+ak09916 -X -q start
@@ -0,0 +1,61 @@
+#
+# This file is autogenerated: PLEASE DO NOT EDIT IT.
+#
+# You can use "make menuconfig" to make any modifications to the installed .config file.
+# You can then do "make savedefconfig" to generate a new defconfig file that includes your
+# modifications.
+#
+CONFIG_ARCH="arm"
+CONFIG_ARCH_BOARD_CUSTOM=y
+CONFIG_ARCH_BOARD_CUSTOM_DIR="../../../../boards/ark/cannode/nuttx-config"
+CONFIG_ARCH_BOARD_CUSTOM_DIR_RELPATH=y
+CONFIG_ARCH_BOARD_CUSTOM_NAME="px4"
+CONFIG_ARCH_CHIP="stm32"
+CONFIG_ARCH_CHIP_STM32=y
+CONFIG_ARCH_CHIP_STM32F412CE=y
+CONFIG_ARCH_INTERRUPTSTACK=4096
+CONFIG_ARMV7M_MEMCPY=y
+CONFIG_ARMV7M_USEBASEPRI=y
+CONFIG_BINFMT_DISABLE=y
+CONFIG_BOARD_LOOPSPERMSEC=16717
+CONFIG_C99_BOOL8=y
+CONFIG_CLOCK_MONOTONIC=y
+CONFIG_DEBUG_FULLOPT=y
+CONFIG_DEBUG_SYMBOLS=y
+CONFIG_DEFAULT_SMALL=y
+CONFIG_DISABLE_MOUNTPOINT=y
+CONFIG_DISABLE_MQUEUE=y
+CONFIG_DISABLE_PTHREAD=y
+CONFIG_EXPERIMENTAL=y
+CONFIG_FDCLONE_DISABLE=y
+CONFIG_FDCLONE_STDIO=y
+CONFIG_HAVE_CXX=y
+CONFIG_HAVE_CXXINITIALIZE=y
+CONFIG_IDLETHREAD_STACKSIZE=4096
+CONFIG_LIBC_FLOATINGPOINT=y
+CONFIG_LIBC_LONG_LONG=y
+CONFIG_LIBC_STRERROR=y
+CONFIG_LIB_BOARDCTL=y
+CONFIG_FS_PROCFS_MAX_TASKS=0
+CONFIG_MM_REGIONS=2
+CONFIG_NAME_MAX=0
+CONFIG_NUNGET_CHARS=0
+CONFIG_PREALLOC_TIMERS=0
+CONFIG_PTHREAD_STACK_MIN=512
+CONFIG_RAM_SIZE=262144
+CONFIG_RAM_START=0x20010000
+CONFIG_RAW_BINARY=y
+CONFIG_SDCLONE_DISABLE=y
+CONFIG_SIG_DEFAULT=y
+CONFIG_SIG_SIGALRM_ACTION=y
+CONFIG_SIG_SIGUSR1_ACTION=y
+CONFIG_SIG_SIGUSR2_ACTION=y
+CONFIG_STACK_COLORATION=y
+CONFIG_START_DAY=30
+CONFIG_START_MONTH=11
+CONFIG_STDIO_DISABLE_BUFFERING=y
+CONFIG_STM32_FLASH_CONFIG_G=y
+CONFIG_STM32_NOEXT_VECTORS=y
+CONFIG_TASK_NAME_SIZE=0
+CONFIG_USEC_PER_TICK=1000
+CONFIG_USERMAIN_STACKSIZE=4096
@@ -0,0 +1,149 @@
+/************************************************************************************
+ * configs/px4fmu/include/board.h
+ * include/arch/board/board.h
+ *
+ *   Copyright (C) 2009 Gregory Nutt. All rights reserved.
+ *   Author: Gregory Nutt <gnutt@nuttx.org>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ *
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in
+ *    the documentation and/or other materials provided with the
+ *    distribution.
+ * 3. Neither the name NuttX nor the names of its contributors may be
+ *    used to endorse or promote products derived from this software
+ *    without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+ * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
+ * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
+ * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
+ * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
+ * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
+ * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
+ * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGE.
+ *
+ ************************************************************************************/
+#include "board_dma_map.h"
+
+#ifndef __ARCH_BOARD_BOARD_H
+#define __ARCH_BOARD_BOARD_H
+
+#include <nuttx/config.h>
+#ifndef __ASSEMBLY__
+# include <stdint.h>
+#endif
+
+#include <stm32.h>
+
+/* HSI - 8 MHz RC factory-trimmed
+ * LSI - 32 KHz RC
+ * HSE - 8  MHz Crystal
+ * LSE - not installed
+ */
+#define STM32_BOARD_USEHSE      1
+#define STM32_BOARD_XTAL        8000000
+#define STM32_HSE_FREQUENCY     STM32_BOARD_XTAL
+
+#define STM32_HSI_FREQUENCY     16000000ul
+#define STM32_LSI_FREQUENCY     32000
+
+/* Main PLL Configuration */
+#define STM32_PLLCFG_PLLM       RCC_PLLCFG_PLLM(8)
+#define STM32_PLLCFG_PLLN       RCC_PLLCFG_PLLN(384)
+#define STM32_PLLCFG_PLLP       RCC_PLLCFG_PLLP_4
+#define STM32_PLLCFG_PLLQ       RCC_PLLCFG_PLLQ(8)
+#define STM32_PLLCFG_PLLR       RCC_PLLCFG_PLLR(2)
+
+#define STM32_RCC_PLLI2SCFGR_PLLI2SM RCC_PLLI2SCFGR_PLLI2SM(16)
+#define STM32_RCC_PLLI2SCFGR_PLLI2SN RCC_PLLI2SCFGR_PLLI2SN(192)
+#define STM32_RCC_PLLI2SCFGR_PLLI2SQ RCC_PLLI2SCFGR_PLLI2SQ(2)
+#define STM32_RCC_PLLI2SCFGR_PLLI2SR RCC_PLLI2SCFGR_PLLI2SR(2)
+#define STM32_RCC_PLLI2SCFGR_PLLI2SSRC RCC_PLLI2SCFGR_PLLI2SSRC(0) /* HSE or HSI depending on PLLSRC of PLLCFGR*/
+
+#define STM32_RCC_DCKCFGR2_CK48MSEL RCC_DCKCFGR2_CK48MSEL_PLL
+#define STM32_RCC_DCKCFGR2_FMPI2C1SEL RCC_DCKCFGR2_FMPI2C1SEL_APB
+#define STM32_RCC_DCKCFGR2_SDIOSEL RCC_DCKCFGR2_SDIOSEL_48MHZ
+
+#define STM32_SYSCLK_FREQUENCY  96000000ul
+
+/* AHB clock (HCLK) is SYSCLK (96MHz) */
+#define STM32_RCC_CFGR_HPRE     RCC_CFGR_HPRE_SYSCLK      /* HCLK  = SYSCLK / 1 */
+#define STM32_HCLK_FREQUENCY    STM32_SYSCLK_FREQUENCY
+#define STM32_BOARD_HCLK        STM32_HCLK_FREQUENCY      /* Same as above, to satisfy compiler */
+
+/* APB1 clock (PCLK1) is HCLK/2 (48MHz) */
+#define STM32_RCC_CFGR_PPRE1    RCC_CFGR_PPRE1_HCLKd2     /* PCLK1 = HCLK / 2 */
+#define STM32_PCLK1_FREQUENCY   (STM32_HCLK_FREQUENCY/2)
+
+/* Timers driven from APB1 will be twice PCLK1 (see page 112 of reference manual) */
+#define STM32_APB1_TIM2_CLKIN   (2*STM32_PCLK1_FREQUENCY)
+#define STM32_APB1_TIM3_CLKIN   (2*STM32_PCLK1_FREQUENCY)
+#define STM32_APB1_TIM4_CLKIN   (2*STM32_PCLK1_FREQUENCY)
+#define STM32_APB1_TIM5_CLKIN   (2*STM32_PCLK1_FREQUENCY)
+#define STM32_APB1_TIM6_CLKIN   (2*STM32_PCLK1_FREQUENCY)
+#define STM32_APB1_TIM7_CLKIN   (2*STM32_PCLK1_FREQUENCY)
+#define STM32_APB1_TIM12_CLKIN  (2*STM32_PCLK1_FREQUENCY)
+
+/* APB2 clock (PCLK2) is HCLK (96MHz) */
+#define STM32_RCC_CFGR_PPRE2    RCC_CFGR_PPRE2_HCLK       /* PCLK2 = HCLK */
+#define STM32_PCLK2_FREQUENCY   (STM32_HCLK_FREQUENCY)
+
+/* Timers driven from APB2 will be PCLK2 since no prescale division */
+#define STM32_APB2_TIM1_CLKIN   (STM32_PCLK2_FREQUENCY)
+#define STM32_APB2_TIM8_CLKIN   (STM32_PCLK2_FREQUENCY)
+#define STM32_APB2_TIM9_CLKIN   (STM32_PCLK2_FREQUENCY)
+#define STM32_APB2_TIM10_CLKIN  (STM32_PCLK2_FREQUENCY)
+#define STM32_APB2_TIM11_CLKIN  (STM32_PCLK2_FREQUENCY)
+
+/* Timer Frequencies, if APBx is set to 1, frequency is same to APBx otherwise frequency is 2xAPBx. */
+#define BOARD_TIM2_FREQUENCY    (2 * STM32_PCLK1_FREQUENCY)
+#define BOARD_TIM3_FREQUENCY    (2 * STM32_PCLK1_FREQUENCY)
+#define BOARD_TIM4_FREQUENCY    (2 * STM32_PCLK1_FREQUENCY)
+#define BOARD_TIM5_FREQUENCY    (2 * STM32_PCLK1_FREQUENCY)
+#define BOARD_TIM6_FREQUENCY    (2 * STM32_PCLK1_FREQUENCY)
+#define BOARD_TIM7_FREQUENCY    (2 * STM32_PCLK1_FREQUENCY)
+#define BOARD_TIM8_FREQUENCY    (2 * STM32_PCLK2_FREQUENCY)
+
+/* Alternate function pin selections ************************************************/
+
+/* UARTs */
+#define GPIO_USART1_RX	GPIO_USART1_RX_2
+#define GPIO_USART1_TX	GPIO_USART1_TX_3
+
+#define GPIO_USART2_RX	GPIO_USART2_RX_1
+#define GPIO_USART2_TX	GPIO_USART2_TX_1
+
+/* CAN */
+#define GPIO_CAN1_RX	GPIO_CAN1_RX_1
+#define GPIO_CAN1_TX	GPIO_CAN1_TX_1
+
+/* SPI */
+#define GPIO_SPI1_MISO  GPIO_SPI1_MISO_1
+#define GPIO_SPI1_MOSI  GPIO_SPI1_MOSI_1
+#define GPIO_SPI1_SCK   GPIO_SPI1_SCK_1
+
+#define GPIO_SPI2_MISO  GPIO_SPI2_MISO_1 /* PB14 */
+#define GPIO_SPI2_MOSI  GPIO_SPI2_MOSI_1 /* PB15 */
+#define GPIO_SPI2_SCK   GPIO_SPI2_SCK_2  /* PB13 */
+
+/* I2C */
+#define GPIO_MCU_I2C1_SCL
+#define GPIO_MCU_I2C1_SDA
+
+#define GPIO_I2C1_SCL	GPIO_I2C1_SCL_1
+#define GPIO_I2C1_SDA	GPIO_I2C1_SDA_2
+
+#define GPIO_I2C1_SCL_GPIO                  (GPIO_OUTPUT | GPIO_OPENDRAIN |GPIO_SPEED_50MHz | GPIO_OUTPUT_SET | GPIO_PORTB | GPIO_PIN6)
+#define GPIO_I2C1_SDA_GPIO                  (GPIO_OUTPUT | GPIO_OPENDRAIN |GPIO_SPEED_50MHz | GPIO_OUTPUT_SET | GPIO_PORTB | GPIO_PIN7)
+
+#endif /* __ARCH_BOARD_BOARD_H */
@@ -0,0 +1,44 @@
+/****************************************************************************
+ *
+ *   Copyright (c) 2021 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
+ * are met:
+ *
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in
+ *    the documentation and/or other materials provided with the
+ *    distribution.
+ * 3. Neither the name PX4 nor the names of its contributors may be
+ *    used to endorse or promote products derived from this software
+ *    without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+ * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
+ * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
+ * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
+ * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
+ * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
+ * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
+ * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGE.
+ *
+ ****************************************************************************/
+
+#pragma once
+
+// DMA1 Channel/Stream Selections
+//--------------------------------------------//---------------------------//----------------
+#define DMACHAN_SPI2_RX    DMAMAP_SPI2_RX   // DMA1, Stream 3, Channel 0
+#define DMACHAN_SPI2_TX    DMAMAP_SPI2_TX   // DMA1, Stream 4, Channel 0
+
+//  DMA2 Channel/Stream Selections
+//--------------------------------------------//---------------------------//----------------
+#define DMACHAN_SPI1_RX    DMAMAP_SPI1_RX_2   // DMA2, Stream 2, Channel 3
+#define DMACHAN_SPI1_TX    DMAMAP_SPI1_TX_2   // DMA2, Stream 5, Channel 3
@@ -0,0 +1,161 @@
+#
+# This file is autogenerated: PLEASE DO NOT EDIT IT.
+#
+# You can use "make menuconfig" to make any modifications to the installed .config file.
+# You can then do "make savedefconfig" to generate a new defconfig file that includes your
+# modifications.
+#
+# CONFIG_DISABLE_OS_API is not set
+# CONFIG_DISABLE_PSEUDOFS_OPERATIONS is not set
+# CONFIG_NSH_DISABLEBG is not set
+# CONFIG_NSH_DISABLESCRIPT is not set
+# CONFIG_NSH_DISABLE_DF is not set
+# CONFIG_NSH_DISABLE_EXEC is not set
+# CONFIG_NSH_DISABLE_EXIT is not set
+# CONFIG_NSH_DISABLE_GET is not set
+# CONFIG_NSH_DISABLE_ITEF is not set
+# CONFIG_NSH_DISABLE_LOOPS is not set
+# CONFIG_NSH_DISABLE_MKFATFS is not set
+# CONFIG_NSH_DISABLE_SEMICOLON is not set
+# CONFIG_NSH_DISABLE_TIME is not set
+# CONFIG_STM32_DMACAPABLE is not set
+CONFIG_ARCH="arm"
+CONFIG_ARCH_BOARD_CUSTOM=y
+CONFIG_ARCH_BOARD_CUSTOM_DIR="../../../../boards/ark/cannode/nuttx-config"
+CONFIG_ARCH_BOARD_CUSTOM_DIR_RELPATH=y
+CONFIG_ARCH_BOARD_CUSTOM_NAME="px4"
+CONFIG_ARCH_CHIP="stm32"
+CONFIG_ARCH_CHIP_STM32=y
+CONFIG_ARCH_CHIP_STM32F412CE=y
+CONFIG_ARCH_INTERRUPTSTACK=512
+CONFIG_ARCH_STACKDUMP=y
+CONFIG_ARMV7M_MEMCPY=y
+CONFIG_ARMV7M_USEBASEPRI=y
+CONFIG_BOARDCTL_RESET=y
+CONFIG_BOARD_LOOPSPERMSEC=16717
+CONFIG_BOARD_RESET_ON_ASSERT=2
+CONFIG_BUILTIN=y
+CONFIG_C99_BOOL8=y
+CONFIG_CLOCK_MONOTONIC=y
+CONFIG_DEBUG_FULLOPT=y
+CONFIG_DEBUG_HARDFAULT_ALERT=y
+CONFIG_DEBUG_SYMBOLS=y
+CONFIG_DEFAULT_SMALL=y
+CONFIG_DEV_FIFO_SIZE=0
+CONFIG_DEV_PIPE_MAXSIZE=1024
+CONFIG_DEV_PIPE_SIZE=70
+CONFIG_FDCLONE_STDIO=y
+CONFIG_FS_BINFS=y
+CONFIG_FS_CROMFS=y
+CONFIG_FS_FAT=y
+CONFIG_FS_FATTIME=y
+CONFIG_FS_PROCFS=y
+CONFIG_FS_PROCFS_INCLUDE_PROGMEM=y
+CONFIG_FS_PROCFS_REGISTER=y
+CONFIG_FS_ROMFS=y
+CONFIG_GRAN=y
+CONFIG_GRAN_INTR=y
+CONFIG_HAVE_CXX=y
+CONFIG_HAVE_CXXINITIALIZE=y
+CONFIG_I2C=y
+CONFIG_I2C_RESET=y
+CONFIG_IDLETHREAD_STACKSIZE=750
+CONFIG_LIBC_FLOATINGPOINT=y
+CONFIG_LIBC_LONG_LONG=y
+CONFIG_LIBC_STRERROR=y
+CONFIG_MEMSET_64BIT=y
+CONFIG_MEMSET_OPTSPEED=y
+CONFIG_MM_REGIONS=2
+CONFIG_MTD=y
+CONFIG_MTD_BYTE_WRITE=y
+CONFIG_MTD_PARTITION=y
+CONFIG_MTD_RAMTRON=y
+CONFIG_NAME_MAX=40
+CONFIG_NSH_ARCHINIT=y
+CONFIG_NSH_ARGCAT=y
+CONFIG_NSH_BUILTIN_APPS=y
+CONFIG_NSH_CMDPARMS=y
+CONFIG_NSH_CROMFSETC=y
+CONFIG_NSH_DISABLE_IFCONFIG=y
+CONFIG_NSH_DISABLE_IFUPDOWN=y
+CONFIG_NSH_DISABLE_TELNETD=y
+CONFIG_NSH_LINELEN=128
+CONFIG_NSH_MAXARGUMENTS=15
+CONFIG_NSH_NESTDEPTH=8
+CONFIG_NSH_QUOTE=y
+CONFIG_NSH_ROMFSETC=y
+CONFIG_NSH_ROMFSSECTSIZE=128
+CONFIG_NSH_STRERROR=y
+CONFIG_NSH_VARS=y
+CONFIG_PIPES=y
+CONFIG_PREALLOC_TIMERS=50
+CONFIG_PRIORITY_INHERITANCE=y
+CONFIG_PTHREAD_MUTEX_ROBUST=y
+CONFIG_PTHREAD_STACK_MIN=512
+CONFIG_RAMTRON_SETSPEED=y
+CONFIG_RAM_SIZE=262144
+CONFIG_RAM_START=0x20000000
+CONFIG_RAW_BINARY=y
+CONFIG_RTC_DATETIME=y
+CONFIG_SCHED_ATEXIT=y
+CONFIG_SCHED_HPWORK=y
+CONFIG_SCHED_HPWORKPRIORITY=254
+CONFIG_SCHED_HPWORKSTACKSIZE=3000
+CONFIG_SCHED_INSTRUMENTATION=y
+CONFIG_SCHED_INSTRUMENTATION_EXTERNAL=y
+CONFIG_SCHED_LPWORK=y
+CONFIG_SCHED_LPWORKPRIORITY=50
+CONFIG_SCHED_LPWORKSTACKSIZE=1632
+CONFIG_SCHED_WAITPID=y
+CONFIG_SEM_NNESTPRIO=8
+CONFIG_SEM_PREALLOCHOLDERS=0
+CONFIG_SERIAL_TERMIOS=y
+CONFIG_SIG_DEFAULT=y
+CONFIG_SIG_SIGALRM_ACTION=y
+CONFIG_SIG_SIGUSR1_ACTION=y
+CONFIG_SIG_SIGUSR2_ACTION=y
+CONFIG_SIG_SIGWORK=4
+CONFIG_STACK_COLORATION=y
+CONFIG_START_DAY=30
+CONFIG_START_MONTH=11
+CONFIG_STDIO_BUFFER_SIZE=32
+CONFIG_STM32_ADC1=y
+CONFIG_STM32_DISABLE_IDLE_SLEEP_DURING_DEBUG=y
+CONFIG_STM32_DMA1=y
+CONFIG_STM32_DMA2=y
+CONFIG_STM32_FLASH_CONFIG_G=y
+CONFIG_STM32_FLASH_PREFETCH=y
+CONFIG_STM32_FLOWCONTROL_BROKEN=y
+CONFIG_STM32_I2C1=y
+CONFIG_STM32_JTAG_SW_ENABLE=y
+CONFIG_STM32_PWR=y
+CONFIG_STM32_RTC=y
+CONFIG_STM32_RTC_HSECLOCK=y
+CONFIG_STM32_RTC_MAGIC=0xfacefeee
+CONFIG_STM32_RTC_MAGIC_REG=1
+CONFIG_STM32_RTC_MAGIC_TIME_SET=0xfacefeef
+CONFIG_STM32_SERIALBRK_BSDCOMPAT=y
+CONFIG_STM32_SERIAL_DISABLE_REORDERING=y
+CONFIG_STM32_SPI1=y
+CONFIG_STM32_SPI1_DMA=y
+CONFIG_STM32_SPI1_DMA_BUFFER=2048
+CONFIG_STM32_SPI2=y
+CONFIG_STM32_SPI2_DMA=y
+CONFIG_STM32_SPI2_DMA_BUFFER=2048
+CONFIG_STM32_SPI_DMA=y
+CONFIG_STM32_USART1=y
+CONFIG_STM32_USART2=y
+CONFIG_STM32_USART_BREAKS=y
+CONFIG_STM32_WWDG=y
+CONFIG_SYSTEM_NSH=y
+CONFIG_TASK_NAME_SIZE=24
+CONFIG_USART1_BAUD=57600
+CONFIG_USART1_RXBUFSIZE=600
+CONFIG_USART1_TXBUFSIZE=1100
+CONFIG_USART2_BAUD=57600
+CONFIG_USART2_RXBUFSIZE=600
+CONFIG_USART2_SERIAL_CONSOLE=y
+CONFIG_USART2_TXBUFSIZE=1100
+CONFIG_USEC_PER_TICK=1000
+CONFIG_USERMAIN_STACKSIZE=2624
+CONFIG_USER_ENTRYPOINT="nsh_main"
@@ -0,0 +1,134 @@
+/****************************************************************************
+ * nuttx-config/scripts/canbootloader_script.ld
+ *
+ *   Copyright (C) 2015 Gregory Nutt. All rights reserved.
+ *   Author: Gregory Nutt <gnutt@nuttx.org>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ *
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in
+ *    the documentation and/or other materials provided with the
+ *    distribution.
+ * 3. Neither the name NuttX nor the names of its contributors may be
+ *    used to endorse or promote products derived from this software
+ *    without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+ * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
+ * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
+ * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
+ * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
+ * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
+ * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
+ * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGE.
+ *
+ ****************************************************************************/
+
+/* The STM32F412 has 512Kb of FLASH beginning at address 0x0800:0000 and
+ * 256Kb of SRAM. SRAM is split up into three blocks:
+ *
+ * 1) 112Kb of SRAM beginning at address 0x2000:0000
+ * 2)  16Kb of SRAM beginning at address 0x2001:c000
+ * 3)  64Kb of SRAM beginning at address 0x2002:0000
+ * 4)  64Kb of TCM SRAM beginning at address 0x1000:0000
+ *
+ * When booting from FLASH, FLASH memory is aliased to address 0x0000:0000
+ * where the code expects to begin execution by jumping to the entry point in
+ * the 0x0800:0000 address range.
+ *
+ * The first 0x10000 of flash is reserved for the bootloader.
+ */
+
+MEMORY
+{
+    flash (rx)   : ORIGIN = 0x08000000, LENGTH = 32K
+    sram (rwx)   : ORIGIN = 0x20000000, LENGTH = 192K
+}
+
+OUTPUT_ARCH(arm)
+
+ENTRY(__start)		/* treat __start as the anchor for dead code stripping */
+EXTERN(_vectors)	/* force the vectors to be included in the output */
+
+/*
+ * Ensure that abort() is present in the final object.  The exception handling
+ * code pulled in by libgcc.a requires it (and that code cannot be easily avoided).
+ */
+EXTERN(abort)
+SECTIONS
+{
+	.text : {
+		_stext = ABSOLUTE(.);
+		*(.vectors)
+		*(.text .text.*)
+		*(.fixup)
+		*(.gnu.warning)
+		*(.rodata .rodata.*)
+		*(.gnu.linkonce.t.*)
+		*(.got)
+		*(.gcc_except_table)
+		*(.gnu.linkonce.r.*)
+		_etext = ABSOLUTE(.);
+	} > flash
+
+	/*
+	 * Init functions (static constructors and the like)
+	 */
+        .init_section : {
+                _sinit = ABSOLUTE(.);
+                KEEP(*(.init_array .init_array.*))
+                _einit = ABSOLUTE(.);
+        } > flash
+
+	.ARM.extab : {
+		*(.ARM.extab*)
+	} > flash
+
+	__exidx_start = ABSOLUTE(.);
+	.ARM.exidx : {
+		*(.ARM.exidx*)
+	} > flash
+	__exidx_end = ABSOLUTE(.);
+
+	_eronly = ABSOLUTE(.);
+
+	.data : {
+		_sdata = ABSOLUTE(.);
+		*(.data .data.*)
+		*(.gnu.linkonce.d.*)
+		CONSTRUCTORS
+		_edata = ABSOLUTE(.);
+	} > sram AT > flash
+
+	.bss : {
+		_sbss = ABSOLUTE(.);
+		*(.bss .bss.*)
+		*(.gnu.linkonce.b.*)
+		*(COMMON)
+		. = ALIGN(4);
+		_ebss = ABSOLUTE(.);
+	} > sram
+
+	/* Stabs debugging sections. */
+	.stab 0 : { *(.stab) }
+	.stabstr 0 : { *(.stabstr) }
+	.stab.excl 0 : { *(.stab.excl) }
+	.stab.exclstr 0 : { *(.stab.exclstr) }
+	.stab.index 0 : { *(.stab.index) }
+	.stab.indexstr 0 : { *(.stab.indexstr) }
+	.comment 0 : { *(.comment) }
+	.debug_abbrev 0 : { *(.debug_abbrev) }
+	.debug_info 0 : { *(.debug_info) }
+	.debug_line 0 : { *(.debug_line) }
+	.debug_pubnames 0 : { *(.debug_pubnames) }
+	.debug_aranges 0 : { *(.debug_aranges) }
+}
--- a/Show More
+++ b/Show More