Update submodule devices to latest Thu Sep 4 12:39:24 UTC 2025

- devices in PX4/Firmware (2538feab9b0245bcdb7f3fe1d0c70d354bdf7d0f): https://github.com/PX4/PX4-GPSDrivers/commit/ce0afaeca23a3b88efcf52d47c82277839980f9d - devices current upstream: https://github.com/PX4/PX4-GPSDrivers/commit/8fdef3bc0cb7820119abdb7320ad3992af2e440f - Changes: https://github.com/PX4/PX4-GPSDrivers/compare/ce0afaeca23a3b88efcf52d47c82277839980f9d...8fdef3bc0cb7820119abdb7320ad3992af2e440f 8fdef3b 2025-09-02 Øyvind Taksdal Stubhaug - ubx: don't inject RTCM while configuring device (#187) f66ac07 2025-08-28 Alex Klimaj - ubx: add support for DAN-F10N and X20 (#181)
doc: Change email for Pedro Roque (#25514 )
2026-06-15 05:00:04 +08:00 · 2025-09-04 12:39:24 +00:00 · 2025-09-02 16:07:55 -08:00 · 2025-09-02 16:27:26 -07:00 · 2025-09-02 10:02:15 -08:00 · 2025-09-02 10:16:32 -06:00
146 changed files with 2250 additions and 537 deletions
@@ -36,6 +36,11 @@ CONFIG:
      buildType: RelWithDebInfo
      settings:
        CONFIG: px4_sitl_test
+    px4_sitl_zenoh:
+      short: px4_sitl_zenoh
+      buildType: RelWithDebInfo
+      settings:
+        CONFIG: px4_sitl_test
    px4_io-v2_default:
      short: px4_io-v2
      buildType: MinSizeRel
@@ -73,6 +73,11 @@ menu "Toolchain"
        help
            relative path to the ROMFS root directory

+    config BOARD_ADDITIONAL_INIT
+        string "Additional init file"
+        help
+            additional configurable init file to include in the ROMFS
+
    config BOARD_IO
        string "IO board name"
        default "px4_io-v2_default"
@@ -19,7 +19,7 @@ See [the documentation on Maintainers](https://docs.px4.io/main/en/contribute/ma
 | Matthias Grob | Multirotor | [@MaEtUgR](https://github.com/MaEtUgR) | maetugr |
 | Silvan Fuhrer | Fixed-Wing / VTOL | [@sfuhrer](https://github.com/sfuhrer) | sfuhrer |
 | Christian Friedrich | Rover | [@chfriedrich98](https://github.com/chfriedrich98) | christian982564 |
-| Pedro Roque | Spacecraft | [@Pedro-Roque](https://github.com/Pedro-Roque) | .pedroroque | <padr@kth.se>
+| Pedro Roque | Spacecraft | [@Pedro-Roque](https://github.com/Pedro-Roque) | .pedroroque | <roque@caltech.edu>
 | Jacob Dahl | Simulation | [@dakejahl](https://github.com/dakejahl) | dakejahl | <dahl.jakejacob@gmail.com>


@@ -511,6 +511,7 @@ validate_module_configs:
 	@find "$(SRC_DIR)"/src/modules "$(SRC_DIR)"/src/drivers "$(SRC_DIR)"/src/lib -name *.yaml -type f \
 	-not -path "$(SRC_DIR)/src/lib/mixer_module/*" \
 	-not -path "$(SRC_DIR)/src/modules/uxrce_dds_client/dds_topics.yaml" \
+	-not -path "$(SRC_DIR)/src/modules/zenoh/dds_topics.yaml" \
 	-not -path "$(SRC_DIR)/src/modules/zenoh/zenoh-pico/*" \
 	-not -path "$(SRC_DIR)/src/lib/events/libevents/*" \
 	-not -path "$(SRC_DIR)/src/lib/cdrstream/*" \
@@ -202,18 +202,43 @@ foreach(board_rc_file ${OPTIONAL_BOARD_RC})

 endforeach()

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

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

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

+#
+# Optional additional init file: rc.additional_init
+#
+set BOARD_RC_ADDITIONAL_INIT ${R}etc/init.d/rc.additional_init
+if [ -f $BOARD_RC_ADDITIONAL_INIT ]
+then
+	echo "Board additional init: ${BOARD_RC_ADDITIONAL_INIT}"
+	. $BOARD_RC_ADDITIONAL_INIT
+fi
+unset BOARD_RC_ADDITIONAL_INIT
+
 #
 # Start system state indicator.
 #
@@ -1,10 +1,21 @@
 #!/bin/sh
 #
-# @name 3DoF Spacecraft Model
+# @name KTH-ATMOS
 #
-# @type 2D Freeflyer with 8 thrusters - Planar motion
+# @type Free-Flyer
+# @class Spacecraft
 #
-# @maintainer Pedro Roque <padr@kth.se>
+# @output Motor1 back left thruster, +x thrust
+# @output Motor2 front left thruster, -x thrust
+# @output Motor3 back right thruster, +x thrust
+# @output Motor4 front right thruster, -x thrust
+# @output Motor5 front left thruster, +y thrust
+# @output Motor6 front right thruster, -y thrust
+# @output Motor7 back left thruster, +y thrust
+# @output Motor8 back right thruster, -y thrust
+#
+# @maintainer discower-io
+# @url https://atmos.discower.io
 #

 . ${R}etc/init.d/rc.sc_defaults
@@ -324,6 +324,11 @@ fi

 uxrce_dds_client start -t udp -p $uxrce_dds_port $uxrce_dds_ns

+if param greater -s ZENOH_ENABLE 0
+then
+	zenoh start
+fi
+
 if param greater -s MNT_MODE_IN -1
 then
 	gimbal start
@@ -5,7 +5,17 @@
 # @type Free-Flyer
 # @class Spacecraft
 #
+# @output Motor1 back left thruster, +x thrust
+# @output Motor2 front left thruster, -x thrust
+# @output Motor3 back right thruster, +x thrust
+# @output Motor4 front right thruster, -x thrust
+# @output Motor5 front left thruster, +y thrust
+# @output Motor6 front right thruster, -y thrust
+# @output Motor7 back left thruster, +y thrust
+# @output Motor8 back right thruster, -y thrust
+#
 # @maintainer DISCOWER
+# @url https://atmos.discower.io
 #

 . ${R}etc/init.d/rc.sc_defaults
@@ -8,6 +8,9 @@
 #                 End Setup for board specific configurations.                #
 ###############################################################################

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

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

-if ! param compare SDLOG_MODE -1
+if param compare SDLOG_BACKEND 2
+then
+	set LOGGER_ARGS "${LOGGER_ARGS} -m mavlink"
+fi
+
+if param compare SDLOG_BACKEND 3
+then
+	set LOGGER_ARGS "${LOGGER_ARGS} -m all"
+fi
+
+#
+# Start logger if any logging backend is enabled
+#
+if ! param compare SDLOG_BACKEND 0
 then
 	logger start -b ${LOGGER_BUF} -t ${LOGGER_ARGS}
 fi
@@ -237,6 +237,7 @@ then
 	qmc5883p -X -q start
 	rm3100 -X -q start
 	bmm350 -X -q start
+	iis2mdc -X -q start

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

+	#
+	# Optional additional init file: rc.additional_init
+	#
+	set BOARD_RC_ADDITIONAL_INIT ${R}etc/init.d/rc.additional_init
+	if [ -f $BOARD_RC_ADDITIONAL_INIT ]
+	then
+		echo "Board additional init: ${BOARD_RC_ADDITIONAL_INIT}"
+		. $BOARD_RC_ADDITIONAL_INIT
+	fi
+	unset BOARD_RC_ADDITIONAL_INIT
+
 	# Load airframe configuration based on SYS_AUTOSTART parameter
 	if ! param compare SYS_AUTOSTART 0
 	then
@@ -613,9 +624,7 @@ else
 		. ${R}etc/init.d/rc.autostart.post
 	fi

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

-	#
-	# Bootloader upgrade (SD card)
-	#
-	if param compare -s SYS_BL_UPDATE 2
-	then
-		if [ -f "/fs/microsd/bl/bl.bin" ]
-		then
-			param set SYS_BL_UPDATE 0
-			param save
-			echo "bootloader update..."
-			bl_update "/fs/microsd/bl/bl.bin"
-			echo "bootloader update done, rebooting"
-			reboot
-		fi
-	fi
-
 	#
 	# Check if UAVCAN is enabled, default to it for ESCs.
 	#
@@ -49,14 +49,14 @@ for field in spec.parsed_fields():
            (package, name) = genmsg.names.package_resource_name(field.base_type)
            package = package or spec.package # convert '' to package

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



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

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

 #ifdef __cplusplus
 }
@@ -14,7 +14,6 @@ class AirframeGroup(object):
        self.af_class = af_class
        self.airframes = []

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

    def GetAirframes(self):
@@ -42,6 +42,7 @@ import os
 import argparse
 import re
 import sys
+import json

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


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

-    topics = []
-    for msg_filename in files:
-        topics.extend(get_topics(msg_filename))
+    rihs01_hashes = dict()
+    if rihs_path != '':
+        for topic in full_base_names:
+            with open(rihs_path + "/msg/" + topic + ".json") as f:
+                d = json.load(f)
+                assert d['type_hashes'][0]['hash_string'][:7] == 'RIHS01_'

-    tl_globals = {"msgs": filenames, "topics": topics, "datatypes": datatypes, "full_base_names": full_base_names}
+                rihs01_hash = d['type_hashes'][0]['hash_string'][7:]
+
+                byte_array = [f"0x{rihs01_hash[i:i+2]}" for i in range(0, len(rihs01_hash), 2)]
+                c_code = f"{{ {', '.join(byte_array)} }};"
+                rihs01_hashes[topic] = c_code
+
+    topics = []
+    datatypes_with_topics = dict()
+    for msg_filename in files:
+        datatype = re.sub(r'(?<!^)(?=[A-Z])', '_', os.path.basename(msg_filename)).lower().replace(".msg","")
+        datatypes_with_topics[datatype] = get_topics(msg_filename)
+        topics.extend(datatypes_with_topics[datatype])
+
+    tl_globals = {"msgs": filenames, "topics": topics, "datatypes": datatypes, "full_base_names": full_base_names, "rihs01_hashes": rihs01_hashes, "datatypes_with_topics": datatypes_with_topics}
    tl_template_file = os.path.join(templatedir, template_filename)
    tl_out_file = os.path.join(outputdir, template_filename.replace(".em", ""))

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

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

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

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

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

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


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


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


-Zenoh_Subscriber* genSubscriber(const char *name) {
+Zenoh_Subscriber* genSubscriber(const char *name, int instance) {
    for (auto &sub : _topics) {
-        if(strcmp(sub.orb_meta->o_name, name) == 0) {
-            return new uORB_Zenoh_Subscriber(sub.orb_meta, sub.ops);
+        for(int i = 0; i < sub.orb_topics_size; i++) {
+            if(strcmp(sub.orb_topic[i]->o_name, name) == 0) {
+                return new uORB_Zenoh_Subscriber(sub.orb_topic[i], sub.ops, instance);
+            }
+        }
+    }
+    return NULL;
+}
+
+const char* getTypeName(const char *name) {
+    for (auto &sub : _topics) {
+        for(int i = 0; i < sub.orb_topics_size; i++) {
+            if(strcmp(sub.orb_topic[i]->o_name, name) == 0) {
+                return sub.data_type_name;
+            }
+        }
+    }
+    return NULL;
+}
+
+
+const uint8_t* getRIHS01_Hash(const orb_metadata *meta) {
+    for (auto &sub : _topics) {
+        for(int i = 0; i < sub.orb_topics_size; i++) {
+            if(sub.orb_topic[i]->o_id == meta->o_id) {
+                return sub.hash;
+            }
+        }
+    }
+    return NULL;
+}
+
+const uint8_t* getRIHS01_Hash(const char *name) {
+    for (auto &sub : _topics) {
+        for(int i = 0; i < sub.orb_topics_size; i++) {
+            if(strcmp(sub.orb_topic[i]->o_name, name) == 0) {
+                return sub.hash;
+            }
        }
    }
    return NULL;
@@ -75,7 +75,6 @@ CONFIG_MODULES_UUV_POS_CONTROL=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
 CONFIG_SYSTEMCMDS_GPIO=y
@@ -35,7 +35,6 @@ CONFIG_MODULES_SENSORS=y
 CONFIG_MODULES_SIMULATION_SIMULATOR_SIH=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
 CONFIG_SYSTEMCMDS_HARDFAULT_LOG=y
@@ -21,6 +21,7 @@ CONFIG_COMMON_MAGNETOMETER=y
 CONFIG_DATAMAN_PERSISTENT_STORAGE=n
 CONFIG_DRIVERS_PWM_OUT=y
 CONFIG_COMMON_RC=y
+CONFIG_DRIVERS_PCA9685_PWM_OUT=y
 CONFIG_DRIVERS_POWER_MONITOR_INA226=y
 CONFIG_DRIVERS_POWER_MONITOR_INA228=y
 CONFIG_DRIVERS_POWER_MONITOR_INA238=y
@@ -14,7 +14,7 @@ param set-default SYS_DM_BACKEND 1
 # Set TELEM1 as default mavlink connection
 param set-default MAV_0_CONFIG 0
 # Disable logger writing to FRAM, only stream over MAVLINK
-set LOGGER_ARGS "-m mavlink"
+param set-default SDLOG_BACKEND 2

 # 200kOhm/10kOhm voltage divider on V_BAT
 param set-default BAT1_V_DIV 21
@@ -12,17 +12,20 @@ board_adc start
 bmi088 -A -R 0 -s start
 bmi088 -G -R 0 -s start

+# MAG on I2C4, ROTATION_ROLL_180=8
 if ver hwtypecmp V6S013 V6S015
 then
-	# Revision(s) with BMM150
-	# MAG on I2C4, ROTATION_ROLL_180=8
 	bmm150 -I -R 8 start
 else
-	# Revision(s) with BMM350
-	# MAG on I2C4, ROTATION_ROLL_180=8
 	bmm350 -I -R 8 start
 fi

+# BARO on I2C4
+bmp388 -I -b 4 -a 0x77 start
+
+
+# External sensors on I2C1
+
 if param compare SENS_EN_INA226 1
 then
 	# Start Digital power monitors
@@ -59,14 +62,17 @@ fi

 if param compare BAT1_V_CHANNEL -2
 then
-    if [ "$INA_CONFIGURED" != "yes" ]
-    then
-        param set BAT1_V_CHANNEL -1
-    fi
+	if [ "$INA_CONFIGURED" != "yes" ]
+	then
+		param set BAT1_V_CHANNEL -1
+	fi
 fi

-# External compass on GPS1/I2C1 (the 3rd external bus): standard Holybro Pixhawk 4 or CUAV V5 GPS/compass puck (with lights, safety button, and buzzer)
+# External compass IST8310 on I2C1
 ist8310 -X -b 1 -R 10 start

-# BARO on I2C4
-bmp388 -I -b 4 -a 0x77 start
+# Start an external PWM generator
+if param greater PCA9685_EN_BUS 0
+then
+	pca9685_pwm_out start -b 1
+fi
@@ -71,7 +71,6 @@ CONFIG_MODULES_UUV_POS_CONTROL=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
@@ -8,5 +8,4 @@ CONFIG_MODULES_LOCAL_POSITION_ESTIMATOR=n
 CONFIG_BOARD_TESTING=y
 CONFIG_DRIVERS_TEST_PPM=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_MICROBENCH=y
@@ -74,7 +74,6 @@ CONFIG_MODULES_UXRCE_DDS_CLIENT=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_GPIO=y
@@ -75,7 +75,6 @@ CONFIG_MODULES_UXRCE_DDS_CLIENT=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_GPIO=y
@@ -75,7 +75,6 @@ CONFIG_MODULES_UUV_POS_CONTROL=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
@@ -66,7 +66,6 @@ CONFIG_MODULES_UXRCE_DDS_CLIENT=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
 CONFIG_SYSTEMCMDS_GPIO=y
@@ -68,7 +68,6 @@ CONFIG_MODULES_UXRCE_DDS_CLIENT=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
 CONFIG_SYSTEMCMDS_GPIO=y
@@ -38,5 +38,5 @@ param set-default SYS_DM_BACKEND 1
 # Ignore that there is no SD card
 param set-default COM_ARM_SDCARD 0

-# Don't try to log onto SD card
-param set-default SDLOG_MODE -1
+# Disable logging
+param set-default SDLOG_BACKEND 0
@@ -38,5 +38,5 @@ param set-default SYS_DM_BACKEND 1
 # Ignore that there is no SD card
 param set-default COM_ARM_SDCARD 0

-# Don't try to log onto SD card
-param set-default SDLOG_MODE -1
+# Disable logging
+param set-default SDLOG_BACKEND 0
@@ -79,7 +79,6 @@ CONFIG_MODULES_UUV_POS_CONTROL=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
@@ -84,7 +84,6 @@ CONFIG_MODULES_UXRCE_DDS_CLIENT=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
@@ -79,7 +79,6 @@ CONFIG_MODULES_UXRCE_DDS_CLIENT=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
@@ -67,7 +67,6 @@ CONFIG_MODULES_UXRCE_DDS_CLIENT=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_GPIO=y
@@ -73,7 +73,6 @@ CONFIG_MODULES_UUV_POS_CONTROL=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
@@ -73,7 +73,6 @@ CONFIG_MODULES_UUV_POS_CONTROL=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
@@ -73,7 +73,6 @@ CONFIG_MODULES_UUV_POS_CONTROL=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
@@ -75,7 +75,6 @@ CONFIG_MODULES_UUV_POS_CONTROL=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
 CONFIG_SYSTEMCMDS_GPIO=y
@@ -8,5 +8,4 @@ CONFIG_MODULES_LOCAL_POSITION_ESTIMATOR=n
 CONFIG_BOARD_TESTING=y
 CONFIG_DRIVERS_TEST_PPM=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_MICROBENCH=y
@@ -14,6 +14,7 @@ CONFIG_MODULES_EKF2=y
 CONFIG_MODULES_MAVLINK=y
 CONFIG_MODULES_NAVIGATOR=y
 CONFIG_MODULES_SENSORS=y
+CONFIG_MODULES_ZENOH=y
 CONFIG_SYSTEMCMDS_I2CDETECT=y
 CONFIG_SYSTEMCMDS_LED_CONTROL=y
 CONFIG_SYSTEMCMDS_MFT=y
@@ -182,6 +182,7 @@ CONFIG_NET_SOLINGER=y
 CONFIG_NET_TCP=y
 CONFIG_NET_TCPBACKLOG=y
 CONFIG_NET_TCP_DELAYED_ACK=y
+CONFIG_NET_TCP_KEEPALIVE=y
 CONFIG_NET_TCP_WRITE_BUFFERS=y
 CONFIG_NET_TIMESTAMP=y
 CONFIG_NET_UDP=y
@@ -207,6 +208,7 @@ CONFIG_PIPES=y
 CONFIG_PREALLOC_TIMERS=50
 CONFIG_PRIORITY_INHERITANCE=y
 CONFIG_PTHREAD_MUTEX_ROBUST=y
+CONFIG_PTHREAD_MUTEX_TYPES=y
 CONFIG_PTHREAD_STACK_MIN=512
 CONFIG_RAM_SIZE=272000
 CONFIG_RAM_START=0x20400000
@@ -1,57 +0,0 @@
-# CONFIG_BOARD_ROMFSROOT is not set
-CONFIG_BOARD_SERIAL_GPS1="/dev/ttyS1"
-CONFIG_BOARD_SERIAL_GPS2="/dev/ttyS4"
-CONFIG_BOARD_SERIAL_RC="/dev/ttyS5"
-CONFIG_BOARD_SERIAL_TEL1="/dev/ttyS2"
-CONFIG_BOARD_SERIAL_TEL4="/dev/ttyS3"
-CONFIG_BOARD_UAVCAN_INTERFACES=1
-CONFIG_COMMON_LIGHT=y
-CONFIG_DRIVERS_ADC_BOARD_ADC=y
-CONFIG_DRIVERS_GPS=y
-CONFIG_DRIVERS_IRLOCK=y
-CONFIG_DRIVERS_MAGNETOMETER_ISENTEK_IST8310=y
-CONFIG_DRIVERS_MAGNETOMETER_LIS3MDL=y
-CONFIG_DRIVERS_RC_INPUT=y
-CONFIG_DRIVERS_SAFETY_BUTTON=y
-CONFIG_DRIVERS_UAVCAN=y
-CONFIG_EXAMPLES_FAKE_GPS=y
-CONFIG_MODULES_AIRSPEED_SELECTOR=y
-CONFIG_MODULES_ATTITUDE_ESTIMATOR_Q=y
-CONFIG_MODULES_BATTERY_STATUS=y
-CONFIG_MODULES_CAMERA_FEEDBACK=y
-CONFIG_MODULES_COMMANDER=y
-CONFIG_MODULES_ESC_BATTERY=y
-CONFIG_MODULES_EVENTS=y
-CONFIG_MODULES_FW_ATT_CONTROL=y
-CONFIG_MODULES_FW_AUTOTUNE_ATTITUDE_CONTROL=y
-CONFIG_MODULES_FW_MODE_MANAGER=y
-CONFIG_MODULES_FW_LATERAL_LONGITUDINAL_CONTROL=y
-CONFIG_MODULES_FW_RATE_CONTROL=y
-CONFIG_MODULES_GYRO_CALIBRATION=y
-CONFIG_MODULES_GYRO_FFT=y
-CONFIG_MODULES_LANDING_TARGET_ESTIMATOR=y
-CONFIG_MODULES_LAND_DETECTOR=y
-CONFIG_MODULES_LOAD_MON=y
-CONFIG_MODULES_LOCAL_POSITION_ESTIMATOR=y
-CONFIG_MODULES_LOGGER=y
-CONFIG_MODULES_MAG_BIAS_ESTIMATOR=y
-CONFIG_MODULES_MANUAL_CONTROL=y
-CONFIG_MODULES_MC_ATT_CONTROL=y
-CONFIG_MODULES_MC_AUTOTUNE_ATTITUDE_CONTROL=y
-CONFIG_MODULES_MC_HOVER_THRUST_ESTIMATOR=y
-CONFIG_MODULES_MC_POS_CONTROL=y
-CONFIG_MODULES_MC_RATE_CONTROL=y
-CONFIG_MODULES_NAVIGATOR=y
-CONFIG_MODULES_RC_UPDATE=y
-CONFIG_MODULES_TEMPERATURE_COMPENSATION=y
-CONFIG_MODULES_VTOL_ATT_CONTROL=y
-CONFIG_MODULES_ZENOH=y
-CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
-CONFIG_SYSTEMCMDS_DMESG=y
-CONFIG_SYSTEMCMDS_DUMPFILE=y
-CONFIG_SYSTEMCMDS_HARDFAULT_LOG=y
-CONFIG_SYSTEMCMDS_NSHTERM=y
-CONFIG_SYSTEMCMDS_PERF=y
-CONFIG_SYSTEMCMDS_REFLECT=y
-CONFIG_SYSTEMCMDS_SERIAL_TEST=y
-CONFIG_SYSTEMCMDS_TUNE_CONTROL=y
@@ -75,6 +75,7 @@ CONFIG_MODULES_SENSORS=y
 CONFIG_MODULES_TEMPERATURE_COMPENSATION=y
 CONFIG_MODULES_UXRCE_DDS_CLIENT=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
+CONFIG_MODULES_ZENOH=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DMESG=y
@@ -49,6 +49,7 @@ CONFIG_DEBUG_SYMBOLS=y
 CONFIG_DEBUG_TCBINFO=y
 CONFIG_DEV_FIFO_SIZE=0
 CONFIG_DEV_PIPE_SIZE=70
+CONFIG_DEV_URANDOM=y
 CONFIG_ETH0_PHY_DP83825I=y
 CONFIG_FAT_DMAMEMORY=y
 CONFIG_FAT_LCNAMES=y
@@ -155,8 +156,8 @@ CONFIG_NETDEV_LATEINIT=y
 CONFIG_NETDEV_PHY_IOCTL=y
 CONFIG_NETINIT_DHCPC=y
 CONFIG_NETINIT_DNS=y
-CONFIG_NETINIT_DNSIPADDR=0XC0A800FE
-CONFIG_NETINIT_DRIPADDR=0XC0A800FE
+CONFIG_NETINIT_DNSIPADDR=0xA290AFE
+CONFIG_NETINIT_DRIPADDR=0xA290AFE
 CONFIG_NETINIT_RETRY_MOUNTPATH=10
 CONFIG_NETINIT_THREAD=y
 CONFIG_NETINIT_THREAD_PRIORITY=49
@@ -167,15 +168,18 @@ CONFIG_NET_BROADCAST=y
 CONFIG_NET_CAN=y
 CONFIG_NET_CAN_EXTID=y
 CONFIG_NET_CAN_NOTIFIER=y
+CONFIG_NET_CAN_RAW_FILTER_MAX=1
 CONFIG_NET_CAN_RAW_TX_DEADLINE=y
 CONFIG_NET_CAN_SOCK_OPTS=y
 CONFIG_NET_ETH_PKTSIZE=1518
 CONFIG_NET_ICMP=y
 CONFIG_NET_ICMP_SOCKET=y
+CONFIG_NET_IGMP=y
 CONFIG_NET_SOLINGER=y
 CONFIG_NET_TCP=y
 CONFIG_NET_TCPBACKLOG=y
 CONFIG_NET_TCP_DELAYED_ACK=y
+CONFIG_NET_TCP_KEEPALIVE=y
 CONFIG_NET_TCP_WRITE_BUFFERS=y
 CONFIG_NET_TIMESTAMP=y
 CONFIG_NET_UDP=y
@@ -196,6 +200,7 @@ CONFIG_NSH_VARS=y
 CONFIG_PIPES=y
 CONFIG_PREALLOC_TIMERS=50
 CONFIG_PRIORITY_INHERITANCE=y
+CONFIG_PTHREAD_MUTEX_TYPES=y
 CONFIG_PTHREAD_STACK_MIN=512
 CONFIG_RAM_SIZE=1048576
 CONFIG_RAM_START=0x20200000
@@ -47,7 +47,6 @@ CONFIG_MODULES_SENSORS=y
 # CONFIG_SENSORS_VEHICLE_AIRSPEED is not set
 # CONFIG_SENSORS_VEHICLE_OPTICAL_FLOW is not set
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_HARDFAULT_LOG=y
 CONFIG_SYSTEMCMDS_MFT=y
 CONFIG_SYSTEMCMDS_MTD=y
@@ -79,7 +79,6 @@ CONFIG_MODULES_UXRCE_DDS_CLIENT=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
 CONFIG_SYSTEMCMDS_GPIO=y
@@ -80,7 +80,6 @@ CONFIG_MODULES_UXRCE_DDS_CLIENT=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
 CONFIG_SYSTEMCMDS_GPIO=y
@@ -77,7 +77,6 @@ CONFIG_MODULES_UXRCE_DDS_CLIENT=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
 CONFIG_SYSTEMCMDS_GPIO=y
@@ -83,7 +83,6 @@ CONFIG_MODULES_UXRCE_DDS_CLIENT=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
@@ -91,7 +91,6 @@ CONFIG_MODULES_UXRCE_DDS_CLIENT=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_GPIO=y
@@ -89,6 +89,7 @@ CONFIG_MODULES_SENSORS=y
 CONFIG_MODULES_TEMPERATURE_COMPENSATION=y
 CONFIG_MODULES_UXRCE_DDS_CLIENT=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
+CONFIG_MODULES_ZENOH=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DMESG=y
@@ -55,6 +55,7 @@ CONFIG_DEBUG_SYMBOLS=y
 CONFIG_DEBUG_TCBINFO=y
 CONFIG_DEV_FIFO_SIZE=0
 CONFIG_DEV_PIPE_SIZE=70
+CONFIG_DEV_URANDOM=y
 CONFIG_ETH0_PHY_MULTI=y
 CONFIG_FAT_DMAMEMORY=y
 CONFIG_FAT_LCNAMES=y
@@ -214,15 +215,18 @@ CONFIG_NET_BROADCAST=y
 CONFIG_NET_CAN=y
 CONFIG_NET_CAN_EXTID=y
 CONFIG_NET_CAN_NOTIFIER=y
+CONFIG_NET_CAN_RAW_FILTER_MAX=1
 CONFIG_NET_CAN_RAW_TX_DEADLINE=y
 CONFIG_NET_CAN_SOCK_OPTS=y
 CONFIG_NET_ETH_PKTSIZE=1518
 CONFIG_NET_ICMP=y
 CONFIG_NET_ICMP_SOCKET=y
+CONFIG_NET_IGMP=y
 CONFIG_NET_SOLINGER=y
 CONFIG_NET_TCP=y
 CONFIG_NET_TCPBACKLOG=y
 CONFIG_NET_TCP_DELAYED_ACK=y
+CONFIG_NET_TCP_KEEPALIVE=y
 CONFIG_NET_TCP_WRITE_BUFFERS=y
 CONFIG_NET_TIMESTAMP=y
 CONFIG_NET_UDP=y
@@ -243,6 +247,7 @@ CONFIG_NSH_VARS=y
 CONFIG_PIPES=y
 CONFIG_PREALLOC_TIMERS=50
 CONFIG_PRIORITY_INHERITANCE=y
+CONFIG_PTHREAD_MUTEX_TYPES=y
 CONFIG_PTHREAD_STACK_MIN=512
 CONFIG_RAMTRON_SETSPEED=y
 CONFIG_RAM_SIZE=1835008
@@ -72,7 +72,6 @@ CONFIG_MODULES_UXRCE_DDS_CLIENT=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
@@ -74,7 +74,6 @@ CONFIG_MODULES_UXRCE_DDS_CLIENT=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
 CONFIG_SYSTEMCMDS_GPIO=y
@@ -74,7 +74,6 @@ CONFIG_MODULES_UXRCE_DDS_CLIENT=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
 CONFIG_SYSTEMCMDS_GPIO=y
@@ -61,7 +61,6 @@ CONFIG_MODULES_SIMULATION_SIMULATOR_SIH=y
 CONFIG_MODULES_TEMPERATURE_COMPENSATION=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_BSONDUMP=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
@@ -66,7 +66,6 @@ CONFIG_MODULES_TEMPERATURE_COMPENSATION=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
 CONFIG_SYSTEMCMDS_GPIO=y
@@ -65,7 +65,6 @@ CONFIG_MODULES_TEMPERATURE_COMPENSATION=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
 CONFIG_SYSTEMCMDS_GPIO=y
@@ -65,7 +65,6 @@ CONFIG_MODULES_TEMPERATURE_COMPENSATION=y
 CONFIG_MODULES_VTOL_ATT_CONTROL=y
 CONFIG_SYSTEMCMDS_ACTUATOR_TEST=y
 CONFIG_SYSTEMCMDS_BL_UPDATE=y
-CONFIG_BL_UPDATE_BL_ROMFS=y
 CONFIG_SYSTEMCMDS_DMESG=y
 CONFIG_SYSTEMCMDS_DUMPFILE=y
 CONFIG_SYSTEMCMDS_GPIO=y
@@ -339,6 +339,11 @@ if(EXISTS ${BOARD_DEFCONFIG})
 		endif()
 	endif()

+	# ADDITIONAL INIT
+	if(ADDITIONAL_INIT)
+		set(config_additional_init ${ADDITIONAL_INIT} CACHE INTERNAL "additional init" FORCE)
+	endif()
+
 	if(UAVCAN_INTERFACES)
 		set(config_uavcan_num_ifaces ${UAVCAN_INTERFACES} CACHE INTERNAL "UAVCAN interfaces" FORCE)
 	endif()
@@ -0,0 +1,197 @@
+<?xml version="1.0" encoding="UTF-8" standalone="no"?>
+<!-- Generator: Adobe Illustrator 19.2.0, SVG Export Plug-In . SVG Version: 6.00 Build 0)  -->
+
+<svg
+   version="1.1"
+   id="draw"
+   x="0px"
+   y="0px"
+   viewBox="0 0 291.424 291.77"
+   enable-background="new 0 0 291.424 291.77"
+   xml:space="preserve"
+   sodipodi:docname="FreeFlyer.svg"
+   inkscape:version="1.2.2 (b0a8486541, 2022-12-01)"
+   xmlns:inkscape="http://www.inkscape.org/namespaces/inkscape"
+   xmlns:sodipodi="http://sodipodi.sourceforge.net/DTD/sodipodi-0.dtd"
+   xmlns="http://www.w3.org/2000/svg"
+   xmlns:svg="http://www.w3.org/2000/svg"
+   xmlns:rdf="http://www.w3.org/1999/02/22-rdf-syntax-ns#"
+   xmlns:cc="http://creativecommons.org/ns#"
+   xmlns:dc="http://purl.org/dc/elements/1.1/"><metadata
+   id="metadata13908"><rdf:RDF><cc:Work
+       rdf:about=""><dc:format>image/svg+xml</dc:format><dc:type
+         rdf:resource="http://purl.org/dc/dcmitype/StillImage" /><dc:title>QuadRotorX</dc:title></cc:Work></rdf:RDF></metadata><defs
+   id="defs13906"><rect
+     x="64.295094"
+     y="257.16159"
+     width="20.004284"
+     height="19.434001"
+     id="rect1674" /><rect
+     x="57.181928"
+     y="12.768183"
+     width="21.455602"
+     height="14.069247"
+     id="rect1668" /><rect
+     x="64.295097"
+     y="257.16159"
+     width="20.004284"
+     height="19.434002"
+     id="rect1674-3" /><rect
+     x="64.295097"
+     y="257.16159"
+     width="20.004284"
+     height="19.434002"
+     id="rect1674-6" /><rect
+     x="64.295097"
+     y="257.16159"
+     width="20.004284"
+     height="19.434002"
+     id="rect1674-8" /><rect
+     x="64.295097"
+     y="257.16159"
+     width="20.004284"
+     height="19.434002"
+     id="rect1674-9" /><rect
+     x="64.295097"
+     y="257.16159"
+     width="20.004284"
+     height="19.434002"
+     id="rect1674-9-0" /><rect
+     x="64.295097"
+     y="257.16159"
+     width="20.004284"
+     height="19.434002"
+     id="rect1674-9-0-3" /><rect
+     x="64.295097"
+     y="257.16159"
+     width="20.004284"
+     height="19.434002"
+     id="rect1674-9-0-5" /></defs><sodipodi:namedview
+   pagecolor="#ffffff"
+   bordercolor="#666666"
+   borderopacity="1"
+   objecttolerance="10"
+   gridtolerance="10"
+   guidetolerance="10"
+   inkscape:pageopacity="0"
+   inkscape:pageshadow="2"
+   inkscape:window-width="1920"
+   inkscape:window-height="1131"
+   id="namedview13904"
+   showgrid="true"
+   showguides="false"
+   inkscape:zoom="2"
+   inkscape:cx="37"
+   inkscape:cy="143.75"
+   inkscape:window-x="0"
+   inkscape:window-y="0"
+   inkscape:window-maximized="1"
+   inkscape:current-layer="draw"
+   inkscape:showpageshadow="2"
+   inkscape:pagecheckerboard="0"
+   inkscape:deskcolor="#d1d1d1"><inkscape:grid
+     type="xygrid"
+     id="grid14610" /></sodipodi:namedview><title
+   id="title13869">QuadRotorX</title>
+     <rect
+   style="fill:#4ec3e8;fill-opacity:0.8;stroke-width:0.703099"
+   id="rect866"
+   width="182.87863"
+   height="182.87863"
+   x="54.336742"
+   y="54.008221" /><path
+   style="fill:#159e1f;fill-opacity:0.8;stroke-width:1.32638"
+   d="m 41.75804,283.31181 64.75142,-0.1091 -34.35904,-46.53234"
+   id="path978" /><path
+   style="fill:#159e1f;fill-opacity:0.8;stroke-width:1.32638"
+   d="m 8.0625538,189.05596 0.1091,64.75142 46.5323452,-34.35904"
+   id="path978-3" /><path
+   style="fill:#159e1f;fill-opacity:0.8;stroke-width:1.32638"
+   d="m 7.6111718,42.233006 0.1091,64.751414 46.5323442,-34.359034"
+   id="path978-3-5" /><path
+   style="fill:#159e1f;fill-opacity:0.8;stroke-width:1.32638"
+   d="M 283.3143,102.92315 283.2052,38.171731 236.67284,72.530766"
+   id="path978-3-0" /><path
+   style="fill:#159e1f;fill-opacity:0.8;stroke-width:1.32638"
+   d="m 283.76568,249.7461 -0.1091,-64.75142 -46.53235,34.35904"
+   id="path978-3-5-9" /><path
+   style="fill:#159e1f;fill-opacity:0.8;stroke-width:1.32638"
+   d="m 186.0159,282.76127 64.75142,-0.1091 -34.35904,-46.53235"
+   id="path978-5" /><path
+   style="fill:#159e1f;fill-opacity:0.8;stroke-width:1.32638"
+   d="m 249.48837,7.3723165 -64.75142,0.1091 34.35904,46.5323455"
+   id="path978-6" /><path
+   style="fill:#159e1f;fill-opacity:0.8;stroke-width:1.32638"
+   d="M 105.23051,7.9228645 40.479095,8.0319644 74.838131,54.56431"
+   id="path978-5-2" /><path
+   fill="#ffffff"
+   stroke="#000000"
+   stroke-miterlimit="10"
+   d="m 177.46535,152.08429 -25.44869,25.44869 c -2.72029,2.72029 -7.13013,2.72029 -9.84972,0 l -25.44868,-25.44869 c -2.7203,-2.72029 -2.7203,-7.13013 0,-9.84972 l 25.44868,-25.44868 c 2.72029,-2.72029 7.13013,-2.72029 9.84972,0 l 25.44869,25.44868 c 2.72029,2.72029 2.72029,7.13013 0,9.84972 z"
+   id="path13875-2"
+   style="stroke-width:0.703099" /><polygon
+   fill="#ff442b"
+   stroke="#000000"
+   stroke-miterlimit="10"
+   points="145.645,117.211 163.823,168.211 127.468,168.211 "
+   id="polygon13877-7"
+   transform="matrix(0.70309945,0,0,0.70309945,44.68853,44.358917)" /><text
+   xml:space="preserve"
+   id="text1666"
+   style="fill:#ffffff;fill-opacity:0.80000001;white-space:pre;shape-inside:url(#rect1668)" /><text
+   xml:space="preserve"
+   id="text1672"
+   style="font-size:16px;white-space:pre;shape-inside:url(#rect1674);fill:#ffffff;fill-opacity:0.8"
+   transform="matrix(1.8712033,0,0,1.8712033,-56.149908,-232.98716)"><tspan
+     x="64.294922"
+     y="271.72011"
+     id="tspan2022">1</tspan></text><text
+   xml:space="preserve"
+   id="text1672-6"
+   style="font-size:16px;white-space:pre;shape-inside:url(#rect1674-3);display:inline;fill:#ffffff;fill-opacity:0.8"
+   transform="matrix(1.8712033,0,0,1.8712033,-54.90599,-471.96664)"><tspan
+     x="64.294922"
+     y="271.72011"
+     id="tspan2024">2</tspan></text><text
+   xml:space="preserve"
+   id="text1672-1"
+   style="font-size:16px;white-space:pre;shape-inside:url(#rect1674-6);display:inline;fill:#ffffff;fill-opacity:0.8"
+   transform="matrix(1.8712033,0,0,1.8712033,88.181331,-233.48182)"><tspan
+     x="64.294922"
+     y="271.72011"
+     id="tspan2026">3</tspan></text><text
+   xml:space="preserve"
+   id="text1672-7"
+   style="font-size:16px;white-space:pre;shape-inside:url(#rect1674-8);display:inline;fill:#ffffff;fill-opacity:0.8"
+   transform="matrix(1.8712033,0,0,1.8712033,89.923516,-472.9994)"><tspan
+     x="64.294922"
+     y="271.72011"
+     id="tspan2028">4</tspan></text><text
+   xml:space="preserve"
+   id="text1672-2"
+   style="font-size:16px;white-space:pre;shape-inside:url(#rect1674-9);display:inline;fill:#ffffff;fill-opacity:0.8"
+   transform="matrix(1.8712033,0,0,1.8712033,-107.88311,-425.85878)"><tspan
+     x="64.294922"
+     y="271.72011"
+     id="tspan2030">5</tspan></text><text
+   xml:space="preserve"
+   id="text1672-2-2"
+   style="font-size:16px;white-space:pre;shape-inside:url(#rect1674-9-0);display:inline;fill:#ffffff;fill-opacity:0.8"
+   transform="matrix(1.8712033,0,0,1.8712033,140.31603,-426.60417)"><tspan
+     x="64.294922"
+     y="271.72011"
+     id="tspan2032">6</tspan></text><text
+   xml:space="preserve"
+   id="text1672-2-2-7"
+   style="font-size:16px;white-space:pre;shape-inside:url(#rect1674-9-0-3);display:inline;fill:#ffffff;fill-opacity:0.8"
+   transform="matrix(1.8712033,0,0,1.8712033,-106.57328,-277.85487)"><tspan
+     x="64.294922"
+     y="271.72011"
+     id="tspan2034">7</tspan></text><text
+   xml:space="preserve"
+   id="text1672-2-2-9"
+   style="font-size:16px;white-space:pre;shape-inside:url(#rect1674-9-0-5);display:inline;fill:#ffffff;fill-opacity:0.8"
+   transform="matrix(1.8712033,0,0,1.8712033,140.59859,-279.63807)"><tspan
+     x="64.294922"
+     y="271.72011"
+     id="tspan2036">8</tspan></text></svg>
@@ -90,6 +90,8 @@ This is documented below.
 The best way to customize the system startup is to introduce a [new frame configuration](../dev_airframes/adding_a_new_frame.md).
 The frame configuration file can be included in the firmware or on an SD Card.

+#### Dynamic customization
+
 If you only need to "tweak" the existing configuration, such as starting one more application or setting the value of a few parameters, you can specify these by creating two files in the `/etc/` directory of the SD Card:

 - [/etc/config.txt](#customizing-the-configuration-config-txt): modify parameter values
@@ -106,7 +108,7 @@ If editing on Windows use a suitable editor.
 These files are referenced in PX4 code as `/fs/microsd/etc/config.txt` and `/fs/microsd/etc/extras.txt`, where the root folder of the microsd card is identified by the path `/fs/microsd`.
 :::

-#### Customizing the Configuration (config.txt)
+##### Customizing the Configuration (config.txt)

 The `config.txt` file can be used to modify parameters.
 It is loaded after the main system has been configured and _before_ it is booted.
@@ -118,7 +120,7 @@ param set-default PWM_MAIN_DIS3 1000
 param set-default PWM_MAIN_MIN3 1120
 ```

-#### Starting Additional Applications (extras.txt)
+##### Starting Additional Applications (extras.txt)

 The `extras.txt` can be used to start additional applications after the main system boot.
 Typically these would be payload controllers or similar optional custom components.
@@ -145,3 +147,28 @@ The following example shows how to start custom applications:

  mandatory_app start     # Will abort boot if mandatory_app is unknown or fails
  ```
+
+#### Additional customization
+
+In rare cases where the desired setup cannot be achieved through frame configuration or dynamic customization,
+you can add a script that will be contained in the binary.
+
+**Note**: In almost all cases, you should use a frame configuration. This method should only be used for
+edge-cases such as customizing `cannode` based boards.
+
+- Add a new init script in `boards/<vendor>/<board>/init` that will run during board startup. For example:
+  ```sh
+  # File: boards/<vendor>/<board>/init/rc.additional
+  param set-default <param> <value>
+  ```
+
+- Add a new board variant in `boards/<vendor>/<board>/<variant>.px4board` that includes the additional script. For example:
+  ```sh
+  # File: boards/<vendor>/<board>/var.px4board
+  CONFIG_BOARD_ADDITIONAL_INIT="rc.additional"
+  ```
+
+- Compile the firmware with your new variant by appending the variant name to the compile target. For example:
+  ```sh
+  make <target>_var
+  ```
@@ -35,14 +35,15 @@ The parameters you are most likely to change are listed below.

 | Parameter                                                                | Description                                                                                                                                                                                                                                                                                                                                                                      |
 | ------------------------------------------------------------------------ | -------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------- |
-| [SDLOG_MODE](../advanced_config/parameter_reference.md#SDLOG_MODE)       | Logging Mode. Defines when logging starts and stops.<br />- `-1`: Logging disabled.<br />- `0`: Log when armed until disarm (default).<br />- `1`: Log from boot until disarm.<br />- `2`: Log from boot until shutdown.<br />- `3`: Log based on the [AUX1 RC channel](../advanced_config/parameter_reference.md#RC_MAP_AUX1).<br />- `4`: Log from first armed until shutdown. |
+| [SDLOG_MODE](../advanced_config/parameter_reference.md#SDLOG_MODE)       | Logging Mode. Defines when logging starts and stops.<br />- `0`: Log when armed until disarm (default).<br />- `1`: Log from boot until disarm.<br />- `2`: Log from boot until shutdown.<br />- `3`: Log based on the [AUX1 RC channel](../advanced_config/parameter_reference.md#RC_MAP_AUX1).<br />- `4`: Log from first armed until shutdown. |
+| [SDLOG_BACKEND](../advanced_config/parameter_reference.md#SDLOG_BACKEND) | Logging Backend (bitmask). Setting a bit enables the corresponding backend. If no backend is selected, the logger is disabled.<br />- bit `0`: SD card logging.</br >- bit `1`: Mavlink logging.
 | [SDLOG_PROFILE](../advanced_config/parameter_reference.md#SDLOG_PROFILE) | Logging profile. Use this to enable less common logging/analysis (e.g. for EKF2 replay, high rate logging for PID & filter tuning, thermal temperature calibration).                                                                                                                                                                                                             |
 | [SDLOG_MISSION](../advanced_config/parameter_reference.md#SDLOG_MISSION) | Create very small additional "Mission Log".<br>This log can _not_ be used with [Flight Review](../log/flight_log_analysis.md#flight-review-online-tool), but is useful when you need a small log for geotagging or regulatory compliance.                                                                                                                                        |

 Useful settings for specific cases:

 - Raw sensor data for comparison: [SDLOG_MODE=1](../advanced_config/parameter_reference.md#SDLOG_MODE) and [SDLOG_PROFILE=64](../advanced_config/parameter_reference.md#SDLOG_PROFILE).
- Disabling logging altogether: [SDLOG_MODE=`-1`](../advanced_config/parameter_reference.md#SDLOG_MODE)
+- Disabling logging altogether: [SDLOG_BACKEND=`0`](../advanced_config/parameter_reference.md#SDLOG_BACKEND)

 ### Logger module

@@ -316,6 +316,43 @@ For SIH as SITL (no FC):

 For specific examples see the `_sihsim_` airframes in [ROMFS/px4fmu_common/init.d-posix/airframes](https://github.com/PX4/PX4-Autopilot/blob/main/ROMFS/px4fmu_common/init.d-posix/airframes/) (SIH as SITL) and [ROMFS/px4fmu_common/init.d/airframes](https://github.com/PX4/PX4-Autopilot/tree/main/ROMFS/px4fmu_common/init.d/airframes) (SIH on FC).

+## Controlling Actuators in SIH
+
+:::warning
+If you want to control throttling actuators in SIH, make sure to remove propellers for safety.
+:::
+
+In some scenarios, it may be useful to control an actuator while running SIH. For example, you might want to verify that winches or grippers are functioning correctly by checking the servo responses.
+
+To enable actuator control in SIH:
+
+1. Configure PWM parameters in the airframe file:
+
+Ensure your airframe file includes the necessary parameters to map PWM outputs to the correct channels.
+
+For example, if a servo is connected to MAIN 3 and you want to map it to AUX1 on your RC, use the following command:
+
+`param set-default PWM_MAIN_FUNC3 407`
+
+You can find a full list of available values for `PWM_MAIN_FUNCn` [here](../advanced_config/parameter_reference.md#PWM_MAIN_FUNC1). In this case, `407` maps the MAIN 3 output to AUX1 on the RC.
+
+Alternatively, you can use the [`PWM_AUX_FUNCn`](../advanced_config/parameter_reference.md#PWM_AUX_FUNC1) parameters.
+
+You may also configure the output as desired:
+- Disarmed PWM: ([`PWM_MAIN_DISn`](../advanced_config/parameter_reference.md#PWM_MAIN_DIS1) / [`PWM_AUX_DIS1`](../advanced_config/parameter_reference.md#PWM_AUX_DIS1))
+- Minimum PWM ([`PWM_MAIN_MINn`](../advanced_config/parameter_reference.md#PWM_MAIN_MIN1) / [`PWM_AUX_MINn`](../advanced_config/parameter_reference.md#PWM_AUX_MIN1))
+- Maximum PWM ([`PWM_MAIN_MAXn`](../advanced_config/parameter_reference.md#PWM_MAIN_MAX1) / [`PWM_AUX_MAXn`](../advanced_config/parameter_reference.md#PWM_AUX_MAX1))
+
+2. Manually start the PWM output driver
+
+For safety, the PWM driver is not started automatically in SIH. To enable it, run the following command in the MAVLink shell:
+
+`pwm_out start`
+
+And to disable it again:
+
+`pwm_out stop`
+
 ## Dynamic Models

 The dynamic models for the various vehicles are:
@@ -3,12 +3,6 @@
 [Rotoye Batmon](https://rotoye.com/batmon/) is a kit for adding smart battery functionality to off-the-shelf Lithium-Ion and LiPo batteries.
 It can be purchased as a standalone unit or as part of a factory-assembled smart-battery.

-::: info
-At time of writing you can only use Batmon by [building a custom branch of PX4](#build-px4-firmware).
-Support in the codeline is pending [PR approval](https://github.com/PX4/PX4-Autopilot/pull/16723).
-:::
-
-
 ![Rotoye Batmon Board](../../assets/hardware/smart_batteries/rotoye_batmon/smart-battery-rotoye.jpg)

 ![Pre-assembled Rotoye smart battery](../../assets/hardware/smart_batteries/rotoye_batmon/smart-battery-rotoye-pack.jpg)
@@ -424,9 +424,11 @@ add_dependencies(uorb_msgs prebuild_targets uorb_headers)
 if(CONFIG_LIB_CDRSTREAM)
 	set(uorb_cdr_idl)
 	set(uorb_cdr_msg)
+	set(uorb_cdr_hash)
 	set(uorb_cdr_idl_uorb)
 	set(idl_include_path ${PX4_BINARY_DIR}/uORB/idl)
 	set(idl_out_path ${idl_include_path}/px4/msg)
+	set(idl_rihs01_out_path ${idl_include_path}/px4)
 	set(idl_uorb_path ${PX4_BINARY_DIR}/msg/px4/msg)

 	# Make sure that CycloneDDS has been checkout out
@@ -457,6 +459,7 @@ if(CONFIG_LIB_CDRSTREAM)
 		configure_file(${msg_file} ${idl_out_path}/${msg}.msg COPYONLY)
 		list(APPEND uorb_cdr_idl ${idl_out_path}/${msg}.idl)
 		list(APPEND uorb_cdr_msg ${idl_out_path}/${msg}.msg)
+		list(APPEND uorb_cdr_hash ${idl_out_path}/${msg}.json)
 		list(APPEND uorb_cdr_idl_uorb ${idl_uorb_path}/${msg}.h)
 	endforeach()

@@ -476,6 +479,25 @@ if(CONFIG_LIB_CDRSTREAM)
 		VERBATIM
 		)

+	file(CREATE_LINK ${idl_rihs01_out_path} ${idl_include_path}/px4_msgs SYMBOLIC)
+
+	# Generate IDL from .msg using rosidl_adapter
+	# Note this is a submodule inside PX4 hence no ROS2 installation required
+	add_custom_command(
+		OUTPUT ${uorb_cdr_hash}
+		COMMAND ${CMAKE_COMMAND}
+		        -E env "PYTHONPATH=${PX4_SOURCE_DIR}/src/lib/cdrstream/rosidl/rosidl_adapter:${PX4_SOURCE_DIR}/src/lib/cdrstream/rosidl/rosidl_cli:${PX4_SOURCE_DIR}/src/lib/cdrstream/rosidl/rosidl_parser:${PX4_SOURCE_DIR}/src/lib/cdrstream/rosidl/rosidl_generator_type_description"
+			${PYTHON_EXECUTABLE} ${PX4_SOURCE_DIR}/src/lib/cdrstream/idl2rihs01.py
+			--output-dir ${idl_rihs01_out_path}
+			${uorb_cdr_idl}
+		DEPENDS
+			${uorb_cdr_idl}
+			git_cyclonedds
+		COMMENT "Generating RIHS01 hashes from IDL"
+		WORKING_DIRECTORY ${CMAKE_CURRENT_SOURCE_DIR}
+		VERBATIM
+		)
+
 	# Generate C definitions from IDL
 	set(CYCLONEDDS_DIR ${PX4_SOURCE_DIR}/src/lib/cdrstream/cyclonedds)
 	include("${CYCLONEDDS_DIR}/cmake/Modules/Generate.cmake")
@@ -505,6 +527,7 @@ if(CONFIG_LIB_CDRSTREAM)
 		DEPENDS
 			uorb_cdrstream
 			${msg_files}
+			${uorb_cdr_hash}
 			${PX4_SOURCE_DIR}/Tools/msg/templates/cdrstream/uorb_idl_header.h.em
 			${PX4_SOURCE_DIR}/Tools/msg/px_generate_uorb_topic_files.py
 			${PX4_SOURCE_DIR}/Tools/msg/px_generate_uorb_topic_helper.py
@@ -534,8 +557,10 @@ if(CONFIG_MODULES_ZENOH)
 			-f ${msg_files}
 			-o ${PX4_BINARY_DIR}/src/modules/zenoh/
 			-e ${PX4_SOURCE_DIR}/Tools/zenoh/templates/zenoh
+			--rihs ${idl_rihs01_out_path}
 		DEPENDS
 			${msg_files}
+			${uorb_cdr_hash}
 			${PX4_SOURCE_DIR}/Tools/zenoh/templates/zenoh/uorb_pubsub_factory.hpp.em
 			${PX4_SOURCE_DIR}/Tools/zenoh/px_generate_zenoh_topic_files.py
 		COMMENT "Generating Zenoh Topic Code"
@@ -0,0 +1,14 @@
+# Arming check request.
+#
+# Broadcast message to request arming checks be reported by all registered components, such as external ROS 2 navigation modes.
+# All registered components should respond with an ArmingCheckReply message that indicates their current mode requirements, and any arming failure information.
+# The request is sent regularly, even while armed, so that the FMU always knows the current arming state for external modes, and can forward it to ground stations.
+#
+# The reply will include the published request_id, allowing correlation of all arming check information for a particular request.
+# The reply will also include the registration_id for each external component, provided to it during the registration process (RegisterExtComponentReply).
+
+uint32 MESSAGE_VERSION = 0
+
+uint64 timestamp  # [us] Time since system start.
+
+uint8 request_id  # Id of this request. Allows correlation with associated ArmingCheckReply messages.
@@ -8,6 +8,7 @@

 #include "translation_airspeed_validated_v1.h"
 #include "translation_arming_check_reply_v1.h"
+#include "translation_arming_check_request_v1.h"
 #include "translation_battery_status_v1.h"
 #include "translation_event_v1.h"
 #include "translation_home_position_v1.h"
@@ -0,0 +1,36 @@
+/****************************************************************************
+ * Copyright (c) 2025 PX4 Development Team.
+ * SPDX-License-Identifier: BSD-3-Clause
+ ****************************************************************************/
+#pragma once
+
+// Translate ArmingCheckRequest v0 <--> v1
+#include <px4_msgs_old/msg/arming_check_request_v0.hpp>
+#include <px4_msgs/msg/arming_check_request.hpp>
+
+class ArmingCheckRequestV1Translation {
+public:
+    using MessageOlder = px4_msgs_old::msg::ArmingCheckRequestV0;
+    static_assert(MessageOlder::MESSAGE_VERSION == 0);
+
+    using MessageNewer = px4_msgs::msg::ArmingCheckRequest;
+    static_assert(MessageNewer::MESSAGE_VERSION == 1);
+
+    static constexpr const char* kTopic = "/fmu/out/arming_check_request";
+
+    static void fromOlder(const MessageOlder &msg_older, MessageNewer &msg_newer) {
+	    msg_newer.timestamp = msg_older.timestamp;
+
+	    msg_newer.request_id = msg_older.request_id;
+
+	    msg_newer.valid_registrations_mask = 0xffffffff;
+    }
+
+    static void toOlder(const MessageNewer &msg_newer, MessageOlder &msg_older) {
+	    msg_older.timestamp = msg_newer.timestamp;
+
+	    msg_older.request_id = msg_newer.request_id;
+    }
+};
+
+REGISTER_TOPIC_TRANSLATION_DIRECT(ArmingCheckRequestV1Translation);
@@ -7,8 +7,10 @@
 # The reply will include the published request_id, allowing correlation of all arming check information for a particular request.
 # The reply will also include the registration_id for each external component, provided to it during the registration process (RegisterExtComponentReply).

-uint32 MESSAGE_VERSION = 0
+uint32 MESSAGE_VERSION = 1

 uint64 timestamp  # [us] Time since system start.

 uint8 request_id  # Id of this request. Allows correlation with associated ArmingCheckReply messages.
+
+uint32 valid_registrations_mask # Bitmask of valid registration ID's (the bit is also cleared if flagged as unresponsive)
@@ -1,7 +1,7 @@
 #! /bin/sh

 #
-# Bootloader upgrade (ROMFS)
+# Bootloader upgrade
 #
 if param compare -s SYS_BL_UPDATE 1
 then
@@ -16,7 +16,7 @@ parameters:
                    sure to set this high enough so that the motors are always spinning while
                    armed.
            type: float
-            unit: '%'
+            unit: norm
            min: 0
            max: 1
            decimal: 2
@@ -759,6 +759,10 @@ GPS::run()
 			ubx_mode = GPSDriverUBX::UBXMode::RoverWithStaticBaseUart2;
 			break;

+		case 6:
+			ubx_mode = GPSDriverUBX::UBXMode::GroundControlStation;
+			break;
+
 		default:
 			break;

@@ -94,6 +94,7 @@ PARAM_DEFINE_INT32(GPS_SAT_INFO, 0);
 * F9P units are connected to each other.
 * Modes 3 and 4 only require UART1 on each F9P connected to the Autopilot or Can Node. UART RX DMA is required.
 * RTK is still possible with this setup.
+ * Mode 6 is intended for use with a ground control station (not necessarily an RTK correction base).
 *
 * @min 0
 * @max 1
@@ -103,6 +104,7 @@ PARAM_DEFINE_INT32(GPS_SAT_INFO, 0);
 * @value 3 Heading (Rover With Moving Base UART1 Connected to Autopilot Or Can Node At 921600)
 * @value 4 Moving Base (Moving Base UART1 Connected to Autopilot Or Can Node At 921600)
 * @value 5 Rover with Static Base on UART2 (similar to Default, except coming in on UART2)
+ * @value 6 Ground Control Station (UART2 outputs NMEA)
 *
 * @reboot_required true
 * @group GPS
@@ -19,6 +19,16 @@ actuator_output:
 parameters:
  - group: Actuator Outputs
    definitions:
+      PCA9685_EN_BUS:
+        description:
+          short: Enable the PCA9685 output driver
+          long: |
+            Enable the PCA9685 output driver.
+            The integer refers to the I2C bus number where PCA9685 is connected.
+        type: int32
+        min: 0
+        max: 10
+        default: 0
      PCA9685_SCHD_HZ:
        description:
          short: PWM update rate
@@ -96,7 +96,7 @@ UavcanEscController::update_outputs(uint16_t outputs[MAX_ACTUATORS], unsigned to

 	_prev_cmd_pub = timestamp;

-	uavcan::equipment::esc::RawCommand msg;
+	uavcan::equipment::esc::RawCommand msg = {};

 	// directly output values from mixer
 	for (unsigned i = 0; i < total_outputs; i++) {
@@ -118,7 +118,7 @@ private:
 	static constexpr int BATTERY_INDEX_2 = 2;
 	static constexpr int BATTERY_INDEX_3 = 3;
 	static constexpr int BATTERY_INDEX_4 = 4;
-	static constexpr int SAMPLE_INTERVAL_US = 20_ms; // assume higher frequency UAVCAN feedback than 50Hz
+	static constexpr int SAMPLE_INTERVAL_US = 500_ms; // Typical message rate for a CAN battery monitor should be 2-5Hz.

 	static_assert(battery_status_s::MAX_INSTANCES <= BATTERY_INDEX_4, "Battery array too big");

@@ -644,7 +644,7 @@ uavcan::int16_t CanIface::configureFilters(const uavcan::CanFilterConfig *filter

 bool CanIface::waitCCCRBitStateChange(uint32_t mask, bool target_state)
 {
-#if UAVCAN_STM32_NUTTX
+#if UAVCAN_STM32H7_NUTTX
 	const unsigned Timeout = 1000;
 #else
 	const unsigned Timeout = 2000000;
@@ -657,7 +657,7 @@ bool CanIface::waitCCCRBitStateChange(uint32_t mask, bool target_state)
 			return true;
 		}

-#if UAVCAN_STM32_NUTTX
+#if UAVCAN_STM32H7_NUTTX
 		::usleep(1000);
 #endif
 	}
@@ -505,12 +505,16 @@ void UavcanNode::Run()

 			if (can_init_res < 0) {
 				PX4_ERR("CAN driver init failed %i", can_init_res);
+				ScheduleClear();
+				return;
 			}

 			int rv = _node.start();

 			if (rv < 0) {
 				PX4_ERR("Failed to start the node");
+				ScheduleClear();
+				return;
 			}

 			// If the node_id was not supplied by the bootloader do Dynamic Node ID allocation
@@ -528,6 +532,8 @@ void UavcanNode::Run()

 				if (client_start_res < 0) {
 					PX4_ERR("Failed to start the dynamic node ID client");
+					ScheduleClear();
+					return;
 				}
 			}
 		}
@@ -0,0 +1,90 @@
+#!/usr/bin/env python3
+
+############################################################################
+#
+#   Copyright (C) 2023 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.
+#
+############################################################################
+
+import argparse
+import pathlib
+import sys
+import os
+import tempfile
+import json
+
+try:
+    from rosidl_generator_type_description import generate_type_hash
+except ImportError:
+    # modifying sys.path and importing the Python package with the same
+    # name as this script does not work on Windows
+    rosidl_generator_type_description_root = os.path.dirname(os.path.dirname(__file__))
+    rosidl_generator_type_description_module = os.path.join(
+        rosidl_generator_type_description_root, 'rosidl_generator_type_description', '__init__.py')
+    if not os.path.exists(rosidl_generator_type_description_module):
+        raise
+    from importlib.machinery import SourceFileLoader
+
+    loader = SourceFileLoader('rosidl_generator_type_description', rosidl_generator_type_description_module)
+    rosidl_generator_type_description = loader.load_module()
+    generate_type_hash = rosidl_generator_type_description.generate_type_hash
+
+if __name__ == '__main__':
+    parser = argparse.ArgumentParser(
+        description=f'Convert px4 .idl files to rihs01')
+    parser.add_argument(
+        'interface_files', nargs='+',
+        help='The interface files to convert')
+    parser.add_argument(
+        '--output-dir', '-o',
+         help='The directory to save converted files (default: current directory)')
+    args = parser.parse_args(sys.argv[1:])
+
+    # So for some odd reason rosidl doesn't do proper cli arguments but believes
+    # that some magically crafted json is better
+
+    idl_files = []
+
+    type_hash_arguments = {}
+    type_hash_arguments['package_name'] = "px4_msgs"
+    type_hash_arguments['output_dir'] = args.output_dir
+    type_hash_arguments["idl_tuples"] = idl_files
+
+    for interface_file in args.interface_files:
+        # So file path need to be magically encoded with a : to let the parser do its thing
+
+        interface_file = str(pathlib.Path(interface_file)).replace("px4/msg", "px4:msg")
+        idl_files.append(interface_file)
+
+    json_file = tempfile.NamedTemporaryFile(mode="w+")
+    json.dump(type_hash_arguments, json_file)
+    json_file.flush()
+
+    generate_type_hash(json_file.name)
@@ -52,6 +52,6 @@ if __name__ == '__main__':
        package_dir = interface_file.parent.absolute()

        convert_msg_to_idl(
-            package_dir, 'px4',
+            package_dir, 'px4_msgs',
            interface_file.absolute().relative_to(package_dir),
            interface_file.parent)
@@ -150,5 +150,18 @@ param_modify_on_import_ret param_modify_on_import(bson_node_t node)
 		}
 	}

+	// 2025-08-22: translate SDLOG_MODE (disabled) to SDLOG_BACKEND (no logging backend)
+	{
+		if (strcmp("SDLOG_MODE", node->name) == 0) {
+			if (node->i32 == -1) {
+				node->i32 = 0;
+
+				int32_t sdlog_backend_val = 0;
+				param_set(param_find("SDLOG_BACKEND"), &sdlog_backend_val);
+				PX4_INFO("migrating %s -> %s", "SDLOG_MODE", "SDLOG_BACKEND");
+			}
+		}
+	}
+
 	return param_modify_on_import_ret::PARAM_NOT_MODIFIED;
 }
@@ -286,9 +286,6 @@ PARAM_DEFINE_INT32(SYS_FAC_CAL_MODE, 0);
 * @reboot_required true
 *
 * @group System
- * @value 0 No bootloader update is performed
- * @value 1 Bootloader update will be performed (using binary in ROMFS)
- * @value 2 Bootloader update will be performed (using binary in /fs/microsd/bl/bl.bin)
 */
 PARAM_DEFINE_INT32(SYS_BL_UPDATE, 0);

@@ -1895,8 +1895,7 @@ void Commander::run()
 		_actuator_armed.armed = isArmed();
 		_actuator_armed.prearmed = getPrearmState();
 		_actuator_armed.ready_to_arm = _vehicle_status.pre_flight_checks_pass || isArmed();
-		_actuator_armed.lockdown = ((_vehicle_status.hil_state == vehicle_status_s::HIL_STATE_ON)
-					    || _multicopter_throw_launch.isThrowLaunchInProgress());
+		_actuator_armed.lockdown = _multicopter_throw_launch.isThrowLaunchInProgress();
 		// _actuator_armed.kill // action_request_s::ACTION_KILL
 		_actuator_armed.termination = (_vehicle_status.nav_state == _vehicle_status.NAVIGATION_STATE_TERMINATION);
 		// _actuator_armed.in_esc_calibration_mode // VEHICLE_CMD_PREFLIGHT_CALIBRATION
@@ -229,8 +229,10 @@ void ExternalChecks::update()
 	int max_num_updates = arming_check_reply_s::ORB_QUEUE_LENGTH;

 	while (_arming_check_reply_sub.update(&reply) && --max_num_updates >= 0) {
-		if (reply.registration_id < MAX_NUM_REGISTRATIONS && registrationValid(reply.registration_id)
-		    && _current_request_id == reply.request_id) {
+		const bool valid = reply.registration_id < MAX_NUM_REGISTRATIONS && registrationValid(reply.registration_id);
+		const bool timed_out = now > reply.timestamp + 300_ms;
+
+		if (!timed_out && valid && _current_request_id == reply.request_id) {
 			_reply_received_mask |= 1u << reply.registration_id;
 			_registrations[reply.registration_id].num_no_response = 0;
 			_registrations[reply.registration_id].waiting_for_first_response = false;
@@ -291,6 +293,15 @@ void ExternalChecks::update()
 		arming_check_request_s request{};
 		request.request_id = ++_current_request_id;
 		request.timestamp = hrt_absolute_time();
+		request.valid_registrations_mask = _active_registrations_mask;
+
+		// Clear unresponsive ones
+		for (int i = 0; i < MAX_NUM_REGISTRATIONS; ++i) {
+			if (_registrations[i].unresponsive) {
+				request.valid_registrations_mask &= ~(1u << i);
+			}
+		}
+
 		_arming_check_request_pub.publish(request);
 	}
 }
@@ -473,6 +473,29 @@ uint8_t ModeManagement::getReplacedModeIfAny(uint8_t nav_state)
 	return nav_state;
 }

+uint8_t ModeManagement::onDisarm(uint8_t stored_nav_state)
+{
+	// Switch to the owned mode if an executor is active
+	uint8_t returned_nav_state = stored_nav_state;
+
+	if (_mode_executors.valid(_mode_executor_in_charge)) {
+		returned_nav_state = _mode_executors.executor(_mode_executor_in_charge).owned_nav_state;
+	}
+
+	// Switch to Hold if the mode is unresponsive
+	if (_modes.valid(returned_nav_state)) {
+		if (_external_checks.isUnresponsive(_modes.mode(returned_nav_state).arming_check_registration_id)) {
+			returned_nav_state = vehicle_status_s::NAVIGATION_STATE_AUTO_LOITER;
+		}
+	}
+
+	// Update _mode_executor_in_charge if needed (in case stored_nav_state belongs to an executor
+	// that is currently not active)
+	onUserIntendedNavStateChange(ModeChangeSource::User, returned_nav_state);
+
+	return returned_nav_state;
+}
+
 void ModeManagement::removeModeExecutor(int mode_executor_id)
 {
 	if (mode_executor_id == -1) {
@@ -153,6 +153,8 @@ public:
 	void onUserIntendedNavStateChange(ModeChangeSource source, uint8_t user_intended_nav_state) override;
 	uint8_t getReplacedModeIfAny(uint8_t nav_state) override;

+	uint8_t onDisarm(uint8_t stored_nav_state) override;
+
 	uint8_t getNavStateReplacementIfValid(uint8_t nav_state, bool report_error = true);

 	bool updateControlMode(uint8_t nav_state, vehicle_control_mode_s &control_mode) const;
@@ -209,6 +211,7 @@ public:

 	void onUserIntendedNavStateChange(ModeChangeSource source, uint8_t user_intended_nav_state) override {}
 	uint8_t getReplacedModeIfAny(uint8_t nav_state) override { return nav_state; }
+	uint8_t onDisarm(uint8_t stored_nav_state) override { return stored_nav_state; }

 	uint8_t getNavStateReplacementIfValid(uint8_t nav_state, bool report_error = true) { return nav_state; }

@@ -92,5 +92,10 @@ bool UserModeIntention::change(uint8_t user_intended_nav_state, ModeChangeSource

 void UserModeIntention::onDisarm()
 {
-	_user_intented_nav_state = _nav_state_after_disarming;
+	if (_handler) {
+		_user_intented_nav_state = _handler->onDisarm(_nav_state_after_disarming);
+
+	} else {
+		_user_intented_nav_state = _nav_state_after_disarming;
+	}
 }
@@ -53,6 +53,8 @@ public:
 	 * @return nav_state or the mode that nav_state replaces
 	 */
 	virtual uint8_t getReplacedModeIfAny(uint8_t nav_state) = 0;
+
+	virtual uint8_t onDisarm(uint8_t stored_nav_state) = 0;
 };


@@ -76,18 +76,11 @@ void Ekf::controlGnssHeightFusion(const gnssSample &gps_sample)
 						measurement_var + bias_est.getBiasVar(),
 						math::max(_params.ekf2_gps_p_gate, 1.f));

-		// update the bias estimator before updating the main filter but after
-		// using its current state to compute the vertical position innovation
-		if (measurement_valid) {
-			bias_est.setMaxStateNoise(sqrtf(measurement_var));
-			bias_est.setProcessNoiseSpectralDensity(_params.gps_hgt_bias_nsd);
-			bias_est.fuseBias(measurement - _gpos.altitude(), measurement_var + P(State::pos.idx + 2, State::pos.idx + 2));
-		}
-
 		// determine if we should use height aiding
 		const bool common_conditions_passing = measurement_valid
 						       && _local_origin_lat_lon.isInitialized()
-						       && _gnss_checks.passed();
+						       && _gnss_checks.passed()
+						       && !_control_status.flags.gnss_fault;

 		const bool continuing_conditions_passing = (_params.ekf2_gps_ctrl & static_cast<int32_t>(GnssCtrl::VPOS))
 				&& common_conditions_passing;
@@ -103,6 +96,12 @@ void Ekf::controlGnssHeightFusion(const gnssSample &gps_sample)
 		if (_control_status.flags.gps_hgt) {
 			if (continuing_conditions_passing) {

+				// update the bias estimator before updating the main filter but after
+				// using its current state to compute the vertical position innovation
+				bias_est.setMaxStateNoise(sqrtf(measurement_var));
+				bias_est.setProcessNoiseSpectralDensity(_params.gps_hgt_bias_nsd);
+				bias_est.fuseBias(measurement - _gpos.altitude(), measurement_var + P(State::pos.idx + 2, State::pos.idx + 2));
+
 				fuseVerticalPosition(aid_src);

 				const bool is_fusion_failing = isTimedOut(aid_src.time_last_fuse, _params.hgt_fusion_timeout_max);
@@ -123,7 +123,8 @@ void Ekf::controlGnssVelFusion(estimator_aid_source3d_s &aid_src, const bool for
 {
 	const bool continuing_conditions_passing = (_params.ekf2_gps_ctrl & static_cast<int32_t>(GnssCtrl::VEL))
 			&& _control_status.flags.tilt_align
-			&& _control_status.flags.yaw_align;
+			&& _control_status.flags.yaw_align
+			&& !_control_status.flags.gnss_fault;
 	const bool starting_conditions_passing = continuing_conditions_passing && _gnss_checks.passed();

 	if (_control_status.flags.gnss_vel) {
@@ -125,11 +125,13 @@ void Ekf::controlOpticalFlowFusion(const imuSample &imu_delayed)

 		if (_flow_counter == 0) {
 			_flow_vel_body_lpf.reset(_flow_vel_body);
+			_flow_rate_compensated_lpf.reset(_flow_rate_compensated);
 			_flow_counter = 1;

 		} else {

 			_flow_vel_body_lpf.update(_flow_vel_body);
+			_flow_rate_compensated_lpf.update(_flow_rate_compensated);
 			_flow_counter++;
 		}

@@ -240,8 +242,23 @@ void Ekf::resetTerrainToFlow()
 {
 	ECL_INFO("reset hagl to flow");

-	// TODO: use the flow data
-	const float new_terrain = -_gpos.altitude() + _params.ekf2_min_rng;
+	float new_terrain = -_gpos.altitude() + _params.ekf2_min_rng;
+
+	if (isOtherSourceOfHorizontalAidingThan(_control_status.flags.opt_flow)) {
+		// ||vel_NE|| = ||( R * flow_body * range).xy()||
+		// range = ||vel_NE|| / ||P * R * flow_body||
+		constexpr float kProjXY[2][3] = {{1.f, 0.f, 0.f}, {0.f, 1.f, 0.f}};
+		const matrix::Matrix<float, 2, 3> proj(kProjXY);
+
+		const Vector3f flow_body(-_flow_rate_compensated_lpf.getState()(1), _flow_rate_compensated_lpf.getState()(0), 0.f);
+		const float denom = Vector2f(proj * _R_to_earth * flow_body).norm();
+
+		if (denom > 1e-6f) {
+			const float range = _state.vel.xy().norm() / denom;
+			new_terrain = -_gpos.altitude() + max(range, _params.ekf2_min_rng);
+		}
+	}
+
 	const float delta_terrain = new_terrain - _state.terrain;
 	_state.terrain = new_terrain;
 	P.uncorrelateCovarianceSetVariance<State::terrain.dof>(State::terrain.idx, 100.f);
@@ -529,6 +529,7 @@ private:
 	uint32_t _flow_counter{0};                      ///< number of flow samples read for initialization

 	Vector2f _flow_rate_compensated{}; ///< measured angular rate of the image about the X and Y body axes after removal of body rotation (rad/s), RH rotation is positive
+	AlphaFilter<Vector2f> _flow_rate_compensated_lpf{_dt_ekf_avg, _kSensorLpfTimeConstant};
 #endif // CONFIG_EKF2_OPTICAL_FLOW

 #if defined(CONFIG_EKF2_AIRSPEED)
@@ -120,6 +120,16 @@ bool EkfWrapper::isIntendingGpsFusion() const
 	return _ekf->control_status_flags().gnss_vel || _ekf->control_status_flags().gnss_pos;
 }

+bool EkfWrapper::isGnssFaultDetected() const
+{
+	return _ekf->control_status_flags().gnss_fault;
+}
+
+void EkfWrapper::setGnssDeadReckonMode()
+{
+	_ekf_params->ekf2_gps_mode = static_cast<int32_t>(GnssMode::kDeadReckoning);
+}
+
 void EkfWrapper::enableGpsHeadingFusion()
 {
 	_ekf_params->ekf2_gps_ctrl |= static_cast<int32_t>(GnssCtrl::YAW);
@@ -78,6 +78,8 @@ public:
 	void enableGpsFusion();
 	void disableGpsFusion();
 	bool isIntendingGpsFusion() const;
+	bool isGnssFaultDetected() const;
+	void setGnssDeadReckonMode();

 	void enableGpsHeadingFusion();
 	void disableGpsHeadingFusion();
@@ -228,3 +228,54 @@ TEST_F(EkfGpsTest, altitudeDrift)
 	// THEN: the baro and local position should follow it
 	EXPECT_LT(fabsf(baro_innov), 0.1f);
 }
+
+TEST_F(EkfGpsTest, gnssJumpDetectionDRMode)
+{
+	// Dead-reckoning mode allows the EKF to reject GNSS data if another source
+	// of horizontal aiding is used (e.g.: airspped)
+	_ekf_wrapper.setGnssDeadReckonMode();
+	_ekf_wrapper.enableGpsHeightFusion();
+
+	// GIVEN:EKF that fuses GNSS and airspeed
+	const Vector3f previous_position = _ekf->getPosition();
+	const Vector3f simulated_velocity_earth(1.f, 0.5f, 0.0f);
+	const Vector2f airspeed_body(15.f, 0.0f);
+	_sensor_simulator._gps.setVelocity(simulated_velocity_earth);
+
+	_ekf->set_in_air_status(true);
+	_ekf->set_vehicle_at_rest(false);
+	_ekf->set_is_fixed_wing(true);
+
+	_sensor_simulator.startAirspeedSensor();
+	_sensor_simulator._airspeed.setData(airspeed_body(0), airspeed_body(0));
+	_sensor_simulator.runSeconds(1);
+
+	EXPECT_TRUE(_ekf_wrapper.isWindVelocityEstimated());
+
+	// AND: simulate jump in position
+	const Vector3f simulated_position_change(500.0f, -1.0f, 0.f);
+	_sensor_simulator._gps.stepHorizontalPositionByMeters(
+		Vector2f(simulated_position_change));
+	_sensor_simulator.runSeconds(15);
+
+	// THEN: the GNSS jump should trigger the fault detection
+	// and stop the fusion (including height and velocity)
+	const Vector3f estimated_position = _ekf->getPosition();
+	EXPECT_FALSE(_ekf_wrapper.isIntendingGpsHeightFusion());
+	EXPECT_FALSE(_ekf_wrapper.isIntendingGpsFusion());
+	EXPECT_TRUE(_ekf_wrapper.isGnssFaultDetected());
+
+	// The position is obtained through dead-reckoning
+	EXPECT_TRUE(isEqual(estimated_position,
+			    previous_position, 25.f));
+
+	// BUT WHEN: the position data goes back to normal
+	_sensor_simulator._gps.stepHorizontalPositionByMeters(
+		-Vector2f(simulated_position_change) + Vector2f(20.f, 10.f));
+	_sensor_simulator.runSeconds(1);
+
+	// THEN: the fault is cleared an dfusion restarts
+	EXPECT_FALSE(_ekf_wrapper.isGnssFaultDetected());
+	EXPECT_TRUE(_ekf_wrapper.isIntendingGpsHeightFusion());
+	EXPECT_TRUE(_ekf_wrapper.isIntendingGpsFusion());
+}
@@ -55,7 +55,10 @@ PARAM_DEFINE_INT32(SDLOG_UTC_OFFSET, 0);
 * Determines when to start and stop logging. By default, logging is started
 * when arming the system, and stopped when disarming.
 *
- * @value -1 disabled
+ * Note: The logging start/end points that can be configured here only apply to
+ * SD logging. The mavlink backend is started/stopped independently
+ * of these points.
+ *
 * @value 0 when armed until disarm (default)
 * @value 1 from boot until disarm
 * @value 2 from boot until shutdown
@@ -67,6 +70,25 @@ PARAM_DEFINE_INT32(SDLOG_UTC_OFFSET, 0);
 */
 PARAM_DEFINE_INT32(SDLOG_MODE, 0);

+/**
+ * Logging Backend (integer bitmask).
+ *
+ * If no logging is set the logger will not be started.
+ *
+ * Set bits true to enable:
+ * 0: SD card logging
+ * 1: Mavlink logging
+ *
+ * @min 0
+ * @max 3
+ * @bit 0 SD card logging
+ * @bit 1 Mavlink logging
+ *
+ * @reboot_required true
+ * @group SD Logging
+ */
+PARAM_DEFINE_INT32(SDLOG_BACKEND, 3);
+
 /**
 * Battery-only Logging
 *
@@ -1832,7 +1832,6 @@ Mavlink::configure_streams_to_default(const char *configure_single_stream)
 		configure_stream_local("AVAILABLE_MODES", 0.3f);
 		configure_stream_local("BATTERY_STATUS", 0.5f);
 		configure_stream_local("CAMERA_IMAGE_CAPTURED", 2.0f);
-		configure_stream_local("COLLISION", 2.0f);
 		configure_stream_local("CURRENT_MODE", 0.5f);
 		configure_stream_local("ESTIMATOR_STATUS", 1.0f);
 		configure_stream_local("EXTENDED_SYS_STATE", 0.5f);
@@ -1852,7 +1851,6 @@ Mavlink::configure_streams_to_default(const char *configure_single_stream)
 		configure_stream_local("SYS_STATUS", 0.5f);
 		configure_stream_local("SYSTEM_TIME", 2.0f);
 		configure_stream_local("TIME_ESTIMATE_TO_TARGET", 0.5f);
-		configure_stream_local("TRAJECTORY_REPRESENTATION_WAYPOINTS", 2.0f);
 		configure_stream_local("VFR_HUD", 1.0f);
 		configure_stream_local("VIBRATION", 0.1f);
 		configure_stream_local("WIND_COV", 0.1f);
--- a/Show More
+++ b/Show More
Author	SHA1	Message	Date
PX4 BuildBot	98d2485025	Update submodule devices to latest Thu Sep 4 12:39:24 UTC 2025 - devices in PX4/Firmware (2538feab9b0245bcdb7f3fe1d0c70d354bdf7d0f): https://github.com/PX4/PX4-GPSDrivers/commit/ce0afaeca23a3b88efcf52d47c82277839980f9d - devices current upstream: https://github.com/PX4/PX4-GPSDrivers/commit/8fdef3bc0cb7820119abdb7320ad3992af2e440f - Changes: https://github.com/PX4/PX4-GPSDrivers/compare/ce0afaeca23a3b88efcf52d47c82277839980f9d...8fdef3bc0cb7820119abdb7320ad3992af2e440f 8fdef3b 2025-09-02 Øyvind Taksdal Stubhaug - ubx: don't inject RTCM while configuring device (#187) f66ac07 2025-08-28 Alex Klimaj - ubx: add support for DAN-F10N and X20 (#181)	2025-09-04 12:39:24 +00:00
Pedro Roque	944b3e763a	doc: Change email for Pedro Roque (#25514 )	2025-09-02 16:07:55 -08:00
Pedro Roque	271cb49597	feat: airframe documentation for spacecraft (#25294 )	2025-09-02 16:27:26 -07:00
Alexander Lerach	9015001b42	uavcan: fix driver init after stop/start (#25511 )	2025-09-02 10:02:15 -08:00
Silvan	ce207837cf	rc.sensors: add iis2mdc mag to list of probed for sensors Signed-off-by: Silvan <silvan@auterion.com>	2025-09-02 10:16:32 -06:00
Niklas Hauser	3a734bc846	[board] Add PCA9685 driver to FMUv6s board	2025-08-29 14:05:40 +02:00
Niklas Hauser	9062d0cc7d	[driver] Add a parameter to enable the PCA9685 driver	2025-08-29 14:05:40 +02:00
Niklas Hauser	b2b80e8075	[board] Reformat FMUv6s init script to start internal sensor first	2025-08-29 14:05:40 +02:00
Balduin	2eac6cca38	dds_topics: accept landing_gear command from external modes (#25496 )	2025-08-28 08:30:27 -08:00
Claudio Chies	fe1abb5b92	the PR has long been merged (#25495 )	2025-08-28 08:28:44 -08:00
Marco Hauswirth	073013cf85	reset terrain w flow based on current horizontal velocity	2025-08-28 13:58:29 +02:00
Silvan Fuhrer	547582b16b	DSHOT: fix unit for DSHOT_MIN parameter (#25493 ) Signed-off-by: Silvan <silvan@auterion.com>	2025-08-27 09:21:16 -08:00
Alexander Lerach	8f2c36689d	logging: allow logging backend config * logging: allow logging backend config * correct board comments * documentation: updated logging section	2025-08-27 15:44:36 +02:00
Jacob Dahl	30fcb4fcb1	uavcan: esc: init msg to avoid publishing random values (#25485 )	2025-08-27 17:09:36 +12:00
Davide Iafrate	ec436d3be3	Enable selectively disabling sensors in the Gazebo bridge. (#25484 ) * Initial plan * Add configurable sensor subscription parameters Co-authored-by: Tuxliri <3532595+Tuxliri@users.noreply.github.com> --------- Co-authored-by: copilot-swe-agent[bot] <198982749+Copilot@users.noreply.github.com> Co-authored-by: Tuxliri <3532595+Tuxliri@users.noreply.github.com>	2025-08-26 10:00:47 -08:00
Beat Küng	6ec8dec63a	commander: add valid_registrations_mask to ArmingCheckRequest.msg This allows external modes to individually check if they are flagged as invalid/unresponsive. Previously this was done only based on whether or not ArmingCheckRequest was received, which does not work when multiple modes are running.	2025-08-26 14:38:05 +02:00
Beat Küng	edfcdaa008	commander: check for stale arming_check_reply messages based on the message timestamp. Previously it was possible to run into the following case: - 2 external modes are registered (running inside the same ROS node) - they time out due to the micro xrce agent being blocked for some reason - PX4 removes them - the latest arming check replies still arrive to PX4 - the application restarts - the first mode gets registered - PX4 handles the previous arming check reply, and clears waiting_for_first_response, which reduces the timeout - the second mode registers and as part of that checks for message compatibility. This takes ~1s, triggering a timeout of the first mode	2025-08-26 14:38:05 +02:00
Silvan	a1ee9eb2c4	mavlink: remove streams from LOW_BANDWIDTH that are deprecated Signed-off-by: Silvan <silvan@auterion.com>	2025-08-25 17:34:34 +02:00
bresch	4a697d0191	ekf2: stop GNSS altittude and velocity aiding when gnss_fault is set	2025-08-25 10:22:23 +02:00
mahima-yoga	db3f33760e	docs: add instructions for controlling actuators in SIH	2025-08-25 09:28:43 +02:00
mahima-yoga	dd09cdf986	Commander: remove HIL_STATE_ON from arming lockdown Removing this from the boolean allows users to send pwm values in SIH.	2025-08-25 09:28:43 +02:00
chfriedrich98	4a5eabb61e	rover: constrain update steps	2025-08-22 12:13:01 +02:00
chfriedrich98	248f113141	rover: improve hold position logic (#25466 )	2025-08-22 12:10:16 +02:00
Peter van der Perk	c1d15d0e09	Zenoh: use strncpy and bool	2025-08-22 08:22:59 +02:00
Peter van der Perk	8689c00be7	Zenoh: cleanup and review	2025-08-22 08:22:59 +02:00
Peter van der Perk	17e843a985	zenoh: remove MessageFormat since Zenoh RIHS01 already provides it RIHS01 has the same functionality and already provides type safety with rmw_zenoh_cpp. The user on ROS2 can compare the PX4 ros2_lv hashes with their own px4_msgs for a mismatch	2025-08-22 08:22:59 +02:00
Peter van der Perk	44ff6d9c62	zenoh: exclude src/modules/zenoh/dds_topics.yaml from yaml check	2025-08-22 08:22:59 +02:00
Peter van der Perk	747bcc9db5	zenoh: Move ROS2 Rmw attachment code to rmw_attachment.h Allows for re-use for later ROS2 Service / Zenoh queryable	2025-08-22 08:22:59 +02:00
Benjamin Chung	c41216376a	Add an explicatory comment to Zenoh publisher's handling of the uOrb topic number (or lack thereof)	2025-08-22 08:22:59 +02:00
Benjamin Chung	88c1412d25	Zenoh CLI improvements	2025-08-22 08:22:59 +02:00
Benjamin Chung	01bf700f3d	Fix dds topics naming	2025-08-22 08:22:59 +02:00
Benjamin Chung	0bb9e5952a	Pubsub constructor template fix	2025-08-22 08:22:59 +02:00
Benjamin Chung	70054fc567	Implement instance selection & pub/sub deletion for Zenoh	2025-08-22 08:22:59 +02:00
Benjamin Chung	7a98c87fcb	Copy the uxrce config for Zenoh	2025-08-22 08:22:59 +02:00
Benjamin Chung	80b5cf2ed7	Prevent conversion warnings from static integers in zenoh-pico	2025-08-22 08:22:59 +02:00
Peter van der Perk	9ffd31097d	zenoh: Use CDRv1 to match ROS2 Fixes various padding related serialization issues.	2025-08-22 08:22:59 +02:00
Peter van der Perk	f99759db87	zenoh: Fix status keyexpr printf	2025-08-22 08:22:59 +02:00
Peter van der Perk	231128c68e	Zenoh set transport lease to 60000 to match ros2	2025-08-22 08:22:59 +02:00
Peter van der Perk	5622565eea	Zenoh optimize memory usage and add optional publish on matching	2025-08-22 08:22:59 +02:00
Peter van der Perk	7887f16daa	Update NuttX config for use with Zenoh	2025-08-22 08:22:59 +02:00
Peter van der Perk	0763bbe2cf	Generate default Zenoh config from dds_topics.yaml For easy transition from uxrce to zenoh and a sane base config to begin with	2025-08-22 08:22:59 +02:00
Peter van der Perk	bac009c2b8	Enable Zenoh by default on big-flash targets These targets can easily support Zenoh by default eases adoption and testing	2025-08-22 08:22:59 +02:00
Peter van der Perk	ac2627cca9	rmw attachment serialization changes Use new atachment serialization format Subscriber fix parsing payload and remove uorb publisher on destructor	2025-08-22 08:22:59 +02:00
Peter van der Perk	61e2f566ca	Zenoh config, lv and connection fixes Fixes a bug in the csv parsing Use % for / seperators in ros2_lv On startup retry connecting	2025-08-22 08:22:59 +02:00
Peter van der Perk	3d30eaae5f	Fix NuttX keepalive socketoption	2025-08-22 08:22:59 +02:00
Peter van der Perk	e052f35664	zenoh: omit timestamp attachment This isn't needed for the rmw_zenoh zenohd configuration	2025-08-22 08:22:59 +02:00
Peter van der Perk	2bc9cb4ead	zenoh: implemement experimental liveliness to get ROS2 graph to work	2025-08-22 08:22:59 +02:00
Peter van der Perk	5211d9c92e	zenoh: pubsub factory fix datatype naming convention	2025-08-22 08:22:59 +02:00
Peter van der Perk	575923b534	Zenoh: fix topic_name and datatype mapping Using substring was buggy instad we make dictionary based on datatypes and the get_topics function	2025-08-22 08:22:59 +02:00
Peter van der Perk	e37f20e94d	zenoh: Don't use uORB o_name as type but check for parent type For example vehicle_local_position_groundtruth has ROS2 type vehicle_local_position, so we've to use px4_msgs/VehicleLocalPosition as typename	2025-08-22 08:22:59 +02:00
Peter van der Perk	cb74cee970	zenoh: Increase CDR safety margin Figure out by trial and error with padding on vehicle_local_position	2025-08-22 08:22:59 +02:00
Peter van der Perk	70536766db	zenoh: Handle parsing errors in config	2025-08-22 08:22:59 +02:00
Peter van der Perk	40bba0069d	zenoh: Fix handling for non-existing types	2025-08-22 08:22:59 +02:00
Peter van der Perk	35004e357c	zenoh: Add px4_sitl_zenoh to cmake-variants.yaml	2025-08-22 08:22:59 +02:00
Peter van der Perk	923257779a	zenoh: Default to 127.0.0.1 when using sitl/posix Also improve error message when connection failed	2025-08-22 08:22:59 +02:00
Peter van der Perk	a24b3a121c	zenoh: Improve error message when there are no scouting results	2025-08-22 08:22:59 +02:00
Peter van der Perk	85cab5a4db	sitl: autostart zenoh if enabled	2025-08-22 08:22:59 +02:00
Peter van der Perk	859ba81e33	Zenoh fix gcc/sitl compile errors	2025-08-22 08:22:59 +02:00
Peter van der Perk	4aff095f9b	IDL 2 RIHS01 remove tempfile and print	2025-08-22 08:22:59 +02:00
Peter van der Perk	796efeebe7	Implement Domain id parameter and move gid to zenoh	2025-08-22 08:22:59 +02:00
Peter van der Perk	9d02698987	Update Zenoh for library and implement rmw_zenoh features New zenoh-pico library Keyexpr instrospection RIHS01 Types	2025-08-22 08:22:59 +02:00
Peter van der Perk	e1a7fbce71	Update cdrstream code generator including typehash	2025-08-22 08:22:59 +02:00
Peter van der Perk	a87456b38b	Update rosidl Adds support for typehashes	2025-08-22 08:22:59 +02:00
Peter van der Perk	33a5122916	Update Zenoh-pico	2025-08-22 08:22:59 +02:00
ljarvela	b53ecf7f68	uavcan: increase battery filter sample interval to 500ms (#25454 ) Fixes issue #25430 Co-authored-by: Lasse Järvelä <lasse.jarvela@iceye.com>	2025-08-21 19:19:52 -07:00
Alexander Lerach	138427b3a8	config: add dynamic init file * config: add dynamic init file * added review feedback * added docs	2025-08-21 16:46:06 +02:00
Alexander Lerach	785ea1a137	ubx: add new mode for GCS usage * ubx: add new mode for GCS usage * use head ref	2025-08-21 15:45:40 +02:00
chfriedrich98	8e5cd59502	rover: fix setpoint generation	2025-08-21 13:33:19 +02:00
Beat Küng	df11aa1d69	fix commander: handle mode executor correctly on disarm There were a number of cases where the state was not correct or not as desired after disarming, when running an external mode 'MyMission' with executor: - run MyMission, which triggers Hold, then Land - before: Mode: Hold, executor_in_charge: 1 - after: Mode: MyMission, executor_in_charge: 1 - run MyMission, then user switches to RTL - before: Mode: MyMission, executor_in_charge: 0 - after: Mode: MyMission, executor_in_charge: 1 - run MyMission, then while in Hold mode, low battery failsafe (RTL) - before: Mode: Hold, executor_in_charge: 1 - after: Mode: MyMission, executor_in_charge: 1 - run MyMission, then stop external mode (terminate the process) - before: Mode: (mode not available), executor_in_charge: 0 - after: Mode: Hold, executor_in_charge: 0 This case is unchanged: - run MyMission, then low battery failsafe (RTL) - before: Mode: MyMission, executor_in_charge: 1 - after: Mode: MyMission, executor_in_charge: 1	2025-08-21 10:06:30 +02:00