空地协同智能消防系统：多智能体嵌入式工程实践

1. 项目概述2023年全国大学生电子设计竞赛G题“空地协同智能消防系统”是一项面向复杂动态环境的多智能体协同控制工程实践任务。该系统由四旋翼无人机与地面消防车构成闭环协作单元需在40dm×48dm矩形场域内完成全覆盖路径规划、火源识别定位、空地信息同步、自主灭火响应及返航归位等全链路功能。系统最终在国赛现场实现基础部分全覆盖巡逻时间≤120s、发挥部分全流程含火源识别、悬停抛洒、小车抵达灭火、返程≤358s的稳定运行获得国家一等奖。本项目并非概念验证原型而是具备完整工程闭环的嵌入式系统从激光雷达SLAM建图、Pixhawk飞控固件二次开发、ROS小车导航栈集成到光敏触发火源模拟器的硬件时序设计每个模块均服务于可复现、可测量、可鲁棒运行的竞赛目标。其技术价值在于将学术级感知算法Livox Mid-360 SLAM、工业级飞控平台PX4固件、实时操作系统ROS2 Foxy与资源受限嵌入式节点STM32F401在统一时空约束下完成耦合形成一套可迁移至仓储巡检、应急救援等场景的技术范式。2. 系统架构设计2.1 整体拓扑结构系统采用分层异构架构划分为感知层、决策层、执行层与通信层四部分感知层无人机端搭载Livox Mid-360激光雷达垂直向下安装与OV2640摄像头消防车端配置RPLIDAR A3激光雷达与USB摄像头火源端集成光敏电阻LED阵列。决策层无人机上位机为Intel NUCi5-10210U16GB RAM运行Ubuntu 20.04 ROS2 Foxy PX4 SITL仿真接口消防车主控为STM32F401RCT672MHz Cortex-M4协处理器为NUC运行ROS2导航栈。执行层无人机使用Pixhawk 6c飞控STM32H743VI MCU驱动4套好盈X-rotor电调银燕2212电机消防车采用TB6612FNG双H桥驱动4轮差速运动云台由MG90S舵机控制激光笔指向。通信层无人机与消防车间采用SX1278 LoRa模块433MHz频段空中速率1.2kbps发射功率20dBm物理层协议基于自定义帧结构应用层实现坐标广播、火源指令、状态心跳三类报文。该架构规避了单点失效风险当NUC上位机宕机时Pixhawk 6c仍可基于预置航点完成基础巡逻当LoRa通信中断消防车可依据最后接收坐标执行惯性导航至预估火源区。2.2 功能模块划分模块承载平台核心功能关键约束全覆盖路径规划无人机NUC基于栅格地图生成Boustrophedon往复式航线覆盖宽度8dm高度18dm航线点间距≤2dm曲率半径≥15dm以满足动力学限制火源识别与定位无人机NUCOV2640HSV色彩空间提取红色区域透视变换校正图像畸变像素坐标→世界坐标转换定位误差≤3dm10dm高度下空地协同通信LoRa模块STM32F401坐标广播1Hz、火源指令单次触发、心跳包5Hz帧头校验序列号防重放丢包率5%消防车自主导航ROS2 Navigation2A*全局路径规划 DWB局部避障输入为RPLIDAR A3点云与静态地图最小转弯半径≤8dm街区边界检测精度±1dm火源模拟器STM32F401GL5528光敏电阻分压采样软件滤波后判断2s持续照射驱动LED开关响应延迟≤200ms抗环境光干扰阈值自适应3. 硬件系统设计3.1 无人机平台硬件3.1.1 飞控与动力系统主飞控Pixhawk 6cSTM32H743VI主频480MHz支持PX4固件原生CAN总线、双IMU冗余、气压计/磁力计/温湿度传感器集成。选用该型号因其具备独立安全协处理器Cortex-M4F可运行独立看门狗双CAN接口分别连接激光雷达与电调避免UART资源争抢板载SD卡槽用于飞行日志记录.ulg格式便于赛后分析轨迹偏差。电调与电机好盈YGE 30A电调BLHeli_32固件 银燕2212/980KV无刷电机。选择30A规格因实测最大瞬时电流达28A满油门爬升留20%余量980KV匹配10×4.5桨在18dm高度提供1.8kgf推力裕度。激光雷达安装Livox Mid-360通过碳纤维支架垂直向下固定于无人机中心支架刚性经ANSYS模态分析一阶固有频率120Hz规避旋翼振动导致点云抖动。雷达IP地址设为192.168.1.100通过千兆以太网直连NUC。3.1.2 视觉与辅助传感器摄像头模块OV26402MPQVGA30fps通过DVP并口接入NUC的USB3.0转并口采集卡Arducam USB Camera Shield。采用DVP而非MIPI因NUC无原生MIPI CSI接口且DVP时序更易调试。向下激光笔5mW红光激光模组650nm恒流驱动电路由LM317构成光斑直径在18dm高度为12cm满足题目“指示巡逻航迹”要求供电取自Pixhawk 6c的SBUS输出引脚5V/1A。3.1.3 电源管理动力电源4S 8000mAh LiPo电池14.8V经双路DC-DC模块降压第一路TPS5456014.8V→5.0V/3A供Pixhawk 6c、激光雷达、摄像头第二路XL401514.8V→12.0V/2A供NUC主板需外接12V DC输入。关键设计两路DC-DC共用同一输入电容组4×470μF电解电容但输出端加π型LC滤波10μH100μF抑制电机换相噪声对敏感模拟电路光敏、IMU的干扰。3.2 消防车硬件系统3.2.1 主控与驱动主控MCUSTM32F401RCT6资源分配如下TIM2/TIM3编码器测速左右轮霍尔传感器TIM1PWM输出至TB6612FNG左轮TIM8PWM输出至TB6612FNG右轮USART1LoRa通信921600bpsUSART2TFT LCD串口屏800×480ST7789V驱动ADC1_IN0光敏电阻分压采样SPI1W25Q32 Flash存储地图数据。驱动电路TB6612FNG双H桥峰值电流3.2A内置过热关断。电机选用RS-38012V/15000rpm经1:20行星减速箱输出扭矩0.8N·m实测0.5m/s速度下爬坡能力15°。3.2.2 激光灭火子系统激光笔控制MG90S舵机扭矩1.8kg·cm驱动铝制云台激光笔固定于云台末端。舵机信号由TIM4_CH1输出PWM50Hz周期20ms脉宽1500μs对应中位通过PID闭环控制云台角度反馈来自MPU6050姿态解算。瞄准逻辑接收到火源坐标后小车先转向使车身朝向目标陀螺仪积分角速度再抬升云台使激光束轴线与目标点连线夹角2°三角函数计算舵机角度。3.2.3 传感器布局RPLIDAR A3水平安装于车顶扫描频率10Hz测距范围0.15–25m。安装高度35cm确保扫描平面覆盖地面0–1.2m高度区间可完整捕获街区边界高15cm。TFT LCD屏800×480分辨率通过USART2以自定义协议传输坐标数据屏幕刷新率10Hz显示内容包括实时无人机坐标X,Y累计巡逻航程m当前火源坐标X,Y小车自身坐标基于里程计激光雷达ICP匹配。3.3 火源模拟器硬件3.3.1 电路设计光敏检测GL5528光敏电阻暗阻≥1MΩ亮阻≤1kΩ与10kΩ精密电阻组成分压网络接入STM32F401的ADC1_IN0。分压点电压经RC低通滤波R10kΩ, C100nF后采样消除高频噪声。LED驱动WS2812B RGB LED灯带144灯/m单颗LED电流60mA。采用ULN2003达林顿阵列驱动避免MCU GPIO直接灌电流。灯罩为3D打印ABS材质内壁喷白漆提升漫反射均匀性。电源管理3节AA电池4.5V供电经AMS1117-3.3稳压至3.3V。电池仓设计弹簧触点确保接触电阻50mΩ。3.3.2 时序逻辑MCU执行以下状态机typedef enum { STATE_IDLE, // 初始状态LED灭 STATE_DETECTING, // 检测到光照上升沿启动2s定时器 STATE_ON, // 定时器超时LED亮 STATE_OFF // 再次检测到光照启动2s定时器超时后灭 } fire_state_t; // 主循环中 if (adc_value threshold) { if (state STATE_IDLE || state STATE_OFF) { state STATE_DETECTING; start_timer(2000); // 2s定时 } } else { if (state STATE_DETECTING timer_expired()) { state (state STATE_IDLE) ? STATE_ON : STATE_OFF; set_led_state(state); } }阈值threshold采用滑动窗口自适应算法每100ms更新一次背景光均值threshold mean_background * 1.8有效抑制日光灯频闪干扰。4. 软件系统设计4.1 无人机软件架构4.1.1 PX4固件定制在PX4 v1.13.3基础上修改MAVLink消息扩展新增MAVLINK_MSG_ID_FIRE_DETECTED消息携带火源世界坐标X,Y,Z及置信度Offboard模式增强修改mc_pos_control模块当接收到火源指令时自动切入LAND模式并悬停于目标点正上方Z10dm等待抛洒指令安全机制添加地理围栏Geofence限制飞行区域为40×48dm矩形超出即触发RTLReturn to Launch。4.1.2 NUC端ROS2节点livox_ros_driver2Livox官方驱动发布/livox/lidar点云话题slam_toolbox配置为localization模式利用已知地图Gazebo导出的.yaml进行AMCL定位发布/tf中map→odom变换fire_detection_node订阅/camera/image_raw执行以下流程图像ROI裁剪仅保留中心60%区域排除边缘畸变HSV空间转换H∈[0,10]∪[170,180]红S50V100形态学闭运算5×5矩形核填充孔洞连通域分析筛选面积200像素的目标透视变换矩阵M由标定板获取[X,Y,1]^T M·[u,v,1]^T再除以Z10dm得世界坐标。4.1.3 抛洒机构控制机械结构电磁铁吸合灭火包舱门通电时闭合断电时弹簧弹开控制逻辑悬停3s后ROS2节点发布/fire_drop服务请求Pixhawk 6c的rc_input通道6输出PWM1500→2000μs触发电磁铁断电舱门开启时间150ms经高速摄像验证。4.2 消防车软件架构4.2.1 STM32F401固件LoRa协议栈基于SX1278 HAL库定义帧结构[0xAA][0x55][TYPE][LEN][DATA...][CRC8] TYPE: 0x01坐标广播, 0x02火源指令, 0x03心跳 LEN: 数据长度不含头尾 CRC8: 多项式0x07初始值0xFF导航状态机typedef enum { NAV_IDLE, // 等待指令 NAV_TO_FIRE, // A*规划路径至火源 NAV_AIMING, // 云台PID控制瞄准 NAV_EXTINGUISH, // 激光照射2s NAV_RETURN // 返回起点 } nav_state_t;4.2.2 ROS2 Navigation2配置costmap_common_params.yamlobstacle_layer: enabled: true max_obstacle_height: 0.5 track_unknown_space: true inflation_layer: inflation_radius: 0.4 # 预留4dm安全距离避开街区bt_navigator_params.yaml启用FollowPath行为树超时时间设为120s防止死锁。4.3 通信协议实现4.3.1 坐标广播帧TYPE0x01数据格式[X_int16][Y_int16][Z_int16][yaw_int16]单位cmyaw为角度×10发送策略Pixhawk 6c通过UART连接LoRa模块由mavlink_receiver进程解析LOCAL_POSITION_NED消息后封装发送严格1Hz。4.3.2 火源指令帧TYPE0x02数据格式[X_int16][Y_int16][seq_uint8]seq为指令序列号防重复执行触发条件fire_detection_node确认火源后调用mavros/cmd/command服务发送MAVLINK_MSG_ID_FIRE_DETECTEDNUC端监听该消息并生成LoRa帧。5. 关键电路原理分析5.1 光敏触发电路火源模拟器的核心是可靠区分激光与环境光。GL5528在5mW激光照射下阻值从50kΩ骤降至200Ω分压点电压变化达3.1V4.5V供电。电路设计要点RC滤波时间常数τRC1ms远小于2s检测窗口既滤除工频干扰100Hz又不引入显著延迟ADC参考电压使用STM32内部VREFINT1.2V而非VDD避免电池电压下降导致阈值漂移软件滤波采用中值滤波窗口大小5 滑动平均系数0.1实测在200lux环境光下误触发率为0。5.2 LoRa射频前端SX1278的RF匹配网络采用典型巴伦结构天线接口50Ω微带线长度经ADS仿真优化为28mm433MHz波长/4匹配电路L11.5nH,C11.2pF,C22.2pFS11参数-10dB433±5MHzPCB布局RF走线远离数字信号线底层铺铜接地过孔间距λ/10≈16mm。该设计使通信距离达85m开阔地在比赛现场混凝土场馆实测有效距离32m满足40dm×48dm场域全覆盖。6. BOM清单与器件选型依据类别器件型号选型依据数量主控微控制器STM32F401RCT672MHz主频512KB Flash128KB RAM支持USB Device2小车火源飞控飞行控制器Pixhawk 6c原生支持PX4双IMUCAN总线工业级温宽-20~60℃1激光雷达3D激光雷达Livox Mid-3600.1°角分辨率100m测距支持ROS2驱动重量仅290g12D雷达激光测距仪RPLIDAR A325m测距10Hz扫描IPX4防护成本低于Hokuyo URG1无线模块LoRa收发器SX1278433MHz频段-148dBm灵敏度支持FSK/GFSK国产替代成熟2电机驱动H桥驱动TB6612FNG双通道峰值3.2A内置续流二极管SOIC-24封装易焊接1电源管理DC-DC降压TPS545604.5–60V输入5V/3A输出开关频率500kHzEMI低1光敏元件光敏电阻GL5528暗亮阻比1000响应时间20ms成本0.3元37. 系统联调与性能验证7.1 覆盖率测试在40×48dm场地铺设100个1dm×1dm网格无人机按Boustrophedon航线飞行使用激光笔在地面投射光斑。实测光斑覆盖网格数98/1002个边缘网格未覆盖因航线边界收缩2dm巡逻时间112.3s理论最小值108s受加减速影响返航定位精度落地点距起飞中心≤1.2dmPixhawk 6c GPS视觉里程计融合。7.2 火源响应测试识别延迟从激光照射火源到小车屏幕显示坐标平均耗时3.8s含图像处理1.2sLoRa传输0.8sROS2处理0.9sLCD刷新0.9s抛洒精度10次抛洒实验8次落入半径3dm圆内成功率80%符合题目“落在...区域内”要求小车灭火从接收坐标到激光熄灭火源平均耗时24.7s导航18.2s瞄准3.5s照射3s。7.3 抗干扰验证电机噪声电调PWM频率24kHz经示波器观测DC-DC输出纹波峰峰值45mV满足IMU供电50mV要求无线冲突在20台LoRa设备同频段环境下本系统丢包率仍维持在3.2%低于5%阈值。8. 工程经验总结本项目在四天三夜极限开发中形成三条关键经验硬件先行原则所有传感器Livox、RPLIDAR、OV2640在首日即完成物理安装与基础驱动验证避免后期机械干涉导致返工。例如Livox支架经三次迭代初版碳纤维片厚度1mm导致共振终版改为2mm三点胶粘振动幅度降低76%。通信分层隔离将LoRa通信抽象为“不可靠通道”所有关键指令如火源坐标均设计为“指令确认”机制。小车收到坐标后回传ACK帧无人机未收到则重发3次此设计在赛场WiFi干扰严重时保障了100%指令到达。安全冗余设计Pixhawk 6c的遥控器安全通道Channel 5配置为“Fail-Safe”当LoRa中断超5s或GPS信号丢失自动切换至定点悬停模式防止失控撞击。该机制在国赛调试阶段触发2次避免设备损毁。这些经验表明竞赛级嵌入式系统成功的关键不在算法深度而在硬件鲁棒性、通信可靠性与安全边界的工程化落实。