diff --git a/ROMFS/px4fmu_common/init.d/rc.fw_defaults b/ROMFS/px4fmu_common/init.d/rc.fw_defaults
index 3063fce346a589579860b9c737d4ec288b11de4c..20e0b60ada82383a04c8cc0f7f9944bca5f7cedd 100644
--- a/ROMFS/px4fmu_common/init.d/rc.fw_defaults
+++ b/ROMFS/px4fmu_common/init.d/rc.fw_defaults
@@ -8,8 +8,11 @@ then
 	# Default parameters for FW
 	#
 	param set COM_POS_FS_DELAY 5
-	param set COM_POS_FS_PROB 1
+	param set COM_POS_FS_EPH 25
+	param set COM_POS_FS_EPV 50
 	param set COM_POS_FS_GAIN 0
+	param set COM_POS_FS_PROB 1
+	param set COM_VEL_FS_EVH 5
 
 	param set EKF2_ARSP_THR 8.0
 	param set EKF2_FUSE_BETA 1