四旋翼如何用降维姿态表示跟踪向量场？

平移只取决于推力方向

四旋翼的平移动力学只通过量 R b3 依赖姿态，即机体固连推力轴在惯性系中的表示。绕该推力轴的旋转就是航向，它不直接影响平移。论文正是建立在这一事实上：不再在 SO(3) 上调节整个姿态，而是只用推力方向描述姿态，即球面 S2 上的单位向量，并把航向交给独立控制器生成。

这一选择不只是简化。论文指出，航向控制权限来自旋翼的反扭矩差，比用于倾斜机动的力矩更弱，因此激进的航向跟踪可能使执行器趋于饱和并削弱平移稳定性。让航向不受约束，就把这一负担从平移问题中移除。

用于控制的降维模型状态为 (p, v, R3)，其中 R3 = R b3 是推力方向，控制输入为 (T, omega1, omega2)：总推力加上前两个角速度分量。论文有意不使用力矩级输入，并指出把设计推广到力矩级还需要额外一步反步法。

两种控制器各有取舍

第一种设计采用动态扩展。推力 T 被并入状态，形成扩展状态 (p, v, R3, T) 和输入 (Tdot, omega1, omega2)，使推力与旋转输入处于同一层级，位置对两者获得一致相对阶。随后反步控制器把速度误差 e1 = v - vd(p,t) 和加速度误差 e2 = (1/m) R3 T - ad(p,v,t) 驱动到零。

第二种设计不做动态扩展，而是利用 S2 的几何性质直接在降维系统上工作。其误差为 e1 = v - vd(p,t) 和 e2 = R3 x R3d，其中 R3d 是目标加速度曲线 ad 对应的单位向量。推力设为 m 乘以 ad 的范数，角速度指令中包含由两个推力方向叉乘结构构成的项。

取舍在论文中写得很明确。动态扩展在实践中常见，但会引入不希望的延迟，因为设计出的控制器必须经过积分才能产生发送给被控对象的物理输入。几何控制器省去这一积分步骤，但要求目标加速度非零，且推力方向不与目标方向反向。

指数收敛及其成立条件

对动态扩展控制器，定理 1 给出显式指数界：跟踪误差范数满足 ||e(t)|| <= max{sqrt(sigma), 1/sqrt(sigma)} ||e(t0)|| exp(-k(t - t0))，其中 k = min{k1/2, k2/2}。证明使用一个结合速度误差与缩放加速度误差的 Lyapunov 函数，该界在最大存在区间内的轨迹上成立。

对几何控制器，定理 2 给出可比但参数化方式不同的界：||e(t)|| <= sqrt(c2/c1) ||e(t0)|| exp(-(k/2)(t - t0))，其中 k = min{k1, (2 - rho) k2}，c1 = min{1/(2 sigma), 1/2}，c2 = max{1/(2 sigma), 1/(2 - rho)}。该结果要求初始条件位于区域 N_rho(t0) 内，rho 属于 (0,2)，并要求 ||ad(p0, v0, t0)|| > 0。

两个界不能互换。动态扩展的界直接依赖 sigma 以及 k1、k2；几何的界则把区域参数 rho 同时带入衰减率和常数 c2，因此保证成立区域的大小会影响保证衰减的快慢。两个定理都只针对最大存在区间上的解，论文明确不声称解是完备的，并指出前向不变性并不需要完备性。

把安全约束编码进向量场

安全性的处理方式是固定跟踪控制器的结构，转而设计目标向量场 vd，使其满足鲁棒控制屏障函数条件：h 对位置的梯度与 vd 的点积，至少为 -alpha h(p) 加上 (1/epsilon) 乘以该梯度范数的平方。这里 h 以其零上水平集定义安全集，alpha > 0 是线性扩展 K 无穷类函数，epsilon > 0 是受输入到状态安全框架启发的鲁棒参数。

论文给出的直觉很直接：如果实际速度恰好等于 vd，该条件就蕴含 h 上的标准 CBF 条件。由于跟踪只是指数收敛而非瞬时完成，控制器还必须压过暂态跟踪误差，这正是安全定理除向量场条件之外还要施加增益条件的原因。

对动态扩展控制器，定理 3 要求 k1 >= max{epsilon mu, 2 alpha} 且 k2 >= alpha，并得出由 h(p) - (1/mu) V >= 0 定义的集合前向不变，因此 p(t) 在存在区间内始终留在安全集中。对几何控制器，定理 4 要求 k1 >= max{epsilon sigma mu, 2 alpha} 且 k2 >= alpha/(2 - rho)，同时初始条件位于安全集内并满足定理 2 的条件。

论文把这些增益条件的含义概括为两点：初始化必须位于安全集内且动力学良定义之处；向量场跟踪必须相对安全向量场的变化足够快，这一变化由 alpha 刻画。

飞行实验实际展示了什么

仿真先测试不含安全约束的跟踪。质量 m = 1 kg，初始位置和速度为零，初始姿态旋转 theta0 = 175 度，论文称这几乎是倒置的，目标向量场为 vd(p,t) = -lambda (p - pd(t)) + pdot_d(t)，lambda = 1，跟踪参考轨迹 pd(t) = [cos 2t, sin 2t, 1]。动态扩展控制器增益为 k1 = k2 = 4，几何控制器为 k1 = 4、k2 = 2。即使从如此大的旋转误差出发，速度误差仍按定理 1 和定理 2 指数收敛到零。

仿真中的安全执行对前两个坐标施加位置约束 pm = +/- 0.8 m，通过定义安全集的光滑组合 h(p) 编码，并对标称 vd 施加光滑安全滤波器。增益为 k1 = k2 = 20，动态扩展控制器的安全滤波器参数为 alpha = 7.5、lambda_h = 5、epsilon = 2、mu = 10，几何控制器为 alpha = 5、lambda_h = 2、epsilon = 2、mu = 10。

实验验证在室内使用 Crazyflie 2.1。轨迹跟踪时，无人机从原点水平地面静止起步，参考轨迹为 pd(t) = [0.5 cos(beta t), 0.5 sin(beta t), 0.25]，beta = 2 pi / 5，向量场取 lambda = 2.5，动态扩展增益为 k1 = k2 = 20，几何控制为 k1 = k2 = 10。飞行中的安全执行把前两个坐标的位置约束收紧到 pm = +/- 0.4 m，CBF 参数为 lambda_h = 10、alpha = 5、epsilon = 1、mu = 10。

论文对这些结果的自我总结是：期望的安全行为被成功编码进目标向量场，并被控制器准确跟踪。所报告的证据是每张飞行图中约 25 秒的位置、速度误差、推力和角速度曲线，而不是量化的约束满足裕度。

这些保证的适用边界

稳定性与安全性结果都只到角速度层级。论文指出，把设计扩展到以 M 为输入的力矩层级还需要额外一步反步法，因此按原文写出的定理并不直接覆盖物理力矩输入。

两个跟踪定理都只在最大存在区间上成立，且不声称解是完备的。论文指出完备性需要对 vd 以及 T 沿轨迹的行为作进一步假设，而这一分析被省略。几何控制器还额外要求 ||ad|| > 0 且 R3 不等于 -R3d，其保证以初始条件位于 N_rho(t0) 内、rho 属于 (0,2) 为前提。

实验证据来自 Crazyflie 2.1 的室内飞行测试，安全测试只对前两个位置坐标施加约束。论文没有报告室外运行、多机协同，也没有报告超出 CBF 条件中鲁棒参数 epsilon 所代表的扰动之外的约束满足情况。

何时该选哪种控制器

两种设计之间的选择取决于一个具体取舍，而不是哪一个全面更优。动态扩展是更常见的技术，其指数界直接依赖 sigma 和增益，但它需要对设计出的控制器积分才能得到物理输入，论文把这一点认定为不希望的延迟来源。几何控制器省去该积分并直接在降维系统上工作，代价是要求目标加速度非零、推力方向不反向，且初始条件位于区域 N_rho 内。

安全增益条件使比较更清晰。动态扩展需要 k1 >= max{epsilon mu, 2 alpha} 和 k2 >= alpha；几何控制需要 k1 >= max{epsilon sigma mu, 2 alpha} 和 k2 >= alpha/(2 - rho)。几何条件同时带有 sigma 和 rho，因此用于认证跟踪保证的区域参数也进入了安全增益要求。

因此论文中最值得关注的判断不是两种控制器都能工作，而是安全保证是靠与跟踪相对安全向量场变化速度（由 alpha 刻画）挂钩的增益条件换来的。比较这两种设计的读者应首先看应用能否容忍动态扩展的积分延迟，其次看几何控制器的区域条件和非反向条件能否在初始化时满足，因为这些条件决定了安全定理是否适用。

本文引用的文献