mirror of
https://github.com/betaflight/betaflight.git
synced 2025-07-25 09:16:07 +03:00
fixed open connection twice times and timeout logic
This commit is contained in:
azol
azolyoung
parent
5967b9b597
commit
8b98528590
8 changed files with 159 additions and 99 deletions
|
|
@ -47,6 +47,7 @@ extern "C" {
|
|||
#include "pg/pg_ids.h"
|
||||
#include "pg/vcd.h"
|
||||
#include "pg/rx.h"
|
||||
#include "pg/rcdevice.h"
|
||||
|
||||
#include "rx/rx.h"
|
||||
|
||||
|
|
@ -57,6 +58,7 @@ extern "C" {
|
|||
extern bool isButtonPressed;
|
||||
extern bool rcdeviceInMenu;
|
||||
extern rcdeviceWaitingResponseQueue watingResponseQueue;
|
||||
PG_REGISTER_WITH_RESET_FN(rcdeviceConfig_t, rcdeviceConfig, PG_RCDEVICE_CONFIG, 0);
|
||||
bool unitTestIsSwitchActivited(boxId_e boxId)
|
||||
{
|
||||
uint8_t adjustBoxID = boxId - BOXCAMERA1;
|
||||
|
|
@ -64,8 +66,14 @@ extern "C" {
|
|||
return switchState.isActivated;
|
||||
}
|
||||
|
||||
void pgResetFn_rcdeviceConfig(rcdeviceConfig_t *rcdeviceConfig)
|
||||
{
|
||||
rcdeviceConfig->initDeviceAttempts = 4;
|
||||
rcdeviceConfig->initDeviceAttemptInterval = 1000;
|
||||
}
|
||||
|
||||
uint32_t millis(void);
|
||||
int minTimeout = 400;
|
||||
int minTimeout = 180;
|
||||
}
|
||||
|
||||
#define MAX_RESPONSES_COUNT 10
|
||||
|
|
@ -146,11 +154,11 @@ TEST(RCDeviceTest, TestInitDevice)
|
|||
addResponseData(responseData, sizeof(responseData), true);
|
||||
|
||||
runcamDeviceInit(&device);
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
testData.responseDataReadPos = 0;
|
||||
testData.indexOfCurrentRespBuf = 0;
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(device.isReady, true);
|
||||
}
|
||||
|
|
@ -171,12 +179,11 @@ TEST(RCDeviceTest, TestInitDeviceWithInvalidResponse)
|
|||
uint8_t responseData[] = { 0xCC, 0x01, 0x37, 0x00, 0xBD, 0x33 };
|
||||
addResponseData(responseData, sizeof(responseData), true);
|
||||
runcamDeviceInit(&device);
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
testData.responseDataReadPos = 0;
|
||||
testData.indexOfCurrentRespBuf = 0;
|
||||
printf("call receiver func again\n");
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
EXPECT_EQ(device.isReady, true);
|
||||
clearResponseBuff();
|
||||
testData.millis += minTimeout;
|
||||
|
|
@ -185,12 +192,11 @@ TEST(RCDeviceTest, TestInitDeviceWithInvalidResponse)
|
|||
uint8_t responseDataWithInvalidCRC[] = { 0xCC, 0x01, 0x37, 0x00, 0xBE };
|
||||
addResponseData(responseDataWithInvalidCRC, sizeof(responseDataWithInvalidCRC), true);
|
||||
runcamDeviceInit(&device);
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
testData.responseDataReadPos = 0;
|
||||
testData.indexOfCurrentRespBuf = 0;
|
||||
printf("call receiver func again11\n");
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
EXPECT_EQ(device.isReady, false);
|
||||
clearResponseBuff();
|
||||
testData.millis += minTimeout;
|
||||
|
|
@ -199,12 +205,11 @@ TEST(RCDeviceTest, TestInitDeviceWithInvalidResponse)
|
|||
uint8_t incompleteResponseData[] = { 0xCC, 0x01, 0x37 };
|
||||
addResponseData(incompleteResponseData, sizeof(incompleteResponseData), true);
|
||||
runcamDeviceInit(&device);
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
testData.responseDataReadPos = 0;
|
||||
testData.indexOfCurrentRespBuf = 0;
|
||||
printf("call receiver func again2222\n");
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(device.isReady, false);
|
||||
clearResponseBuff();
|
||||
|
|
@ -216,12 +221,11 @@ TEST(RCDeviceTest, TestInitDeviceWithInvalidResponse)
|
|||
testData.isRunCamSplitPortConfigurated = true;
|
||||
testData.isAllowBufferReadWrite = true;
|
||||
runcamDeviceInit(&device);
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
testData.responseDataReadPos = 0;
|
||||
testData.indexOfCurrentRespBuf = 0;
|
||||
printf("call receiver func again3333\n");
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
EXPECT_EQ(device.isReady, false);
|
||||
clearResponseBuff();
|
||||
testData.millis += minTimeout;
|
||||
|
|
@ -241,11 +245,11 @@ TEST(RCDeviceTest, TestWifiModeChangeWithDeviceUnready)
|
|||
uint8_t responseData[] = { 0xCC, 0x01, 0x37, 0x00, 0xBC }; // wrong response
|
||||
addResponseData(responseData, sizeof(responseData), true);
|
||||
rcdeviceInit();
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
testData.responseDataReadPos = 0;
|
||||
testData.indexOfCurrentRespBuf = 0;
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(camDevice->isReady, false);
|
||||
|
||||
|
|
@ -299,13 +303,12 @@ TEST(RCDeviceTest, TestWifiModeChangeWithDeviceReady)
|
|||
addResponseData(responseData, sizeof(responseData), true);
|
||||
camDevice->info.features = 15;
|
||||
rcdeviceInit();
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
testData.responseDataReadPos = 0;
|
||||
testData.indexOfCurrentRespBuf = 0;
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
printf("pr222222otocol ver:%d\n", camDevice->info.features);
|
||||
EXPECT_EQ(camDevice->isReady, true);
|
||||
|
||||
// bind aux1, aux2, aux3 channel to wifi button, power button and change mode
|
||||
|
|
@ -358,11 +361,11 @@ TEST(RCDeviceTest, TestWifiModeChangeCombine)
|
|||
uint8_t responseData[] = { 0xCC, 0x01, 0x37, 0x00, 0xBD };
|
||||
addResponseData(responseData, sizeof(responseData), true);
|
||||
rcdeviceInit();
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
testData.responseDataReadPos = 0;
|
||||
testData.indexOfCurrentRespBuf = 0;
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(true, camDevice->isReady);
|
||||
|
||||
|
|
@ -440,22 +443,20 @@ TEST(RCDeviceTest, Test5KeyOSDCableSimulationProtocol)
|
|||
uint8_t responseData[] = { 0xCC, 0x01, 0x37, 0x00, 0xBD };
|
||||
addResponseData(responseData, sizeof(responseData), true);
|
||||
rcdeviceInit();
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
testData.responseDataReadPos = 0;
|
||||
testData.indexOfCurrentRespBuf = 0;
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(true, camDevice->isReady);
|
||||
clearResponseBuff();
|
||||
printf("pass init device\n");
|
||||
|
||||
// test timeout of open connection
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_CONNECTION_OPEN);
|
||||
printf("waiting open connection \n");
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += 3000;
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(false, rcdeviceInMenu);
|
||||
clearResponseBuff();
|
||||
|
|
@ -463,10 +464,8 @@ TEST(RCDeviceTest, Test5KeyOSDCableSimulationProtocol)
|
|||
// open connection with correct response
|
||||
uint8_t responseDataOfOpenConnection[] = { 0xCC, 0x11, 0xe7 };
|
||||
addResponseData(responseDataOfOpenConnection, sizeof(responseDataOfOpenConnection), true);
|
||||
printf("waiting open connection 222222\n");
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_CONNECTION_OPEN);
|
||||
printf("start to recei vdedata\n");
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(true, rcdeviceInMenu);
|
||||
clearResponseBuff();
|
||||
|
|
@ -475,7 +474,7 @@ TEST(RCDeviceTest, Test5KeyOSDCableSimulationProtocol)
|
|||
uint8_t incorrectResponseDataOfOpenConnection1[] = { 0xCC, 0x11, 0xe7, 0x55 };
|
||||
addResponseData(incorrectResponseDataOfOpenConnection1, sizeof(incorrectResponseDataOfOpenConnection1), true);
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_CONNECTION_OPEN);
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(true, rcdeviceInMenu);
|
||||
clearResponseBuff();
|
||||
|
|
@ -484,16 +483,16 @@ TEST(RCDeviceTest, Test5KeyOSDCableSimulationProtocol)
|
|||
uint8_t incorrectResponseDataOfOpenConnection2[] = { 0xCC, 0x10, 0x42 };
|
||||
addResponseData(incorrectResponseDataOfOpenConnection2, sizeof(incorrectResponseDataOfOpenConnection2), true);
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_CONNECTION_OPEN);
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(true, rcdeviceInMenu); // when crc wrong won't change the menu state
|
||||
clearResponseBuff();
|
||||
|
||||
// test timeout of close connection
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_CONNECTION_CLOSE);
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += 3000;
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(true, rcdeviceInMenu); // close menu timeout won't change the menu state
|
||||
clearResponseBuff();
|
||||
|
|
@ -502,7 +501,7 @@ TEST(RCDeviceTest, Test5KeyOSDCableSimulationProtocol)
|
|||
uint8_t responseDataOfCloseConnection[] = { 0xCC, 0x21, 0x11 };
|
||||
addResponseData(responseDataOfCloseConnection, sizeof(responseDataOfCloseConnection), true);
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_CONNECTION_CLOSE);
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(false, rcdeviceInMenu);
|
||||
clearResponseBuff();
|
||||
|
|
@ -510,8 +509,7 @@ TEST(RCDeviceTest, Test5KeyOSDCableSimulationProtocol)
|
|||
// close connection with correct response but wrong data length
|
||||
addResponseData(responseDataOfOpenConnection, sizeof(responseDataOfOpenConnection), true);
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_CONNECTION_OPEN); // open menu again
|
||||
printf("start to recei vdedata\n");
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(true, rcdeviceInMenu);
|
||||
clearResponseBuff();
|
||||
|
|
@ -519,7 +517,7 @@ TEST(RCDeviceTest, Test5KeyOSDCableSimulationProtocol)
|
|||
uint8_t responseDataOfCloseConnection1[] = { 0xCC, 0x21, 0x11, 0xC1 };
|
||||
addResponseData(responseDataOfCloseConnection1, sizeof(responseDataOfCloseConnection1), true);
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_CONNECTION_CLOSE);
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(false, rcdeviceInMenu);
|
||||
clearResponseBuff();
|
||||
|
|
@ -527,8 +525,7 @@ TEST(RCDeviceTest, Test5KeyOSDCableSimulationProtocol)
|
|||
// close connection with response that invalid crc
|
||||
addResponseData(responseDataOfOpenConnection, sizeof(responseDataOfOpenConnection), true);
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_CONNECTION_OPEN); // open menu again
|
||||
printf("start to recei vdedata\n");
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(true, rcdeviceInMenu);
|
||||
clearResponseBuff();
|
||||
|
|
@ -536,16 +533,24 @@ TEST(RCDeviceTest, Test5KeyOSDCableSimulationProtocol)
|
|||
uint8_t responseDataOfCloseConnection2[] = { 0xCC, 0x21, 0xA1 };
|
||||
addResponseData(responseDataOfCloseConnection2, sizeof(responseDataOfCloseConnection2), true);
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_CONNECTION_CLOSE);
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(true, rcdeviceInMenu);
|
||||
clearResponseBuff();
|
||||
|
||||
// release button first
|
||||
uint8_t responseDataOfSimulation4[] = { 0xCC, 0xA5 };
|
||||
addResponseData(responseDataOfSimulation4, sizeof(responseDataOfSimulation4), true);
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_RELEASE);
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(false, isButtonPressed);
|
||||
clearResponseBuff();
|
||||
|
||||
// simulate press button with no response
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_ENTER);
|
||||
rcdeviceReceive(millis());
|
||||
testData.millis += 2000;
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(false, isButtonPressed);
|
||||
clearResponseBuff();
|
||||
|
|
@ -554,16 +559,15 @@ TEST(RCDeviceTest, Test5KeyOSDCableSimulationProtocol)
|
|||
uint8_t responseDataOfSimulation1[] = { 0xCC, 0xA5 };
|
||||
addResponseData(responseDataOfSimulation1, sizeof(responseDataOfSimulation1), true);
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_ENTER);
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(true, isButtonPressed);
|
||||
clearResponseBuff();
|
||||
|
||||
// simulate press button with correct response but wrong data length
|
||||
uint8_t responseDataOfSimulation4[] = { 0xCC, 0xA5 };
|
||||
addResponseData(responseDataOfSimulation4, sizeof(responseDataOfSimulation4), true); // release first
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_RELEASE);
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(false, isButtonPressed);
|
||||
clearResponseBuff();
|
||||
|
|
@ -571,7 +575,7 @@ TEST(RCDeviceTest, Test5KeyOSDCableSimulationProtocol)
|
|||
uint8_t responseDataOfSimulation2[] = { 0xCC, 0xA5, 0x22 };
|
||||
addResponseData(responseDataOfSimulation2, sizeof(responseDataOfSimulation2), true);
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_ENTER);
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(true, isButtonPressed);
|
||||
clearResponseBuff();
|
||||
|
|
@ -580,16 +584,7 @@ TEST(RCDeviceTest, Test5KeyOSDCableSimulationProtocol)
|
|||
uint8_t responseDataOfSimulation3[] = { 0xCC, 0xB5, 0x22 };
|
||||
addResponseData(responseDataOfSimulation3, sizeof(responseDataOfSimulation3), true);
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_ENTER);
|
||||
rcdeviceReceive(millis());
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(true, isButtonPressed);
|
||||
clearResponseBuff();
|
||||
|
||||
// simulate release button event
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_RELEASE);
|
||||
rcdeviceReceive(millis());
|
||||
testData.millis += 1200;
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(true, isButtonPressed);
|
||||
clearResponseBuff();
|
||||
|
|
@ -597,7 +592,7 @@ TEST(RCDeviceTest, Test5KeyOSDCableSimulationProtocol)
|
|||
// simulate release button with correct response
|
||||
addResponseData(responseDataOfSimulation4, sizeof(responseDataOfSimulation4), true);
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_RELEASE);
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(false, isButtonPressed);
|
||||
clearResponseBuff();
|
||||
|
|
@ -605,7 +600,7 @@ TEST(RCDeviceTest, Test5KeyOSDCableSimulationProtocol)
|
|||
// simulate release button with correct response but wrong data length
|
||||
addResponseData(responseDataOfSimulation1, sizeof(responseDataOfSimulation1), true); // press first
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_ENTER);
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(true, isButtonPressed);
|
||||
clearResponseBuff();
|
||||
|
|
@ -613,7 +608,7 @@ TEST(RCDeviceTest, Test5KeyOSDCableSimulationProtocol)
|
|||
uint8_t responseDataOfSimulation5[] = { 0xCC, 0xA5, 0xFF };
|
||||
addResponseData(responseDataOfSimulation5, sizeof(responseDataOfSimulation5), true);
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_RELEASE);
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(false, isButtonPressed);
|
||||
clearResponseBuff();
|
||||
|
|
@ -622,7 +617,7 @@ TEST(RCDeviceTest, Test5KeyOSDCableSimulationProtocol)
|
|||
uint8_t responseDataOfSimulation6[] = { 0xCC, 0x31, 0xFF };
|
||||
addResponseData(responseDataOfSimulation6, sizeof(responseDataOfSimulation6), true);
|
||||
rcdeviceSend5KeyOSDCableSimualtionEvent(RCDEVICE_CAM_KEY_RELEASE);
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += minTimeout;
|
||||
EXPECT_EQ(false, isButtonPressed);
|
||||
clearResponseBuff();
|
||||
|
|
@ -647,11 +642,11 @@ TEST(RCDeviceTest, Test5KeyOSDCableSimulationWithout5KeyFeatureSupport)
|
|||
uint8_t responseData[] = { 0xCC, 0x01, 0x37, 0x00, 0xBD };
|
||||
addResponseData(responseData, sizeof(responseData), true);
|
||||
rcdeviceInit();
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += 200;
|
||||
testData.responseDataReadPos = 0;
|
||||
testData.indexOfCurrentRespBuf = 0;
|
||||
rcdeviceReceive(millis());
|
||||
rcdeviceReceive(millis() * 1000);
|
||||
testData.millis += 200;
|
||||
EXPECT_EQ(camDevice->isReady, true);
|
||||
clearResponseBuff();
|
||||
|
|
@ -722,19 +717,15 @@ extern "C" {
|
|||
uint8_t bufIndex = testData.indexOfCurrentRespBuf;
|
||||
uint8_t leftDataLen = 0;
|
||||
if (testData.responseDataReadPos + 1 > testData.responseBufsLen[bufIndex]) {
|
||||
printf("no data avaliable22\n");
|
||||
return 0;
|
||||
} else {
|
||||
printf("testData.responseBufsLen[bufIndex]:%d, testData.responseDataReadPos:%d\n", testData.responseBufsLen[bufIndex], testData.responseDataReadPos);
|
||||
leftDataLen = testData.responseBufsLen[bufIndex] - (testData.responseDataReadPos);
|
||||
}
|
||||
|
||||
if (leftDataLen) {
|
||||
printf("let data:%d\n", leftDataLen);
|
||||
return leftDataLen;
|
||||
}
|
||||
|
||||
printf("no data avaliable\n");
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
|
@ -860,8 +851,7 @@ extern "C" {
|
|||
{
|
||||
UNUSED(instance); UNUSED(data); UNUSED(count);
|
||||
|
||||
// // reset the input buffer
|
||||
printf("buffer reseted\n");
|
||||
// reset the input buffer
|
||||
testData.responseDataReadPos = 0;
|
||||
testData.indexOfCurrentRespBuf++;
|
||||
if (testData.indexOfCurrentRespBuf >= testData.responseBufCount) {
|
||||
|
|
|
|||
Loading…
Add table
Add a link
Reference in a new issue