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

Add protocol level receiver frame rate measurement for IBUS

This commit is contained in:
Bruce Luckcuck 2019-11-21 15:35:13 -05:00
parent 05418297b2
commit 92771b666f
2 changed files with 16 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

17
src/main/rx/ibus.c
View File

@ -75,7 +75,7 @@ static bool ibusFrameDone = false;
static uint32_t ibusChannelData[IBUS_MAX_CHANNEL];
static uint8_t ibus[IBUS_BUFFSIZE] = { 0, };
static timeDelta_t lastFrameDelta = 0;
static bool isValidIa6bIbusPacketLength(uint8_t length)
{
@ -88,13 +88,13 @@ static void ibusDataReceive(uint16_t c, void *data)
{
UNUSED(data);
uint32_t ibusTime;
static uint32_t ibusTimeLast;
static timeUs_t ibusTimeLast;
static uint8_t ibusFramePosition;
static timeUs_t lastFrameCompleteTimeUs = 0;
ibusTime = micros();
const timeUs_t ibusTime = microsISR();
if ((ibusTime - ibusTimeLast) > IBUS_FRAME_GAP) {
if (cmpTimeUs(ibusTime, ibusTimeLast) > IBUS_FRAME_GAP) {
ibusFramePosition = 0;
rxBytesToIgnore = 0;
} else if (rxBytesToIgnore) {
@ -125,6 +125,8 @@ static void ibusDataReceive(uint16_t c, void *data)
ibus[ibusFramePosition] = (uint8_t)c;
if (ibusFramePosition == ibusFrameSize - 1) {
lastFrameDelta = cmpTimeUs(ibusTime, lastFrameCompleteTimeUs);
lastFrameCompleteTimeUs = ibusTime;
ibusFrameDone = true;
} else {
ibusFramePosition++;
@ -202,6 +204,10 @@ static uint16_t ibusReadRawRC(const rxRuntimeState_t *rxRuntimeState, uint8_t ch
return ibusChannelData[chan];
}
static timeDelta_t ibusFrameDelta(void)
{
return lastFrameDelta;
}
bool ibusInit(const rxConfig_t *rxConfig, rxRuntimeState_t *rxRuntimeState)
{
@ -213,6 +219,7 @@ bool ibusInit(const rxConfig_t *rxConfig, rxRuntimeState_t *rxRuntimeState)
rxRuntimeState->rcReadRawFn = ibusReadRawRC;
rxRuntimeState->rcFrameStatusFn = ibusFrameStatus;
rxRuntimeState->rcFrameDeltaFn = ibusFrameDelta;
const serialPortConfig_t *portConfig = findSerialPortConfig(FUNCTION_RX_SERIAL);
if (!portConfig) {

4
src/test/unit/rx_ibus_unittest.cc
View File

@ -67,6 +67,10 @@ uint32_t micros(void)
{
return microseconds_stub_value;
}
uint32_t microsISR(void)
{
return micros();
}
#define SERIAL_BUFFER_SIZE 256
#define SERIAL_PORT_DUMMY_IDENTIFIER (serialPortIdentifier_e)0x1234