feat: ELRS bind command support (#4907)
This commit is contained in:
@@ -20,7 +20,6 @@
|
||||
*/
|
||||
|
||||
#include "crossfire.h"
|
||||
|
||||
#include "opentx.h"
|
||||
|
||||
// clang-format off
|
||||
@@ -62,6 +61,8 @@ const CrossfireSensor crossfireSensors[] = {
|
||||
};
|
||||
// clang-format on
|
||||
|
||||
CrossfireModuleStatus crossfireModuleStatus[2] = {0};
|
||||
|
||||
const CrossfireSensor & getCrossfireSensor(uint8_t id, uint8_t subId)
|
||||
{
|
||||
if (id == LINK_ID)
|
||||
@@ -260,6 +261,18 @@ void processCrossfireTelemetryFrame(uint8_t module, uint8_t* rxBuffer,
|
||||
|
||||
#if defined(LUA)
|
||||
default:
|
||||
if (id == DEVICE_INFO_ID && rxBuffer[4]== MODULE_ADDRESS) {
|
||||
uint8_t nameSize = rxBuffer[1] - 18;
|
||||
strncpy((char *)&crossfireModuleStatus[module].name, (const char *)&rxBuffer[5], CRSF_NAME_MAXSIZE);
|
||||
crossfireModuleStatus[module].name[CRSF_NAME_MAXSIZE -1] = 0; // For some reason, GH din't like strlcpy
|
||||
if (strncmp((const char *) &rxBuffer[5 + nameSize], "ELRS", 4) == 0)
|
||||
crossfireModuleStatus[module].isELRS = true;
|
||||
crossfireModuleStatus[module].major = rxBuffer[14 + nameSize];
|
||||
crossfireModuleStatus[module].minor = rxBuffer[15 + nameSize];
|
||||
crossfireModuleStatus[module].revision = rxBuffer[16 + nameSize];
|
||||
crossfireModuleStatus[module].queryCompleted = true;
|
||||
}
|
||||
|
||||
if (luaInputTelemetryFifo && luaInputTelemetryFifo->hasSpace(rxBufferCount - 2)) {
|
||||
for (uint8_t i = 1; i < rxBufferCount - 1; i++) {
|
||||
// destination address and CRC are skipped
|
||||
|
||||
@@ -29,6 +29,7 @@
|
||||
#define BROADCAST_ADDRESS 0x00
|
||||
#define RADIO_ADDRESS 0xEA
|
||||
#define MODULE_ADDRESS 0xEE
|
||||
#define RECEIVER_ADDRESS 0xEC
|
||||
|
||||
// Frame id
|
||||
#define GPS_ID 0x02
|
||||
@@ -50,6 +51,9 @@
|
||||
#define UART_SYNC 0xC8
|
||||
#define SUBCOMMAND_CRSF 0x10
|
||||
#define COMMAND_MODEL_SELECT_ID 0x05
|
||||
#define SUBCOMMAND_CRSF_BIND 0x01
|
||||
|
||||
constexpr uint8_t CRSF_NAME_MAXSIZE = 16;
|
||||
|
||||
struct CrossfireSensor {
|
||||
const uint8_t id;
|
||||
@@ -100,6 +104,18 @@ enum CrossfireFrames{
|
||||
CRSF_FRAME_MODELID_SENT
|
||||
};
|
||||
|
||||
struct CrossfireModuleStatus
|
||||
{
|
||||
uint8_t major;
|
||||
uint8_t minor;
|
||||
uint8_t revision;
|
||||
char name[CRSF_NAME_MAXSIZE];
|
||||
bool queryCompleted;
|
||||
bool isELRS;
|
||||
};
|
||||
|
||||
extern CrossfireModuleStatus crossfireModuleStatus[2];
|
||||
|
||||
void processCrossfireTelemetryFrame(uint8_t module, uint8_t* rxBuffer,
|
||||
uint8_t rxBufferCount);
|
||||
void crossfireSetDefault(int index, uint8_t id, uint8_t subId);
|
||||
|
||||
Reference in New Issue
Block a user