SLAM无人机系统说明
核心能力: 在无GPS条件下,达到消费级GPS无人机的定点悬停、自主航线飞行和避障能力。
坐标系: 使用以起飞点为原点的东北天(ENU)局部坐标系。
1 无GPS自主飞行
技术实现: 紧耦合VIO(VINS-Fusion / OKVIS算法)或LIO-SAM。
性能指标:
- 定位漂移:< 1% 飞行距离(如飞行100米,漂移<1米)
- 定位频率: 100Hz-200Hz(融合IMU后输出)
- 抗丢帧能力: 视觉丢帧 < 500ms 可维持悬停
2 实时建图(SLAM)
地图类型:
- 视觉方案: 稀疏点云(用于定位)+ OctoMap(用于导航/避障,分辨率5-20cm)
- 激光方案: 2D栅格地图或3D体素地图
建图范围: 实时构建以无人机为中心、半径50-100m的局部地图。
地图保存: 支持保存为.pgm(栅格),.pcd(点云),.osa(用于复飞)。
回环检测: 支持(需重新访问已知区域),可修正累积漂移。
3 路径规划
全局规划: A* 或 Hybrid A* 算法(在已知地图上)。
局部规划: DWA (Dynamic Window Approach) 或 TEB (Timed Elastic Band),频率20Hz。
导航精度: 终点到达误差 < 0.3m(标准版,无外部辅助)。
最小转弯半径:0m(支持悬停转向)。
4 智能避障
感知范围: 前向 0.5m - 15m,水平FOV 90°,垂直FOV 60°。
避障行为: 优先侧向绕行 > 上方绕行 > 停止悬停。
动态物体处理: 过滤移动人/车(不将其加入静态地图),但主动绕开。
5 任务模式
探索模式: 自主探索(基于前沿边界探测Frontier Exploration),自动覆盖未知区域,生成覆盖率报告。
定点导航: 支持输入 (x,y,z,yaw) 相对坐标或 (lat,lon,alt) 转换后的局部坐标。
路径复飞: 记录飞行轨迹,复飞时位置误差 < 0.2m,姿态一致。
| 子系统 | 标准版配置 | 接口/协议 | 参数 |
|---|---|---|---|
| 飞控 | Pixhawk 6C / Cube Orange | UART (MAVLink 2.0), CAN | 频率400Hz, 内置IMU+Baro |
| 计算平台 | Nvidia Jetson Orin NX 16GB | USB 3.0, GMSL2, GigE, UART | 100 TOPS AI算力, 20W功耗 |
| 视觉前端 | Intel RealSense D455 | USB-C 3.1 | 全局快门, 0.2-10m深度, 内置IMU |
| 激光雷达(可选) | Livox Mid-360 | Ethernet/UART | 360° x 59° FOV, 40m范围, 近零盲区 |
| 机载IMU | BMI088 (飞控) + ICM-42688 (算力板) | SPI | 6轴, 抗振动, 2000dps |
| 避障传感器 | 前向双目 (复用D455) | 视觉+深度 | 不单独配置,由SLAM复用 |
| 通信链路 | 4G Dongle + SDR 数传 433/915MHz | USB + UART | 数据回传 2MB/s (4G), 控制链路 250kbps |
无GPS启动时间
< 15秒(从上电到位置锁定)
最大飞行速度(建图模式)
2 m/s
最大飞行速度(导航模式)
5 m/s
抗光照变化
10 lux ~ 10,000 lux(微光路灯到室外阴天)
动态避障响应时间
< 100ms(障碍物出现到开始绕行)
模块化设计
传感器、计算板、电池快拆,更换< 2分钟
- 纹理: 墙面/地面有 > 5% 的特征点(如划痕、图案、角点)。纯白、纯黑、镜面、水面失效。
- 光照: 无频闪(50/60Hz LED灯光可接受),无剧烈曝光变化(如隧道入口)。
- 动态物体比例: 视野中移动物体(人、车)< 30%,否则VIO估计会偏。
飞行包线:
- 最大角速度:< 150°/s
- 最大加速度:< 3 m/s²(超过则定位可能丢失)
- 光照 < 10 lux 或 > 100,000 lux(无光或强直射)
- 环境为纯色结构(白色走廊、空旷仓库)
- 需要穿越烟雾、粉尘、雨雾
| 场景 | 配置要点 | 预期效果 |
|---|---|---|
| 室内巡检 | 视觉SLAM + 预先录制航点 | 重复轨迹误差 < 0.2m,可拍摄高精度对齐照片 |
| 隧道检测 | 激光SLAM + 前向补光 | 无光照条件下以 1m/s 前进,生成带时间戳的缺陷点云 |
| 林地搜索 | 视觉+激光融合,关闭下方避障 | 穿越树干间隙(>50cm),识别红色/橙色物体 |
| 地下车库 | 纯视觉 + 地库弱光模式(增益调高) | 可覆盖2-3层,每层1000平米,生成2D俯视地图 |
| 扩展功能 | 硬件要求 | 软件改动 | 性能 |
|---|---|---|---|
| 目标识别 | 机载算力 > 50 TOPS | YOLOv8 部署 | 30fps 检测,输出目标在局部地图中的坐标 |
| 热成像 | 热成像USB相机(如FLIR Lepton) | 图像融合 + 温度阈值报警 | 检测温差 > 0.5°C 物体 |
| 4G/5G远程 | 机载5G模组 + 公网IP服务器 | 增加RTC和自适应码率 | 控制延迟 < 80ms,图传延迟 150-300ms |
| 自动充电 | 接触式电极 + 停机坪(带引导信标) | 电量<20%触发返航,着陆精度需<10cm | 充电电流 10A,2小时充满 |
- 控制输入: MAVLink SET_POSITION_TARGET_LOCAL_NED 消息,频率 10-50Hz。
- 状态输出: LOCAL_POSITION_NED (x,y,z, vx,vy,vz) + ATTITUDE (roll,pitch,yaw)。
- 地图输出: ROS 2 Topic /octomap_full 或 /costmap_2d。
- 诊断信息: 输出定位置信度(0-100),避障状态,CPU/GPU占用率。
| 故障 | 检测条件 | 标准版响应 |
|---|---|---|
| SLAM丢失 | 特征点 < 20个 持续1秒 或 IMU发散 | 悬停 → 尝试原地重定位 → 失败则垂直降落 |
| 避障传感器失效 | 深度数据持续无效 > 2秒 | 减速至0.5m/s,仅允许前后左右微调,提示手动降落 |
| 通信中断 | 地面站无心跳 > 3秒 | 执行"返回起飞点"路径(沿原路后退) |
| 低电量 | 电压低于预设阈值(如3.5V/电芯) | 第一级报警(返回),第二级报警(原地降落) |