zhangjianhui/ESPC3-wireless
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

实现自动识别MSP或者MAVLINK，以及数据解析功能

Browse Source
This commit is contained in:
OPTOC
2025-09-02 14:20:56 +08:00
parent 9f79709f62
commit 2e5b3416a6
3 changed files with 13 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
app/CMakeLists.txt
View File

@@ -8,7 +8,8 @@ list(APPEND incs "drivers/data_port/usb-host")
list(APPEND incs "drivers/data_port/ble_spp") list(APPEND incs "drivers/data_port/ble_spp")
list(APPEND incs "drivers/data_port/socket_inet") list(APPEND incs "drivers/data_port/socket_inet")
list(APPEND incs "drivers/sertrf") list(APPEND incs "drivers/sertrf")
list(APPEND incs "drivers/sertrf/protocol")
list(APPEND incs "drivers/sertrf/protocol/mavlinkv2")
list(APPEND srcs "app_main.c") list(APPEND srcs "app_main.c")
list(APPEND srcs "app_info.c") list(APPEND srcs "app_info.c")
@@ -30,6 +31,9 @@ list(APPEND srcs "utils/sb_aes.c")
list(APPEND srcs "drivers/sertrf/sertrf.c") list(APPEND srcs "drivers/sertrf/sertrf.c")
list(APPEND srcs "drivers/sertrf/device.c") list(APPEND srcs "drivers/sertrf/device.c")
list(APPEND srcs "drivers/sertrf/key.c") list(APPEND srcs "drivers/sertrf/key.c")
list(APPEND srcs "drivers/sertrf/protocol/MSP.c")
list(APPEND srcs "drivers/sertrf/protocol/p_protocol.c")
list(APPEND srcs "drivers/sertrf/protocol/mavlink_control.c")
list(APPEND srcs "drivers/led_strip/led_strip.c") list(APPEND srcs "drivers/led_strip/led_strip.c")
list(APPEND srcs "drivers/led_strip/led_strip_encoder.c") list(APPEND srcs "drivers/led_strip/led_strip_encoder.c")

7
app/drivers/sertrf/sertrf.c
View File

@@ -10,6 +10,8 @@ void sertrf_init(void)
{ {
SYS_LOG_WRN("device init error"); SYS_LOG_WRN("device init error");
} }
// 协议初始化
Protocol_init(PORT_LINUX_SBDATA, sertrf.device.embedded_device);
//RGB灯 //RGB灯
work_rgb_led_start(); work_rgb_led_start();
//按键初始化 //按键初始化
@@ -33,8 +35,11 @@ void embedded_thread(void* arg)
uint32_t embedded_size = embedded_device_get_rx_length(&sertrf.device); uint32_t embedded_size = embedded_device_get_rx_length(&sertrf.device);
if(embedded_size > 0) if(embedded_size > 0)
{ {
uint8_t data[embedded_size]; uint8_t data[embedded_size ];
// data[embedded_size] = '\0';
embedded_device_read(&sertrf.device, data, embedded_size); embedded_device_read(&sertrf.device, data, embedded_size);
Protocol_buf_decode(data, embedded_size);
// SYS_LOG_INF("data : %s", data); // SYS_LOG_INF("data : %s", data);
pc_device_write(&sertrf.device, data, embedded_size); pc_device_write(&sertrf.device, data, embedded_size);
} }

2
app/drivers/sertrf/sertrf.h
View File

@@ -3,6 +3,8 @@
#include "device.h" #include "device.h"
#include "../led_strip/led_strip.h" #include "../led_strip/led_strip.h"
#include "key.h" #include "key.h"
#include "protocol/p_protocol.h"
typedef struct typedef struct
{ {
device_t device; device_t device;