4. 航线规划基础
自主飞行器的航线规划，本质上是在三维空间中为飞行器定义一条可执行、可监控、可优化的运动路径。与地面车辆不同，飞行器不受道路约束，但受制于动力学性能、空域规则、能源消耗和环境风场。因此，航线规划并非简单地在地图上画折线，而是需要将地理坐标、飞行性能、任务约束和安全边界统一编码为结构化数据。本章将系统拆解航线规划中最核心的六个基本概念：航点（Waypoint）、航线（Route）、航段（Leg）、转弯半径（Turn Radius）、高度层（Flight Level）和速度剖面（Speed Profile），并说明它们之间的层级关系与工程实现方法。
4.1 航点（Waypoint）：航线的最小语义单元
核心原理：航点是航线中最基本的空间锚点，通常由三维坐标（纬度、经度、高度）和一组行为属性组成。在Pixhawk/ArduPilot、PX4等开源飞控中，航点被编码为MAVLink消息中的MISSION_ITEM，包含帧类型（MAV_FRAME_GLOBAL_RELATIVE_ALT等）、坐标、以及可选的航向角、悬停时间、云台俯仰角等参数。航点不仅仅是“飞过去”，它定义了飞行器到达该点时的期望状态——是直接飞越（Fly-Through）还是减速悬停（Stop-and-Turn），这直接影响后续转弯轨迹的规划方式。
航点属性设计要点：
- 坐标参考系：WGS-84经纬度 + 相对起飞点高度（常用）或海拔高度（MSL）。相对高度便于任务设计，但需注意地形起伏；高度适合山区或需要精确离地高度的场景。
- 到达容差（Acceptance Radius）：飞控判断“已到达”航点的半径范围。容差过小会导致飞行器在航点附近反复修正，增加能耗和抖动；容差过大则可能切弯过早，偏离任务路径。典型值：多旋翼1~3米，固定翼10~30米。
- 航点动作：拍照、投放、云台旋转、数据采集触发等。这些动作通常与航点绑定，在飞控到达并触发事件时执行。
4.2 航段（Leg）与航线（Route）：从点到线的结构化组织
核心原理：航段是相邻两个航点之间的运动路径描述，包含水平距离、垂直变化量、期望速度、爬升/下降率等参数。航线则是由多个航段按顺序组成的完整任务序列。在工程实现中，航线文件（如QGC Plan文件、Waypoint文件）通常以JSON或KML格式存储，包含航点列表、航段参数、以及全局设置（如返航高度、失控行为）。
航段类型与适用场景：
| 航段类型 | 描述 | 典型应用 |
|---|---|---|
| 直线航段（Line） | 两点间最短路径，飞控自动生成水平直线轨迹 | 常规巡航、测绘航线 |
| 垂直航段（Vertical） | 仅改变高度，水平位置不变 | 起飞爬升、降落前下降 |
| 圆弧航段（Arc） | 围绕指定圆心和半径飞行 | 环绕拍摄、雷达扫描 |
| 扫描航段（Scan） | 自动生成蛇形或栅格路径 | 大面积测绘、搜索救援 |
航线设计流程：
- 任务分解：将任务目标（如“完成2平方公里正射影像采集”）分解为若干子任务（起飞、爬升、进入测区、逐行扫描、返航）。
- 航点布局：根据相机视场角、重叠率、地面分辨率计算航点间距和航线间距。
- 航段参数设置：为每个航段指定速度、高度变化率、转弯策略。
- 安全校验：检查航线是否超出地理围栏、是否与障碍物冲突、是否满足电池续航。
- 导出与上传：生成航线文件，通过地面站上传至飞控，并执行仿真验证。
4.3 转弯半径与转弯策略
核心原理：转弯半径是飞行器在水平面内完成转向所需的最小圆弧半径，由飞行速度、最大坡度（倾斜角）和重力加速度共同决定。固定翼飞机的转弯半径公式为：
R = V² / (g · tan(φ))其中，V为真空速（m/s），g为重力加速度（9.81m/s²），φ为坡度角。例如，速度20m/s、坡度30°时，R = 400 / (9.81×0.577) ≈ 70.6m。多旋翼飞行器由于可以悬停，转弯半径理论上可为零，但实际中受限于飞控的加速度限制和云台稳定性要求，通常设定最小转弯半径。
转弯策略对比：
| 策略 | 描述 | 优点 | 缺点 |
|---|---|---|---|
| 飞越转弯（Fly-Through） | 飞行器不减速，沿圆弧平滑过渡到下一航段 | 效率高、速度快、能耗低 | 转弯半径大，可能偏离航线 |
| 减速转弯（Stop-and-Turn） | 到达航点后减速至悬停，再转向下一航点 | 轨迹精确、适合复杂环境 | 效率低、能耗高、影像姿态不稳定 |
| 自适应转弯（Adaptive） | 根据下一航段角度动态调整转弯半径 | 兼顾效率与精度 | 需要飞控支持高级算法 |
4.4 高度层（Flight Level）与垂直剖面
核心原理：高度层定义了飞行器在垂直维度上的运动约束。在航线规划中，高度层通常分为三种参考系：相对高度（Relative Altitude，相对于起飞点）、高度（MSL，平均海平面）和标准气压高度（Pressure Altitude，用于高空飞行）。实际任务中，高度层设计需综合考虑地形起伏、障碍物高度、空域限制和传感器性能。
高度层设计方法：
- 地形跟随：使用数字高程模型（DEM）生成等距地面高度层，适合山区测绘或电力巡检。需注意DEM精度和更新时效。
- 分层巡航：在长距离任务中，将航线分为爬升段、巡航段、下降段，每段设定不同的高度和速度，以优化能耗。
- 避障高度：根据任务区域内最高障碍物高度加上安全余量（通常10~20m）设定最低安全高度。
4.5 速度剖面（Speed Profile）与任务效率
核心原理：速度剖面描述了飞行器在航线不同位置的速度变化规律。合理的速度剖面能显著降低能耗、延长续航、提高数据质量。速度剖面通常包含：巡航速度、转弯速度、爬升/下降速度、悬停时间等参数。在PX4中，可通过NAV_SPEED、NAV_ACC_RAD等参数调整；在ArduPilot中，则通过WPNAV_SPEED、WPNAV_ACCEL等参数控制。
速度剖面设计原则：
- 直线段高速巡航：在无转弯、无障碍的航段使用最大巡航速度，减少任务时间。
- 转弯前减速：提前一个转弯半径的距离开始减速，确保转弯过程中速度不超过安全阈值。
- 爬升段适当加速：固定翼在爬升时需保持足够的空速，避免失速；多旋翼则需平衡爬升率与电池放电倍率。
- 任务段稳定速度：在测绘、巡检等数据采集航段，保持恒定速度以保证影像重叠率和传感器数据一致性。
4.6 常见误区与总结复盘
常见误区：
- 误区一：航点越多越好。过多的航点会增加飞控处理负担，且可能导致不必要的减速和转向。应尽量使用“直线航段+少量关键航点”的结构。
- 误区二：忽略转弯半径对航线的影响。在固定翼任务中，若航线间距小于两倍转弯半径，飞行器将无法按预期路径飞行，导致漏拍或重叠率异常。
- 误区三：高度层设置不考虑地形变化。在丘陵或山区使用固定相对高度，可能导致飞行器撞山或离地过高影响数据精度。
- 误区四：速度剖面“一刀切”。全程使用同一速度，既浪费续航，又可能在转弯或爬升段引发安全隐患。
总结复盘：航线规划的本质是将任务需求转化为飞控可执行的参数化指令。航点是“点”的语义，航段是“线”的运动描述，航线是“面”的任务组织，而转弯半径、高度层和速度剖面则是贯穿始终的动力学约束。在实际工程中，建议采用“先安全校验、后效率优化”的流程：首先确保所有航点、航段满足飞行器性能包线和空域规则，然后通过仿真迭代优化速度剖面和转弯策略。每一次实飞后，应回放飞行日志，对比规划轨迹与实际轨迹的偏差，持续修正航点容差、转弯提前量等参数。