piotr/edgetx-gx12
1
0
Fork 0
Code Issues 2 Pull Requests Actions Packages Projects Releases Wiki Activity

feat: trainer SBUS processing in IDLE IRQ (#5672)

Browse Source
This commit is contained in:
3djc
2024-11-25 10:58:53 +10:00
committed by GitHub
parent b35baecfb9
commit 7594a47a2d
5 changed files with 65 additions and 102 deletions
Download Patch File Download Diff File Expand all files Collapse all files
radio/src/trainer.cpp
+11 -19
View File
@@ -103,7 +103,7 @@ void stopTrainer()
break;
case TRAINER_MODE_MASTER_SERIAL:
sbusSetGetByte(nullptr);
sbusAuxSetEnabled(false);
break;
case TRAINER_MODE_MASTER_CPPM_EXTERNAL_MODULE:
@@ -111,7 +111,6 @@ void stopTrainer()
break;
case TRAINER_MODE_MASTER_SBUS_EXTERNAL_MODULE:
sbusSetGetByte(nullptr);
trainer_stop_module_sbus();
break;
}
@@ -141,7 +140,7 @@ void checkTrainerSettings()
break;
case TRAINER_MODE_MASTER_SERIAL:
sbusSetGetByte(sbusAuxGetByte);
sbusAuxSetEnabled(true);
break;
case TRAINER_MODE_MASTER_CPPM_EXTERNAL_MODULE:
@@ -150,7 +149,6 @@ void checkTrainerSettings()
case TRAINER_MODE_MASTER_SBUS_EXTERNAL_MODULE:
trainer_init_module_sbus();
sbusSetGetByte(sbus_trainer_get_byte);
break;
}
@@ -190,7 +188,15 @@ static void trainer_init_module_sbus()
}
if (sbus_trainer_mod_st) {
modulePortSetPower(EXTERNAL_MODULE,true);
// configure IDLE IRQ callback
auto drv = modulePortGetSerialDrv(sbus_trainer_mod_st->rx);
auto ctx = modulePortGetCtx(sbus_trainer_mod_st->rx);
sbusSetReceiveCtx(ctx, drv);
drv->setIdleCb(ctx, sbusFrameReceived, nullptr);
// switch ON
modulePortSetPower(EXTERNAL_MODULE, true);
}
}
@@ -201,17 +207,3 @@ static void trainer_stop_module_sbus()
modulePortSetPower(EXTERNAL_MODULE,false);
sbus_trainer_mod_st = nullptr;
}
static int sbus_trainer_get_byte(uint8_t* data)
{
if (!sbus_trainer_mod_st) return 0;
auto serial_driver = modulePortGetSerialDrv(sbus_trainer_mod_st->rx);
auto ctx = modulePortGetCtx(sbus_trainer_mod_st->rx);
if (ctx) {
return serial_driver->getByte(ctx, data);
}
return 0;
}