MAVLink 消息处理指南
MAVLink 消息处理指南
本指南介绍项目中 MAVLink 消息的处理机制,包括消息接收、解析、转换和转发等核心功能。
MAVLink 协议简介
MAVLink 是一种轻量级的消息传输协议,广泛用于无人机和机器人系统。本项目使用 Rust 的 mavlink crate 来处理 MAVLink 消息,支持 ArduPilot 飞控的消息格式。
消息类型
核心消息类型
项目主要处理以下 MAVLink 消息类型:
- HEARTBEAT:心跳消息,用于保持连接和获取系统状态
- GLOBAL_POSITION_INT:全局位置信息,包括经纬度、高度和速度
- ATTITUDE:姿态信息,包括横滚、俯仰和偏航角
- MISSION_COUNT:航点数量消息
- MISSION_ITEM_INT:航点详细信息
- MISSION_REQUEST:航点请求消息
- MISSION_ACK:航点操作确认消息
- COMMAND_ACK:命令执行确认消息
消息接收
连接建立
系统通过以下方式建立与飞控的连接:
1
let conn_str = String::from("udpin:127.0.0.1:23445");
2
let conn = mavlink::connect::<MavMessage>(&conn_str).expect("连接失败");
接收循环
消息接收器运行在独立线程中,持续接收来自飞控的消息:
1
loop {
2
// 定期发送心跳
3
if last_heartbeat.elapsed() >= Duration::from_secs(1) {
4
if let Err(e) = conn.send_default(&heartbeat_message()) {
5
log::error!("心跳发送失败: {:?}", e);
6
}
7
last_heartbeat = std::time::Instant::now();
8
}
9
10
// 接收 MAVLink 消息
11
match conn.recv() {
12
Ok((header, msg)) => {
13
// 转发消息到主循环
14
if tx.blocking_send((header, msg.clone())).is_err() {
15
log::warn!("主通道已关闭,退出接收线程");
16
break;
17
}
18
消息处理
主循环处理
主循环接收来自 MAVLink 接收器的消息,并根据消息类型进行不同处理:
1
while let Some((header, msg)) = mavlink_rx.recv().await {
2
match msg {
3
MavMessage::MISSION_COUNT(cnt) => {
4
// 处理航点数量
5
expected_total = cnt.count;
6
waypoint_received.clear();
7
}
8
MavMessage::MISSION_ITEM_INT(item) => {
9
// 处理航点信息
10
let wp = Waypoint {
11
seq: item.seq,
12
lat: item.x as f64 / 1e7,
13
lon: item.y as f64 / 1e7,
14
alt: item.z,
15
};
16
waypoint_received.push(wp.clone());
17
}
18
MavMessage::MISSION_REQUEST(msg) => {
Actor 处理
MAVLink Actor 使用状态机模式处理消息,特别是航点相关的消息:
1
async fn handle_mavlink_message(&mut self, _header: MavHeader, msg: MavMessage) -> Result<()> {
2
match msg {
3
MavMessage::MISSION_COUNT(cnt) => {
4
self.state = match self.state {
5
MissionState::WaitingCount => {
6
if cnt.count == 0 {
7
MissionState::Idle
8
} else {
9
// 请求第一个航点
10
let req = MavMessage::MISSION_REQUEST_INT(MISSION_REQUEST_INT_DATA {
11
target_system: 1,
12
target_component: 1,
13
seq: 0,
14
});
15
if let Err(e) = self.vehicle.send_default(&req) {
16
log::error!("发送 MISSION_REQUEST_INT 失败: {}", e);
17
MissionState::Idle
18
} else {
消息转换
JSON 转换
系统将 MAVLink 消息转换为 JSON 格式,便于通过 MQTT 传输和前端处理:
1
async fn send_mqtt_data(
2
header: MavHeader,
3
msg: &MavMessage,
4
client: &AsyncClient,
5
topic: &str,
6
) -> Result<()> {
7
let payload = match msg {
8
MavMessage::HEARTBEAT(data) => {
9
let is_armed = data.base_mode.contains(MavModeFlag::MAV_MODE_FLAG_SAFETY_ARMED);
10
let arm_status = if is_armed { "解锁" } else { "加锁" };
11
12
json!({
13
"header": {
14
"system_id": header.system_id,
15
"component_id": header.component_id,
16
"sequence": header.sequence,
17
},
18
"message_type": "HEARTBEAT",
控制命令
加解锁控制
系统支持通过 MQTT 发送加解锁命令:
1
async fn handle_arm_disarm(&mut self, arm: bool) -> Result<()> {
2
log::info!("收到解锁/上锁命令: {}", arm);
3
let msg = MavMessage::COMMAND_LONG(COMMAND_LONG_DATA {
4
target_system: 1,
5
target_component: 1,
6
command: MAV_CMD_COMPONENT_ARM_DISARM,
7
confirmation: 1,
8
param1: if arm { 1.0 } else { 0.0 },
9
param2: 0.0,
10
param3: 0.0,
11
param4: 0.0,
12
param5: 0.0,
13
param6: 0.0,
14
param7: 0.0,
15
});
16
if let Err(e) = self.vehicle.send_default(&msg) {
17
log::error!("发送解锁/上锁命令失败: {}", e);
18
}
飞行模式切换
系统支持切换不同的飞行模式:
1
async fn handle_set_mode(&mut self, mode: String) -> Result<()> {
2
log::info!("收到模式切换命令: {}", mode);
3
let mode_value = match mode.as_str() {
4
"MANUAL" => RoverMode::ROVER_MODE_MANUAL as u16,
5
"ACRO" => RoverMode::ROVER_MODE_ACRO as u16,
6
"STEERING" => RoverMode::ROVER_MODE_STEERING as u16,
7
"HOLD" => RoverMode::ROVER_MODE_HOLD as u16,
8
"LOITER" => RoverMode::ROVER_MODE_LOITER as u16,
9
"FOLLOW" => RoverMode::ROVER_MODE_FOLLOW as u16,
10
"SIMPLE" => RoverMode::ROVER_MODE_SIMPLE as u16,
11
"DOCK" => RoverMode::ROVER_MODE_DOCK as u16,
12
"CIRCLE" => RoverMode::ROVER_MODE_CIRCLE as u16,
13
"AUTO" => RoverMode::ROVER_MODE_AUTO as u16,
14
"RTL" => RoverMode::ROVER_MODE_RTL as u16,
15
"SMART_RTL" => RoverMode::ROVER_MODE_SMART_RTL as u16,
16
"GUIDED" => RoverMode::ROVER_MODE_GUIDED as u16,
17
"INITIALISING" => RoverMode::ROVER_MODE_INITIALIZING as u16,
18
_ => {
航点管理
下载航点列表
系统支持从飞控下载航点列表:
- 发送 MISSION_REQUEST_LIST 请求
- 接收 MISSION_COUNT 消息获取航点总数
- 逐个请求航点(MISSION_REQUEST_INT)
- 接收航点信息(MISSION_ITEM_INT)
- 完成后更新状态为 Idle
上传航点列表
系统支持向飞控上传航点列表:
- 发送 MISSION_CLEAR_ALL 清除现有航点
- 发送 MISSION_COUNT 告知航点总数
- 接收 MISSION_REQUEST 请求
- 逐个发送航点(MISSION_ITEM_INT)
- 接收 MISSION_ACK 确认
心跳机制
系统定期发送心跳消息以保持与飞控的连接:
1
pub fn heartbeat_message() -> mavlink::ardupilotmega::MavMessage {
2
mavlink::ardupilotmega::MavMessage::HEARTBEAT(mavlink::ardupilotmega::HEARTBEAT_DATA {
3
custom_mode: 0,
4
mavtype: mavlink::ardupilotmega::MavType::MAV_TYPE_QUADROTOR,
5
autopilot: mavlink::ardupilotmega::MavAutopilot::MAV_AUTOPILOT_ARDUPILOTMEGA,
6
base_mode: mavlink::ardupilotmega::MavModeFlag::empty(),
7
system_status: mavlink::ardupilotmega::MavState::MAV_STATE_STANDBY,
8
mavlink_version: 0x3,
9
})
10
}
常见问题
1. 消息丢失
如果出现消息丢失,请检查:
- 网络连接是否稳定
- 消息通道缓冲区是否足够大
- 是否有处理瓶颈导致消息积压
2. 航点上传失败
如果航点上传失败,请检查:
- 航点数据格式是否正确
- 飞控是否处于可接受航点上传的状态
- 是否有其他任务正在进行
3. 心跳超时
如果出现心跳超时,请检查:
- 飞控是否正常运行
- 网络连接是否正常
- 心跳发送间隔是否合理
相关文章
查看同分类文章M3U8 下载助手油猴脚本 - 技术实现解析
M3U8下载助手技术解析 该油猴脚本通过注入拦截脚本实现对M3U8链接的全面捕获。核心架构包括: 请求拦截层:劫持XHR、fetch和WebSocket请求 DOM监听层:通过MutationObserver监控动态元素变化 跨域通信:iframe间使用postMessage传递数据 UI展示层:提供浮动按钮等交互界面 关键技术点: 使用document-start确保早期注入 通过保存原始方法实现API劫持 在send时而非open时检测URL 全面覆盖各种属性(src/href/data-src等) 脚
362 浏览
我做了一个局域网传文件的小工具,记录一下
本文记录了作者开发局域网文件传输工具的过程。起因是工作中遇到大文件传输不便的问题,作者选择用Rust语言开发,解决了WebSocket状态管理、大文件上传限制等技术难点。最终成品通过浏览器即可使用,支持文字聊天和文件传输,内存占用低。同事们试用后反馈良好,建议增加拖拽上传等功能。作者认为Rust虽开发较繁琐但运行高效稳定,并将项目开源供社区参与改进。
291 浏览
局域网聊天工具
这是一个基于Rust和Axum框架开发的局域网实时聊天工具,支持文本聊天、图片和文件分享功能。项目采用WebSocket实现实时通信,前端使用Tailwind CSS构建界面。主要功能包括实时消息传递、文件上传下载(限制100MB)、在线用户显示和消息历史记录。部署简单,只需Rust环境,通过Cargo编译运行即可启动服务。系统架构清晰,包含后端处理、前端界面和文件存储模块,适合局域网内团队协作使用。
350 浏览
彻底解决 Windows 下无法删除 nul 文件的问题
摘要:Windows系统下无法删除名为nul的文件,因为它是系统保留设备名。常见解决方法如\\.\路径可能失效,更可靠的方案是使用Git Bash的rm命令直接删除,或使用\\?\前缀的扩展路径。备选方案包括安全模式、PE系统或第三方工具。Git Bash方案操作简单成功率最高,\\?\路径是原生解决方案,建议根据实际情况选择最佳方法。
1312 浏览