Fix FMU init

This commit is contained in:
Lorenz Meier
2016-08-15 10:49:10 +02:00
parent 4b9e1d58f7
commit 8b66a76432
+8 -8
View File
@@ -405,15 +405,15 @@ PX4FMU::init()
return ret;
}
if (_mode != MODE_NONE) {
/* try to claim the generic PWM output device node as well - it's OK if we fail at this */
_class_instance = register_class_devname(PWM_OUTPUT_BASE_DEVICE_PATH);
// XXX best would be to register / de-register the device depending on modes
if (_class_instance == CLASS_DEVICE_PRIMARY) {
/* lets not be too verbose */
} else if (_class_instance < 0) {
warnx("FAILED registering class device");
}
/* try to claim the generic PWM output device node as well - it's OK if we fail at this */
_class_instance = register_class_devname(PWM_OUTPUT_BASE_DEVICE_PATH);
if (_class_instance == CLASS_DEVICE_PRIMARY) {
/* lets not be too verbose */
} else if (_class_instance < 0) {
warnx("FAILED registering class device");
}
_safety_disabled = circuit_breaker_enabled("CBRK_IO_SAFETY", CBRK_IO_SAFETY_KEY);