From 7c1da8d6086ff1bd6dfb700c7c8e21ac513a19ae Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Igor=20Mi=C5=A1i=C4=87?= <igy1000mb@gmail.com>
Date: Tue, 14 Jun 2022 10:35:33 +0200
Subject: [PATCH] driver/px4io: set default failsafe values

---
 src/drivers/px4io/px4io.cpp | 8 ++++++++
 1 file changed, 8 insertions(+)

diff --git a/src/drivers/px4io/px4io.cpp b/src/drivers/px4io/px4io.cpp
index 82a4979093..f16f81c256 100644
--- a/src/drivers/px4io/px4io.cpp
+++ b/src/drivers/px4io/px4io.cpp
@@ -803,6 +803,14 @@ void PX4IO::update_params()
 						int32_t pwm_fail_new = _mixing_output.failsafeValue(i);
 						param_set(param_find(str), &pwm_fail_new);
 					}
+
+				} else {
+					if (pwm_default_channel_mask & 1 << i) {
+						_mixing_output.failsafeValue(i) = PWM_MOTOR_OFF;
+
+					} else {
+						_mixing_output.failsafeValue(i) = PWM_SERVO_STOP;
+					}
 				}
 			}
 		}