1. 课程导入

当无人机完成中段导航、进入目标附近最后几十米甚至几米的空域时，任务成败往往不再取决于“飞得远不远”，而取决于“停得准不准”。末端进近控制研究的正是这一段：从视觉系统捕获目标、估计相对位姿，到控制器输出速度或姿态指令，最终让无人机稳定悬停、精准降落、贴附或抓取。它是导航、感知、控制与任务决策高度耦合的环节，也是无人机从“能飞”走向“能干活”的关键门槛。

一、学习目标：从“看得见”到“停得稳”

本课程围绕末端进近的完整闭环展开，学习目标可归纳为四个层次：

• 感知层：理解相机成像模型、目标检测与特征提取，掌握从像素坐标到相对位姿的转换关系。
• 估计层：掌握PnP、对极几何、视觉伺服等位姿估计方法，能分析噪声、延迟与遮挡对估计的影响。
• 控制层：理解位置控制、速度控制与视觉伺服控制的差异，能设计带前馈与滤波的进近律。
• 系统层：能够把感知、估计、控制、安全策略组织成可运行的末端进近流程，并完成参数整定与故障复盘。

换句话说，学习目标不是记住某个公式，而是建立“图像—位姿—指令—运动”的因果链，并能在真实约束下做出工程取舍。

二、核心概念：末端进近的五个关键词

末端进近涉及大量术语，但真正贯穿始终的核心概念可以压缩为五个：

概念	含义	典型表现
相对位姿	无人机与目标之间的位置和姿态差	横向偏差、高度差、偏航角误差
视觉伺服	以图像特征误差直接驱动控制量	图像平面上的目标中心逐渐收敛
视场约束	目标必须保持在相机视野内	目标接近图像边缘时需减速或转向
时延	从曝光到控制输出的时间滞后	高速进近时出现超调或振荡
安全包线	允许的速度、高度、距离与姿态范围	超出阈值时触发悬停或复飞

其中，相对位姿是控制目标，视觉伺服是主要手段，视场约束和时延是两大现实限制，安全包线则是最后防线。理解这五者的关系，就理解了末端进近的基本矛盾：既要快，又要稳，还要看得见。

三、整体框架：从图像到执行的闭环

末端进近系统通常由感知、估计、控制、执行和安全监控五个模块构成。其数据流可以概括为：相机采集图像，检测与跟踪模块输出目标区域，位姿估计模块计算相对位姿，控制器根据误差生成速度或姿态指令，飞控执行并反馈状态，安全监控模块实时判断是否越界。整个过程是一个带反馈的闭环，任何一环的延迟或误差都会沿链路放大。

该框架中，感知与估计决定“知道在哪”，控制决定“怎么过去”，安全监控决定“什么时候不能过去”。三者缺一不可，且必须在同一时间尺度上协调。

四、典型应用场景：末端进近的真实舞台

末端进近并非实验室概念，它直接对应大量真实任务：

• 精准降落：无人机在移动平台、舰船甲板或狭窄场地降落，需要视觉标志辅助定位，抑制风扰与地面效应。
• 室内巡检：在GPS拒止环境中，依靠视觉与惯性融合，贴近设备表面完成拍摄或读数。
• 目标抓取与贴附：机械臂或吸附装置需要在厘米级误差内对准目标，末端进近的稳定性直接决定抓取成功率。
• 编队对接：多机近距离协同，需要相对位姿估计与避碰策略同时生效。
• 应急投送：在灾区或复杂地形中，快速下降并精准投放物资，对时延和安全包线要求极高。

这些场景的共同点是：目标近、环境杂、容错低。末端进近控制的价值，正是在有限视场、有限算力和有限时间内，把误差收敛到任务允许的范围内。

五、常见误区与复盘思路

复盘时建议按“感知—估计—控制—执行”四段逐项检查：图像是否清晰、特征是否稳定、位姿是否跳变、指令是否饱和、执行是否滞后。只有把每一段的输入输出记录下来，才能定位真正的瓶颈。

六、一个最小可运行参数示例

下面给出末端进近中常见的参数配置片段，用于说明各模块之间的耦合关系。实际使用时需根据机型、相机与任务调整。

# 末端进近参数示例
camera:
  resolution: 1280x720
  fps: 30
  fov_h: 70          # 水平视场角(度)

detector:
  target: "aruco_marker"
  min_area: 400      # 最小像素面积
  max_lost_frames: 5

estimator:
  method: "pnp"
  smoothing: 0.35    # 位姿低通系数

controller:
  mode: "velocity"
  kp_xy: 0.8
  kp_z: 0.5
  max_speed: 1.2     # m/s
  approach_distance: 0.5  # 最终悬停距离(m)

safety:
  min_distance: 0.3
  max_tilt: 25       # 度
  lost_target_action: "hover"

这段配置体现了末端进近的基本逻辑：感知给出目标，估计给出位姿，控制给出速度，安全模块给出边界。任何一项参数变化，都会沿闭环传播，影响最终的停准精度与稳定性。