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

lib/rc/ghst: Added differentiation between GHST and CRSF (#23805)

Browse Source
This commit is contained in:
Alexander Lerach
2024-10-11 16:17:54 -04:00
committed by GitHub
parent 9031f44eba
commit dbba9adb14
1 changed files with 3 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/rc/ghst.cpp
+3 -1
View File
@@ -69,6 +69,7 @@
#define GHST_FRAME_CRC_SIZE (1U)
#define GHST_FRAME_TYPE_SIZE (1U)
#define GHST_TYPE_DATA_CRC_SIZE (12U)
#define GHST_ADDR_FC (130U)
#define GHST_MAX_NUM_CHANNELS (16)
enum class ghst_parser_state_t : uint8_t {
@@ -251,7 +252,8 @@ static bool ghst_parse_buffer(uint16_t *values, int8_t *rssi, uint16_t *num_valu
if ((ghst_frame.type >= static_cast<uint8_t>(ghstFrameType::frameTypeFirst)) &&
(ghst_frame.type <= static_cast<uint8_t>(ghstFrameType::frameTypeLast)) &&
(ghst_frame.header.length == GHST_TYPE_DATA_CRC_SIZE)) {
(ghst_frame.header.length == GHST_TYPE_DATA_CRC_SIZE) &&
(ghst_frame.header.device_address == GHST_ADDR_FC)) {
const uint8_t crc = ghst_frame.payload[ghst_frame.header.length - 2U];
if (crc == ghst_frame_CRC(ghst_frame)) {