Try to fix the trainer mode mess

This commit is contained in:
Raphael Coeffic
2022-03-20 16:30:59 +01:00
parent 34e9cbb245
commit de43d7e77c
6 changed files with 60 additions and 82 deletions
+12 -16
View File
@@ -61,6 +61,10 @@ void stopTrainer()
stop_trainer_ppm();
break;
case TRAINER_MODE_MASTER_SERIAL:
sbusSetGetByte(nullptr);
break;
#if defined(TRAINER_MODULE_CPPM)
case TRAINER_MODE_MASTER_CPPM_EXTERNAL_MODULE:
stop_trainer_module_cppm();
@@ -73,12 +77,6 @@ void stopTrainer()
stop_trainer_module_sbus();
break;
#endif
#if defined(TRAINER_BATTERY_COMPARTMENT)
case TRAINER_MODE_MASTER_BATTERY_COMPARTMENT:
sbusSetGetByte(nullptr);
break;
#endif
}
currentTrainerMode = 0xFF;
@@ -96,10 +94,18 @@ void checkTrainerSettings()
currentTrainerMode = requiredTrainerMode;
switch (requiredTrainerMode) {
case TRAINER_MODE_MASTER_TRAINER_JACK:
init_trainer_capture();
break;
case TRAINER_MODE_SLAVE:
init_trainer_ppm();
break;
case TRAINER_MODE_MASTER_SERIAL:
sbusSetGetByte(sbusAuxGetByte);
break;
#if defined(TRAINER_MODULE_CPPM)
case TRAINER_MODE_MASTER_CPPM_EXTERNAL_MODULE:
init_trainer_module_cppm();
@@ -112,16 +118,6 @@ void checkTrainerSettings()
sbusSetGetByte(trainerModuleSbusGetByte);
break;
#endif
#if defined(TRAINER_BATTERY_COMPARTMENT)
case TRAINER_MODE_MASTER_BATTERY_COMPARTMENT:
sbusSetGetByte(sbusAuxGetByte);
break;
#endif
case TRAINER_MODE_MASTER_TRAINER_JACK:
init_trainer_capture();
break;
}
#if defined(INTMODULE_HEARTBEAT_GPIO) && !defined(SIMU)