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

Optimized the buffer full solution

Browse source
This commit is contained in:
ligenxxxx 2020-12-18 11:06:47 +08:00
parent fbfbf189c1
commit abc9f868b1
1 changed files with 6 additions and 6 deletions
Download patch file Download diff file Expand all files Collapse all files

12
src/main/msp/msp_serial.c
View file

@ -40,6 +40,8 @@
#include "msp_serial.h" #include "msp_serial.h"
#include "drivers/time.h"
static mspPort_t mspPorts[MAX_MSP_PORT_COUNT]; static mspPort_t mspPorts[MAX_MSP_PORT_COUNT];
static void resetMspPort(mspPort_t *mspPortToReset, serialPort_t *serialPort, bool sharedWithTelemetry) static void resetMspPort(mspPort_t *mspPortToReset, serialPort_t *serialPort, bool sharedWithTelemetry)
@ -289,8 +291,10 @@ static int mspSerialSendFrame(mspPort_t *msp, const uint8_t * hdr, int hdrLen, c
// this allows us to transmit jumbo frames bigger than TX buffer (serialWriteBuf will block, but for jumbo frames we don't care) // this allows us to transmit jumbo frames bigger than TX buffer (serialWriteBuf will block, but for jumbo frames we don't care)
// b) Response fits into TX buffer // b) Response fits into TX buffer
const int totalFrameLength = hdrLen + dataLen + crcLen; const int totalFrameLength = hdrLen + dataLen + crcLen;
const int perByteCostUs = (1000000 / (msp->port->baudRate / 10));
if (!isSerialTransmitBufferEmpty(msp->port) && ((int)serialTxBytesFree(msp->port) < totalFrameLength)) { if (!isSerialTransmitBufferEmpty(msp->port) && ((int)serialTxBytesFree(msp->port) < totalFrameLength)) {
return 0; //Currently TxBuffer free space is not enough, Wait for TxBuffer empty
delayMicroseconds((int)serialTxBytesFree(msp->port) * perByteCostUs);
} }
// Transmit frame // Transmit frame
@ -312,7 +316,6 @@ static int mspSerialEncode(mspPort_t *msp, mspPacket_t *packet, mspVersion_e msp
uint8_t checksum; uint8_t checksum;
int hdrLen = 3; int hdrLen = 3;
int crcLen = 0; int crcLen = 0;
int ret = 0;
#define V1_CHECKSUM_STARTPOS 3 #define V1_CHECKSUM_STARTPOS 3
if (mspVersion == MSP_V1) { if (mspVersion == MSP_V1) {
@ -389,10 +392,7 @@ static int mspSerialEncode(mspPort_t *msp, mspPacket_t *packet, mspVersion_e msp
} }
// Send the frame // Send the frame
// If it fails, resend until success return mspSerialSendFrame(msp, hdrBuf, hdrLen, sbufPtr(&packet->buf), dataLen, crcBuf, crcLen);
while (ret==0)
ret = mspSerialSendFrame(msp, hdrBuf, hdrLen, sbufPtr(&packet->buf), dataLen, crcBuf, crcLen);
return ret;
} }
static mspPostProcessFnPtr mspSerialProcessReceivedCommand(mspPort_t *msp, mspProcessCommandFnPtr mspProcessCommandFn) static mspPostProcessFnPtr mspSerialProcessReceivedCommand(mspPort_t *msp, mspProcessCommandFnPtr mspProcessCommandFn)