default··约 19 分钟读完·304 次观看

MAVLink 消息处理指南

MAVLink消息处理系统摘要 本系统实现了一套完整的MAVLink消息处理机制,用于无人机通信与控制。核心功能包括: 消息接收:通过UDP连接持续接收飞控消息,支持心跳维持机制 消息处理:分类处理多种MAVLink消息类型,包括心跳、位置、姿态和航点相关消息 航点管理:实现航点下载状态机,支持分片请求和接收航点数据 消息转发:将处理后的消息通过MQTT发布到指定主题 系统采用多线程架构,包含独立的消息接收线程和主处理循环,通过通道进行线程间通信。关键特性包括航点下载状态机、错误处理和日志记录机制,确保通信
rustmavlink

MAVLink 消息处理指南

本指南介绍项目中 MAVLink 消息的处理机制,包括消息接收、解析、转换和转发等核心功能。

MAVLink 是一种轻量级的消息传输协议,广泛用于无人机和机器人系统。本项目使用 Rust 的 mavlink crate 来处理 MAVLink 消息,支持 ArduPilot 飞控的消息格式。

消息类型

核心消息类型

项目主要处理以下 MAVLink 消息类型:

  1. HEARTBEAT:心跳消息,用于保持连接和获取系统状态
  2. GLOBAL_POSITION_INT:全局位置信息,包括经纬度、高度和速度
  3. ATTITUDE:姿态信息,包括横滚、俯仰和偏航角
  4. MISSION_COUNT:航点数量消息
  5. MISSION_ITEM_INT:航点详细信息
  6. MISSION_REQUEST:航点请求消息
  7. MISSION_ACK:航点操作确认消息
  8. COMMAND_ACK:命令执行确认消息

消息接收

连接建立

系统通过以下方式建立与飞控的连接:

rust
      
        
          1
          
          let conn_str = String::from("udpin:127.0.0.1:23445");
        
          2
          
          let conn = mavlink::connect::<MavMessage>(&conn_str).expect("连接失败");
        
      
    

接收循环

消息接收器运行在独立线程中,持续接收来自飞控的消息:

rust
      
        
          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 接收器的消息,并根据消息类型进行不同处理:

rust
      
        
          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 使用状态机模式处理消息,特别是航点相关的消息:

rust
      
        
          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 传输和前端处理:

rust
      
        
          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 发送加解锁命令:

rust
      
        
          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
          
              }
        
      
    

飞行模式切换

系统支持切换不同的飞行模式:

rust
      
        
          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
          
                  _ => {
        
      
    

航点管理

下载航点列表

系统支持从飞控下载航点列表:

  1. 发送 MISSION_REQUEST_LIST 请求
  2. 接收 MISSION_COUNT 消息获取航点总数
  3. 逐个请求航点(MISSION_REQUEST_INT)
  4. 接收航点信息(MISSION_ITEM_INT)
  5. 完成后更新状态为 Idle

上传航点列表

系统支持向飞控上传航点列表:

  1. 发送 MISSION_CLEAR_ALL 清除现有航点
  2. 发送 MISSION_COUNT 告知航点总数
  3. 接收 MISSION_REQUEST 请求
  4. 逐个发送航点(MISSION_ITEM_INT)
  5. 接收 MISSION_ACK 确认

心跳机制

系统定期发送心跳消息以保持与飞控的连接:

rust
      
        
          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 浏览

这篇文章对你有帮助吗?