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

Graft of serial port inversion option onto 'next'.

Browse Source
This commit is contained in:
mikeller
2015-12-15 12:03:21 +13:00
committed by Michael Keller
parent 92704687cf
commit 01fa6471c7
19 changed files with 80 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files
radio/src/telemetry/frsky.cpp
+19 -1
View File
@@ -69,6 +69,9 @@ FrskyData frskyData;
#if defined(CPUARM)
uint8_t telemetryProtocol = 255;
#if defined(REVX)
uint8_t serialInversion = 0;
#endif
#define IS_FRSKY_D_PROTOCOL() (telemetryProtocol == PROTOCOL_FRSKY_D)
#define IS_FRSKY_SPORT_PROTOCOL() (telemetryProtocol == PROTOCOL_FRSKY_SPORT)
#else
@@ -283,7 +286,13 @@ void telemetryWakeup()
{
#if defined(CPUARM)
uint8_t requiredTelemetryProtocol = MODEL_TELEMETRY_PROTOCOL();
if (telemetryProtocol != requiredTelemetryProtocol) {
#if defined(REVX)
uint8_t requiredSerialInversion = g_model.moduleData[EXTERNAL_MODULE].invertedSerial;
if (telemetryProtocol != requiredTelemetryProtocol || serialInversion != requiredSerialInversion) {
serialInversion = requiredSerialInversion;
#else
if (telemetryProtocol != requiredTelemetryProtocol) {
#endif
telemetryProtocol = requiredTelemetryProtocol;
telemetryInit();
}
@@ -622,6 +631,15 @@ void telemetryInit(void)
else {
telemetryPortInit(FRSKY_SPORT_BAUDRATE);
}
#if defined(REVX)
if (serialInversion) {
setMFP();
}
else {
clearMFP();
}
#endif
#elif !defined(SIMU)
telemetryPortInit();
#endif