rusefi
/
atbetaflight
mirror of https://github.com/rusefi/atbetaflight.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Disable trampHandleResponse() instead of trampReceive()

This commit is contained in:
jflyper 2017-01-13 02:58:58 +09:00 committed by Raphael Coeffic
parent 5bbf4e13c1
commit 3d9a82e4ae
1 changed files with 6 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
src/main/io/vtx_tramp.c
View File

@ -226,6 +226,8 @@ void trampReceive(uint32_t currentTimeUs)
if (c == 0x0F) {
trampReceiveState = S_WAIT_CODE;
trampFrameStartUs = currentTimeUs;
} else {
trampReceivePos = 0;
}
break;
@ -241,8 +243,9 @@ void trampReceive(uint32_t currentTimeUs)
case S_DATA:
if (trampReceivePos == 16) {
uint8_t cksum = trampChecksum(trampRespBuffer);
if ((trampRespBuffer[14] == cksum) && (trampRespBuffer[15] == 0))
trampHandleResponse();
if ((trampRespBuffer[14] == cksum) && (trampRespBuffer[15] == 0)) {
// trampHandleResponse();
}
trampReceiveState = S_WAIT_LEN;
trampReceivePos = 0;
@ -259,7 +262,7 @@ void trampProcess(uint32_t currentTimeUs)
if (trampStatus == TRAMP_STATUS_BAD_DEVICE)
return;
trampReceive(currentTimeUs);
// trampReceive(currentTimeUs);
if (trampStatus == TRAMP_STATUS_OFFLINE) {
if (cmp32(currentTimeUs, lastQueryRTimeUs) > 1000 * 1000) {