KSat/fsfw
19
6
Fork 0
forked from fsfw/fsfw
Code Issues Pull Requests Releases Wiki Activity

debugged and tested non-escaped encoder

Browse Source
This commit is contained in:
Robin Müller
2021-09-09 01:28:21 +02:00
parent 35b53e9a17
commit d05eb23ea7
2 changed files with 34 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files

9
src/fsfw/globalfunctions/DleEncoder.cpp
View File

@ -19,10 +19,11 @@ ReturnValue_t DleEncoder::encode(const uint8_t* sourceStream,
return STREAM_TOO_SHORT;
}
if (addStxEtx) {
size_t currentIdx = 0;
if(not escapeStxEtx) {
destStream[0] = DLE_CHAR;
destStream[currentIdx++] = DLE_CHAR;
}
destStream[1] = STX_CHAR;
destStream[currentIdx] = STX_CHAR;
}
if(escapeStxEtx) {
@ -122,8 +123,8 @@ ReturnValue_t DleEncoder::encodeStreamNonEscaped(const uint8_t *sourceStream, si
if (sourceIndex == sourceLen and encodedIndex < maxDestLen) {
if (addStxEtx) {
destStream[encodedIndex] = ETX_CHAR;
++encodedIndex;
destStream[encodedIndex++] = DLE_CHAR;
destStream[encodedIndex++] = ETX_CHAR;
}
*encodedLen = encodedIndex;
return RETURN_OK;