Pulses fixes
This commit is contained in:
@@ -102,12 +102,14 @@ void setupPulsesMultimodule()
|
||||
|
||||
// Every 1000 cycles (=9s) send a config packet that configures the multimodule (inversion, telemetry type)
|
||||
counter++;
|
||||
if (counter % 1000== 500) {
|
||||
if (counter % 1000== 500) {
|
||||
sendSetupFrame();
|
||||
} else if (counter % 1000 == 0 && g_model.moduleData[EXTERNAL_MODULE].failsafeMode != FAILSAFE_NOT_SET && g_model.moduleData[EXTERNAL_MODULE].failsafeMode != FAILSAFE_RECEIVER) {
|
||||
}
|
||||
else if (counter % 1000 == 0 && g_model.moduleData[EXTERNAL_MODULE].failsafeMode != FAILSAFE_NOT_SET && g_model.moduleData[EXTERNAL_MODULE].failsafeMode != FAILSAFE_RECEIVER) {
|
||||
sendFrameProtocolHeader(EXTERNAL_MODULE, true);
|
||||
sendFailsafeChannels(EXTERNAL_MODULE);
|
||||
} else {
|
||||
}
|
||||
else {
|
||||
// Normal Frame
|
||||
sendFrameProtocolHeader(EXTERNAL_MODULE, false);
|
||||
sendChannels(EXTERNAL_MODULE);
|
||||
|
||||
@@ -171,7 +171,7 @@ void disablePulses(uint8_t module, uint8_t protocol)
|
||||
#endif
|
||||
|
||||
#if defined(MULTIMODULE)
|
||||
case PROTOCOL_CHANNELS_MULTIMODULE:
|
||||
case PROTOCOL_CHANNELS_MULTIMODULE:
|
||||
#endif
|
||||
case PROTOCOL_CHANNELS_SBUS:
|
||||
disable_serial(module);
|
||||
@@ -204,7 +204,7 @@ void enablePulses(uint8_t module, uint8_t protocol)
|
||||
case PROTOCOL_CHANNELS_DSM2_LP45:
|
||||
case PROTOCOL_CHANNELS_DSM2_DSM2:
|
||||
case PROTOCOL_CHANNELS_DSM2_DSMX:
|
||||
init_serial(module, DSM2_BAUDRATE, DSM2_PERIOD * 2000);
|
||||
init_serial(module, DSM2_BAUDRATE, DSM2_PERIOD * 2000, false);
|
||||
break;
|
||||
#endif
|
||||
|
||||
@@ -222,12 +222,12 @@ void enablePulses(uint8_t module, uint8_t protocol)
|
||||
|
||||
#if defined(MULTIMODULE)
|
||||
case PROTOCOL_CHANNELS_MULTIMODULE:
|
||||
init_serial(module, MULTIMODULE_BAUDRATE, MULTIMODULE_PERIOD * 2000);
|
||||
init_serial(module, MULTIMODULE_BAUDRATE, MULTIMODULE_PERIOD * 2000, true);
|
||||
break;
|
||||
#endif
|
||||
|
||||
case PROTOCOL_CHANNELS_SBUS:
|
||||
init_serial(module, SBUS_BAUDRATE, SBUS_PERIOD_HALF_US);
|
||||
init_serial(module, SBUS_BAUDRATE, SBUS_PERIOD_HALF_US, false);
|
||||
break;
|
||||
|
||||
case PROTOCOL_CHANNELS_PPM:
|
||||
|
||||
Reference in New Issue
Block a user