1. 无人机与地面车辆协同系统概述
在复杂环境下的巡检任务中，无人机(UAV)和无人地面车辆(UGV)各自存在明显的局限性。无人机虽然具有空中机动优势，但受限于电池容量，通常只能维持20-30分钟的飞行时间；而地面车辆虽然续航能力强，却难以应对高空或复杂地形。将两者结合的"母子式"(marsupial)系统通过物理连接(通常是供电/通信线缆)实现优势互补，正在成为工业检测、灾害救援等领域的研究热点。
我们开发的这套系统核心创新点在于：
- 采用移动式UGV作为供电基站，通过特制线缆为UAV持续供电
- 专门设计的非线性轨迹优化算法，同时考虑线缆长度约束和障碍物避碰
- 分布式但同步的运动控制架构，确保两个平台协调运动
- 针对GNSS缺失环境优化的定位方案(DLL方法)
在实际建筑结构检测实验中，系统实现了超过2小时的连续飞行作业，检测精度达到厘米级。相比传统无人机方案，作业时间延长了4-6倍；相比固定式系留无人机，工作范围扩大了3-5倍。
关键设计选择：采用1N张力的特制轻量化线缆，在保证供电可靠性的同时，仅使无人机悬停功耗增加2.5%。实测四旋翼无人机(总重约4kg)在该配置下稳定性良好。
2. 系统硬件架构设计
2.1 供电与动力子系统
供电系统采用双冗余设计：
- UGV主电源：48V/20Ah锂铁磷酸电池组(LiFePO4)，通过DC-DC转换器输出24V为线缆收放系统(LTS4)供电
- UAV备用电池：6S/10000mAh锂聚合物电池，在系留系统故障时提供应急电力
实测数据表明：
- 满电状态下UGV可支持系统连续工作超过3小时
- 线缆传输效率达92%，功率损耗主要来自阻抗发热
- 备用电池在正常工况下基本不放电，始终保持80%以上电量
2.2 传感与计算单元
UGV配置：
- 感知：Velodyne Puck LITE 16线激光雷达
- 计算：Intel NUC11TNKi5工控机(12核/16GB RAM)
- 定位：轮式编码器+IMU+激光SLAM融合
UAV配置：
- 感知：Ouster OS1-64激光雷达+全局快门相机
- 计算：同型号NUC工控机
- 专用：线缆张力传感器(精度±0.1N)
双机通过千兆以太网连接，采用时间同步协议(PTCP)确保控制指令同步，时延控制在20ms以内。
3. 轨迹规划算法实现
3.1 问题建模与约束处理
轨迹规划被建模为带约束的非线性优化问题，目标函数包含：
- 轨迹平滑度项(最小化加加速度)
- 执行时间项(最短时间优化)
- 安全距离项(远离障碍物)
关键约束条件：
线缆长度约束(公式3)：
δᵤ = { e^(dᵤ-L_max) -1, if dᵤ > L_max 0, otherwise其中dᵤ为UGV与UAV间距离，L_max为线缆最大长度
障碍物避碰约束(公式4)：
δₒₜ = Σ(ρⱼ/dₒₜ,ⱼ) ρⱼ = { 1, if dₒₜ,ⱼ > ρₒₜ β, otherwise (β>>1)通过对线缆路径采样(m=20个点)，计算各点与最近障碍物的距离dₒₜ,ⱼ
3.2 优化求解与实时性优化
采用Ceres Solver实现优化计算，通过以下技巧提升实时性：
- 雅可比矩阵解析推导(比数值差分快3倍)
- 多线程并行(8线程利用率达90%)
- 热启动策略(以上次解作为初始值)
在i5-1135G7处理器上，单次轨迹规划耗时约0.5秒，比对比方法[28]快6倍。典型轨迹生成结果如图10所示，其中：
- 黑色线/蓝点：UAV路径/轨迹
- 白色线/绿点：UGV路径/轨迹
- 红点：优化后的线缆形态
4. 运动控制实现细节
4.1 分布式跟踪架构
系统采用分层控制策略：
- 底层：各平台独立的PID控制器
- UAV：位置+高度+偏航三环控制
- UGV：平面轨迹跟踪
- 协调层：TCM(轨迹协调模块)
- 基于时间戳的指令同步
- 速度匹配(取两者较小值)
- 异常检测(张力突变、定位丢失等)
实验设置最大速度为0.25m/s，这是由UGV地形通过性决定的保守值。实际跟踪误差：
- UAV横向误差：0.07m(RMS)
- UAV高度误差：0.08m(RMS)
- UGV位置误差：0.05m(RMS)
4.2 同步策略与容错机制
TCM采用"到达即停"策略：
- 只有当双方都到达当前航点，才下发下一航点
- 先到达的平台进入等待状态(平均等待时间1.5秒)
- 超时(>5秒)或异常时触发安全协议
统计数据显示(表5)：
- UAV平均等待次数：144次/任务
- 平均等待时间差异：<0.1秒
- 最长等待时间：8.3秒(发生在初始阶段)
5. 实地测试与性能分析
5.1 续航能力测试(场景1)
在标准实验室环境(建筑45)进行的三组测试显示：
- 实验3持续2小时15分钟
- LTS4电池放电速率：46%/小时(最差情况)
- 备用电池始终维持>80%电量
- UGV电池电压稳定在25.5V(约50%电量)
关键发现：系统总重量仅使用UGV承载能力的60%，可通过增加电池组进一步延长作业时间。
5.2 定位精度测试(场景2)
对比三种定位方法在废弃热电站的表现(表3)：
- MCL-3D(500粒子)：
- 平均误差：0.45-1.25m
- 计算时间：0.64-0.71秒
- ICP(PCL实现)：
- 平均误差：0.13-0.56m
- 计算时间：1.8-2.9秒
- DLL(我们提出的方法)：
- 平均误差：0.14-0.26m
- 计算时间：0.07-0.11秒
DLL方法在保持ICP级精度的同时，速度提升25倍，满足实时控制要求。
5.3 全系统检测测试(场景3)
在老剧院建筑进行的模拟缺陷检测中：
- 成功识别全部12个AR标记(边长15cm)
- 平均定位误差：11.2cm(表6)
- 最佳标记(ID422)：误差仅3.1cm(307次观测)
- 最差标记(ID415)：误差19.8cm(28次观测)
值得注意的是，检测精度与观测次数强相关(r=0.82)，说明系统可通过重复检测提高结果可靠性。
6. 工程实践经验分享
6.1 线缆管理要点
- 张力设置：1N是最佳平衡点
- <0.8N：线缆易缠绕
1.5N：显著影响UAV稳定性
- 收放速度：与UAV升降速度匹配
- 上升：收线速度 = 上升速度 + 10%
- 下降：放线速度 = 下降速度 × 90%
- 应急措施：备用电池可支持5分钟紧急降落
6.2 典型故障处理
- 定位跳变：
- 现象：DLL输出突然偏移>0.5m
- 处理：切入手动模式，重启定位节点
- 线缆缠绕：
- 现象：张力波动>±0.3N
- 处理：暂停任务，手动解绕
- 通信中断：
- 设计：心跳包超时(>200ms)自动触发返航
6.3 参数调优建议
- 轨迹优化权重：
- 平滑度：安全性 = 1:2(室内) → 1:1(开阔区域)
- DLL参数：
- 体素滤波尺寸：0.1m(精细地图) → 0.2m(大场景)
- 控制参数：
- 高度控制增益：比平面增益高30%
这套系统在三次实地测试中展现出良好可靠性，累计运行时间超过8小时，未发生严重故障。移动式系留方案相比传统无人机，在2小时任务中可多覆盖3-4倍的工作区域，特别适合大型结构体的连续检测作业。
