Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-24 00:35:39 +03:00
Code Issues Wiki Activity

Fix for VTX and lack of telemetry

Browse source
This commit is contained in:
blckmn 2022-11-05 13:47:24 +11:00
parent 323936e7b2
commit b00e252477
1 changed files with 8 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

8
src/main/io/vtx_msp.c
View file

@ -92,7 +92,11 @@ static bool isLowPowerDisarmed(void)
void setMspVtxDeviceStatusReady(const int descriptor) void setMspVtxDeviceStatusReady(const int descriptor)
{ {
if (mspVtxStatus != MSP_VTX_STATUS_READY && vtxTableConfig()->bands && vtxTableConfig()->channels && vtxTableConfig()->powerLevels) { if (mspVtxStatus != MSP_VTX_STATUS_READY && vtxTableConfig()->bands && vtxTableConfig()->channels && vtxTableConfig()->powerLevels) {
#if defined(USE_MSP_OVER_TELEMETRY)
if (getMspSerialPortDescriptor(mspVtxPortIdentifier) == descriptor || getMspTelemetryDescriptor() == descriptor) { if (getMspSerialPortDescriptor(mspVtxPortIdentifier) == descriptor || getMspTelemetryDescriptor() == descriptor) {
#else
if (getMspSerialPortDescriptor(mspVtxPortIdentifier) == descriptor) {
#endif
mspVtxStatus = MSP_VTX_STATUS_READY; mspVtxStatus = MSP_VTX_STATUS_READY;
} }
} }
@ -214,7 +218,11 @@ static void vtxMspProcess(vtxDevice_t *vtxDevice, timeUs_t currentTimeUs)
DEBUG_SET(DEBUG_VTX_MSP, 0, packetCounter); DEBUG_SET(DEBUG_VTX_MSP, 0, packetCounter);
DEBUG_SET(DEBUG_VTX_MSP, 1, isCrsfPortConfig(portConfig)); DEBUG_SET(DEBUG_VTX_MSP, 1, isCrsfPortConfig(portConfig));
DEBUG_SET(DEBUG_VTX_MSP, 2, isLowPowerDisarmed()); DEBUG_SET(DEBUG_VTX_MSP, 2, isLowPowerDisarmed());
#if defined(USE_MSP_OVER_TELEMETRY)
DEBUG_SET(DEBUG_VTX_MSP, 3, isCrsfPortConfig(portConfig) ? getMspTelemetryDescriptor() : getMspSerialPortDescriptor(mspVtxPortIdentifier)); DEBUG_SET(DEBUG_VTX_MSP, 3, isCrsfPortConfig(portConfig) ? getMspTelemetryDescriptor() : getMspSerialPortDescriptor(mspVtxPortIdentifier));
#else
DEBUG_SET(DEBUG_VTX_MSP, 3, getMspSerialPortDescriptor(mspVtxPortIdentifier));
#endif
} }
static vtxDevType_e vtxMspGetDeviceType(const vtxDevice_t *vtxDevice) static vtxDevType_e vtxMspGetDeviceType(const vtxDevice_t *vtxDevice)