fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-03 07:28:54 +08:00
Code Issues Packages Projects Releases Wiki Activity

protocol_splitter: update header length and payload length position

Browse Source 
To match the change on the microRTPS message header, which adds the sys ID as the 5th byte of the header
This commit is contained in:
TSC21
2021-08-12 08:44:53 +02:00
committed by Nuno Marques
parent ba3dbbd38d
commit 5a75277ff1
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/protocol_splitter/protocol_splitter.cpp
+2 -2
View File
@@ -672,7 +672,7 @@ public:
virtual ssize_t write(struct file *filp, const char *buffer, size_t buflen);
protected:
static const uint8_t HEADER_SIZE = 9;
static const uint8_t HEADER_SIZE = 10;
};
RtpsDev::RtpsDev(ReadBuffer *read_buffer)
@@ -741,7 +741,7 @@ ssize_t RtpsDev::write(struct file *filp, const char *buffer, size_t buflen)
return 0;
}
payload_len = ((uint16_t)buffer[5] << 8) | buffer[6];
payload_len = ((uint16_t)buffer[6] << 8) | buffer[7];
_packet_len = payload_len + HEADER_SIZE;
_parser_state = ParserState::GotLength;
lock(Write);