Lee 2015 RATSMC 论文精读：李群 SE(3) 航天器自主交会对接鲁棒自适应终端滑模控制深度剖析

---

---

一、引言与学术背景 (I. INTRODUCTION & CONTEXT)

在现代航天任务中，在轨卫星捕获、空间碎片清除、深空采样返回以及空间站货物补给（如欧洲自动转移飞行器 ATV 与国际空间站 ISS 对接）对自主近距离交会对接（Autonomous Rendezvous and Docking, RVD）提出了极其苛刻的自主性与鲁棒性要求。

此类空间任务面临三重深层控制难题：

1. 六自由度强交叉耦合：航天器的平动轨道运动与姿态旋转运动并非相互解耦的质点。推力器安装于本体坐标系，推力矢量在惯性空间中的指向完全受姿态旋转矩阵支配；同时，万有引力梯度、地磁摄动及非球形引力摄动引起了复杂的动力学牵连力矩；
2. 环境干扰与惯量参数失配：在近距操作阶段，高层稀薄大气阻力、太阳辐射光压、目标非合作微自旋以及抓捕引起的质量/转动惯量突变（通常存在 $20\%\sim 30\%$ 的不确定性）导致无法依赖精确的名义模型；
3. 执行机构推力与力矩受限：微小推力器或反作用飞轮输出的力和力矩受到物理饱和约束（例如力矩限幅 $0.1\mathrm{N}\cdot \mathrm{m}$，推力限幅 $0.6\mathrm{N}$）。若不显式考虑饱和特性，控制指令超限将诱发闭环发散。

在历史文献中，许多学者采用欧拉角或四元数分别设计姿态环控制器，采用三维笛卡尔坐标设计位置环控制器。然而，欧拉角存在固有的运动学万向节死锁奇点；四元数在紧致李群 $\mathrm{SO}(3)$ 上的拓扑映射存在双重覆盖（Double Covering），在闭环大角度机动中极易引发不可预测的解缠绕（Unwinding）振荡；双四元数虽然形式紧凑，但代数乘法复杂且流形约束繁琐。

Daero Lee 与 George Vukovich 在 2015 年发表于 Nonlinear Dynamics 的这篇里程碑论文，彻底突破了传统姿轨解耦范式。作者将航天器的位姿构型空间严格建立在特殊欧几里得群 $\mathrm{SE}(3)\cong {\mathbb{R}}^3⋉\mathrm{SO}(3)$ 这一无坐标奇异的微分流形上，利用指数坐标对数映射建立了相对运动学方程，进而提出了鲁棒自适应终端滑模控制 (RATSMC)。该方法在存在未知上界时变扰动、惯量参数严重不确定以及执行机构输出物理饱和的条件下，实现了刚体航天器位姿一体化跟踪误差的有限时间（Finite-Time）几乎全局收敛。

---

二、刚体动力学与李群 SE(3) 相对耦合建模 (II. RIGID-BODY DYNAMICS & RELATIVE COUPLING)

图 1：从航天器（追踪星）与主航天器（目标星）在地球中心引力场中的几何坐标系示意图。

2.1 主航天器与从航天器动力学（欧拉-庞加莱方程）

考虑在地球中心引力场中沿一般受约束轨道运动的刚体航天器。设地球中心惯性系为 $\{\mathcal{I}\}$，航天器本体坐标系为 $\{\mathcal{B}\}$。 定义航天器的构型矩阵 $\mathbf{g}\in \mathrm{SE}(3)$：

$$\mathbf{g}=\left[\begin{array}{cc}\mathbf{R}& \mathbf{p}\\ 0_{1\times 3}& 1\end{array}\right]\in \mathrm{SE}(3)\text{\hspace{1em}(1)}$$

其中 $\mathbf{R}\in \mathrm{SO}(3)$ 为从本体坐标系到惯性系的旋转矩阵，$\mathbf{p}\in {\mathbb{R}}^3$ 为质心在惯性系中的位置矢量。

航天器在本体坐标系中的六维速度旋量（Twist）定义为：

$$\mathbf{\xi }=\left[\begin{array}{c}\mathbf{\omega }\\ \mathbf{v}\end{array}\right]\in {\mathbb{R}}^6\text{\hspace{1em}(2)}$$

其中 $\mathbf{\omega }\in {\mathbb{R}}^3$ 为本体角速度，$\mathbf{v}\in {\mathbb{R}}^3$ 为本体平动线速度。

其运动学方程紧凑表示为李群上的泊松微分方程：

$$\dot{\mathbf{g}}=\mathbf{g}{\mathbf{\xi }}^{\wedge },\text{其中 }{\mathbf{\xi }}^{\wedge }=\left[\begin{array}{cc}{\mathbf{\omega }}^{\times }& \mathbf{v}\\ 0_{1\times 3}& 0\end{array}\right]\in \mathfrak{se}(3)\text{\hspace{1em}(3)}$$

算子 $(\cdot {)}^{\times }:{\mathbb{R}}^3\to \mathfrak{so}(3)$ 为反对称矩阵映射；$(\cdot {)}^{\wedge }:{\mathbb{R}}^6\to \mathfrak{se}(3)$ 为向量到李代数的线性同构映射，其逆映射记为 $(\cdot {)}^{\vee }$。

定义刚体广义广义质量惯度矩阵 $\mathbb{I}\in {\mathbb{R}}^{6\times 6}$：

$$\mathbb{I}=\left[\begin{array}{cc}\mathbf{J}& 0_{3\times 3}\\ 0_{3\times 3}& m{\mathbf{I}}_3\end{array}\right]\text{\hspace{1em}(4)}$$

其中 $\mathbf{J}\in {\mathbb{R}}^{3\times 3}$ 为本体转动惯量矩阵，$m$ 为航天器质量。

在无控制与外扰条件下，李群 $\mathrm{SE}(3)$ 上的动能拉格朗日量经左不变（或右不变）约化后导出欧拉-庞加莱方程（Euler-Poincaré Equations）。引入控制与外力后，主航天器（上标 $0$）与从航天器的动力学方程统一写作：

$$\mathbb{I}\dot{\mathbf{\xi }}={\mathrm{ad}}_{\mathbf{\xi }}^{\ast }\mathbb{I}\mathbf{\xi }+{\mathbf{\tau }}_g+{\mathbf{\tau }}_c+{\mathbf{\tau }}_d\text{\hspace{1em}(5)}$$

其中：

• ${\mathbf{\tau }}_g\in {\mathbb{R}}^6$ 为已知重力场输入（包含万有引力与重力梯度力矩）；
• ${\mathbf{\tau }}_c=[{\mathbf{T}}_c^{\top },{\mathbf{F}}_c^{\top }{]}^{\top }\in {\mathbb{R}}^6$ 为控制输入力矩与控制推力；
• ${\mathbf{\tau }}_d=[{\mathbf{T}}_d^{\top },{\mathbf{F}}_d^{\top }{]}^{\top }\in {\mathbb{R}}^6$ 为未知时变外界环境扰动旋量。

2.2 伴随算子与李代数对偶余伴随算子

在 $\mathrm{SE}(3)$ 与其切空间 $\mathfrak{se}(3)$ 之间，伴随映射（Adjoint representation）定义为群内自同构的微分。对于任意位姿 $\mathbf{g}\in \mathrm{SE}(3)$ 与速度旋量 $\mathbf{\zeta }\in {\mathbb{R}}^6$：

$${\mathrm{Ad}}_{\mathbf{g}}=\left[\begin{array}{cc}\mathbf{R}& 0_{3\times 3}\\ {\mathbf{p}}^{\times }\mathbf{R}& \mathbf{R}\end{array}\right]\in {\mathbb{R}}^{6\times 6},\text{满足 }{\mathrm{Ad}}_{\mathbf{g}}\mathbf{\zeta }=(\mathbf{g}{\mathbf{\zeta }}^{\wedge }{\mathbf{g}}^{-1}{)}^{\vee }\text{\hspace{1em}(6)}$$

李代数自身的伴随映射 ${\mathrm{ad}}_{\mathbf{\xi }}$ 作用在切向量上，表示李括号矩阵：

$${\mathrm{ad}}_{\mathbf{\xi }}=\left[\begin{array}{cc}{\mathbf{\omega }}^{\times }& 0_{3\times 3}\\ {\mathbf{v}}^{\times }& {\mathbf{\omega }}^{\times }\end{array}\right]\in {\mathbb{R}}^{6\times 6}\text{\hspace{1em}(7)}$$

余伴随算子（Co-adjoint representation）${\mathrm{ad}}_{\mathbf{\xi }}^{\ast }$ 定义在余切空间 ${\mathfrak{se}}^{\ast }(3)$（与动量/力旋量同构）上，其标准矩阵形式为伴随矩阵的转置的负伴随或直接定义为：

$${\mathrm{ad}}_{\mathbf{\xi }}^{\ast }=({\mathrm{ad}}_{\mathbf{\xi }}{)}^{\top }=\left[\begin{array}{cc}-(\mathbf{\omega }{)}^{\times }& -(\mathbf{v}{)}^{\times }\\ 0_{3\times 3}& -(\mathbf{\omega }{)}^{\times }\end{array}\right]\text{\hspace{1em}(8)}$$

在欧拉-庞加莱方程中，${\mathrm{ad}}_{\mathbf{\xi }}^{\ast }\mathbb{I}\mathbf{\xi }=[-({\mathbf{\omega }}^{\times }\mathbf{J}\mathbf{\omega }{)}^{\top },-m({\mathbf{\omega }}^{\times }\mathbf{v}{)}^{\top }{]}^{\top }$，精准对应了经典刚体力学中的欧拉非线性陀螺项与旋转坐标系下的平动科氏力牵连项！

2.3 高保真重力场与地球非球形 J2 摄动建模

航天器在近地或大偏心率轨道运行时，重力并非简单的常值加速度。文献综合考虑了引力、重力梯度力矩以及二阶带谐系数 $J_2$：

$${\mathbf{\tau }}_g=\left[\begin{array}{c}{\mathbf{M}}_g\\ {\mathbf{F}}_g+m{\mathbf{R}}^{\top }{\mathbf{a}}_{J_2}(\mathbf{p})\end{array}\right]\text{\hspace{1em}(9)}$$

其中：

$$\begin{array}{rl}{\mathbf{M}}_g& =\frac{3\mu }{\Vert \mathbf{p}{\Vert }^5}{\mathbf{b}}^{\times }\mathbf{J}\mathbf{b},(\text{其中 }\mathbf{b}={\mathbf{R}}^{\top }\mathbf{p})\\ {\mathbf{F}}_g& =-\frac{m\mu }{\Vert \mathbf{p}{\Vert }^3}\mathbf{b}-\frac{3\mu }{\Vert \mathbf{p}{\Vert }^5}\mathcal{J}\mathbf{b}+\frac{15\mu ({\mathbf{b}}^{\top }\mathbf{J}\mathbf{b})}{2\Vert \mathbf{p}{\Vert }^7}\mathbf{b},\mathcal{J}=\frac{1}{2}\mathrm{tr}(\mathbf{J}){\mathbf{I}}_3+\mathbf{J}\end{array}\text{\hspace{1em}(10)}$$

惯性系下的地球扁率 $J_2$ 摄动加速度为：

$${\mathbf{a}}_{J_2}(\mathbf{p})=\left[\begin{array}{c}-\frac{3\mu J_2{R}_{\oplus }^2{p}_x}{2\Vert \mathbf{p}{\Vert }^5}\left(1-\frac{5p_z^2}{\Vert \mathbf{p}{\Vert }^2}\right)\\ -\frac{3\mu J_2{R}_{\oplus }^2{p}_y}{2\Vert \mathbf{p}{\Vert }^5}\left(1-\frac{5p_z^2}{\Vert \mathbf{p}{\Vert }^2}\right)\\ -\frac{3\mu J_2{R}_{\oplus }^2{p}_z}{2\Vert \mathbf{p}{\Vert }^5}\left(3-\frac{5p_z^2}{\Vert \mathbf{p}{\Vert }^2}\right)\end{array}\right]\text{\hspace{1em}(11)}$$

参数定义：地球引力常数 $\mu =3.9860044\times 10^{14}{\mathrm{m}}^3/{\mathrm{s}}^2$，赤道半径 $R_{\oplus }=6378.137\mathrm{km}$，$J_2=1.08263\times 10^{-3}$。

2.4 相对位姿构型误差与对数指数坐标

设主航天器的位姿轨迹为 ${\mathbf{g}}^0(t)\in \mathrm{SE}(3)$，期望的固定相对构型（形成相对保持或对接构型）为 ${\mathbf{h}}_{\mathrm{f}}\in \mathrm{SE}(3)$。 则追踪星的期望位姿与期望速度旋量为：

$${\mathbf{g}}^d(t)={\mathbf{g}}^0(t){\mathbf{h}}_{\mathrm{f}},{\mathbf{\xi }}^d(t)={\mathrm{Ad}}_{{\mathbf{h}}_{\mathrm{f}}^{-1}}{\mathbf{\xi }}^0(t)\text{\hspace{1em}(12)}$$

从航天器与主航天器之间的真实相对位姿为：

$$\mathbf{h}(t)=({\mathbf{g}}^0(t){)}^{-1}\mathbf{g}(t)\in \mathrm{SE}(3)\text{\hspace{1em}(13)}$$

追踪星相对于期望构型的误差位姿定义为：

$${\mathbf{h}}_e(t)=({\mathbf{h}}_{\mathrm{f}}{)}^{-1}\mathbf{h}(t)=({\mathbf{g}}^d(t){)}^{-1}\mathbf{g}(t)\in \mathrm{SE}(3)\text{\hspace{1em}(14)}$$

利用李群对数映射 $\mathrm{logm}:\mathrm{SE}(3)\to \mathfrak{se}(3)$，将构型误差映射到指数坐标向量 $\tilde{\mathbf{\eta }}\in {\mathbb{R}}^6$：

$${\tilde{\mathbf{\eta }}}^{\wedge }=\mathrm{logm}\left({\mathbf{h}}_e\right)=\left[\begin{array}{cc}{\tilde{\mathbf{\Theta }}}^{\times }& \tilde{\mathbf{\beta }}\\ 0_{1\times 3}& 0\end{array}\right],\tilde{\mathbf{\eta }}=\left[\begin{array}{c}\tilde{\mathbf{\Theta }}\\ \tilde{\mathbf{\beta }}\end{array}\right]\in {\mathbb{R}}^6\text{\hspace{1em}(15)}$$

其中 $\tilde{\mathbf{\Theta }}\in {\mathbb{R}}^3$ 为姿态旋转误差（对应罗德里格主旋转矢量，主角度 $\theta =\Vert \tilde{\mathbf{\Theta }}\Vert$），$\tilde{\mathbf{\beta }}\in {\mathbb{R}}^3$ 为相对位置误差指数坐标。 根据注 1，只要姿态旋转角 $\Vert \tilde{\mathbf{\Theta }}\Vert <\pi$，对数映射是严格双射平滑的。

从航天器在自身本体坐标系中相对于主航天器的相对速度旋量定义为：

$$\tilde{\mathbf{\xi }}(t)=\mathbf{\xi }(t)-{\mathrm{Ad}}_{{\mathbf{h}}^{-1}(t)}{\mathbf{\xi }}^0(t)=\left[\begin{array}{c}{\mathbf{\omega }}_e(t)\\ {\mathbf{v}}_e(t)\end{array}\right]\in {\mathbb{R}}^6\text{\hspace{1em}(16)}$$

2.5 相对运动学雅可比逆矩阵 G(η) 与恒等式 G(η)η = η

指数坐标的时间导数与相对速度旋量之间的微分运动学关系由微分指数映射的切空间传递矩阵给出：

$$\dot{\tilde{\mathbf{\eta }}}=\mathbf{G}(\tilde{\mathbf{\eta }})\tilde{\mathbf{\xi }}\text{\hspace{1em}(17)}$$

根据 Park & Chung (2005) 的精确级数展开，$\mathbf{G}(\mathbf{\eta })$ 可表示为伴随算子幂次多项式：

$$\mathbf{G}(\mathbf{\eta })={\mathbf{I}}_6+\frac{1}{2}{\mathrm{ad}}_{\mathbf{\eta }}+a(\theta ){\mathrm{ad}}_{\mathbf{\eta }}^2+b(\theta ){\mathrm{ad}}_{\mathbf{\eta }}^4\text{\hspace{1em}(18)}$$

标量系数由三角函数封闭给出：

$$\{\begin{array}{l}a(\theta )=\frac{1}{{\theta }^2}\left[2-\frac{3}{4}\theta \cot \left(\frac{\theta }{2}\right)-\frac{{\theta }^2}{8}{\csc }^2\left(\frac{\theta }{2}\right)\right]\\ b(\theta )=\frac{1}{{\theta }^4}\left[1-\frac{1}{4}\theta \cot \left(\frac{\theta }{2}\right)-\frac{{\theta }^2}{8}{\csc }^2\left(\frac{\theta }{2}\right)\right]\end{array}\text{\hspace{1em}(19)}$$

将 $\mathbf{\eta }=[{\mathbf{\Theta }}^{\top },{\mathbf{\beta }}^{\top }{]}^{\top }$ 代入，$\mathbf{G}(\mathbf{\eta })$ 呈现块下三角结构：

$$\mathbf{G}(\mathbf{\eta })=\left[\begin{array}{cc}{\mathcal{S}}^{-1}(\mathbf{\Theta })& 0_{3\times 3}\\ \mathbf{Q}(\mathbf{\Theta },\mathbf{\beta },\theta )& {\mathcal{S}}^{-1}(\mathbf{\Theta })\end{array}\right]\text{\hspace{1em}(20)}$$

其中 ${\mathcal{S}}^{-1}(\mathbf{\Theta })={\mathbf{I}}_3-\frac{1}{2}{\mathbf{\Theta }}^{\times }+\left(\frac{1}{{\theta }^2}-\frac{1+\cos \theta }{2\theta \sin \theta }\right)({\mathbf{\Theta }}^{\times }{)}^2$。

引理 1 (Lee 2015 关键恒等式)
矩阵值映射 $\mathbf{G}(\mathbf{\eta }):{\mathbb{R}}^6\to {\mathbb{R}}^{6\times 6}$ 对任意 $\mathbf{\eta }\in {\mathbb{R}}^6$ 均严格满足：

$$\mathbf{G}(\mathbf{\eta })\mathbf{\eta }\equiv \mathbf{\eta }\text{\hspace{1em}(21)}$$

严格证明：由伴随算子定义式 (7)，${\mathrm{ad}}_{\mathbf{\eta }}\mathbf{\eta }=[{\mathbf{\Theta }}^{\times }\mathbf{\Theta };{\mathbf{\beta }}^{\times }\mathbf{\Theta }+{\mathbf{\Theta }}^{\times }\mathbf{\beta }]=[0;0]=0$。将其代入式 (18)：

$$\mathbf{G}(\mathbf{\eta })\mathbf{\eta }={\mathbf{I}}_6\mathbf{\eta }+\frac{1}{2}{\mathrm{ad}}_{\mathbf{\eta }}\mathbf{\eta }+a(\theta ){\mathrm{ad}}_{\mathbf{\eta }}({\mathrm{ad}}_{\mathbf{\eta }}\mathbf{\eta })+b(\theta ){\mathrm{ad}}_{\mathbf{\eta }}^3({\mathrm{ad}}_{\mathbf{\eta }}\mathbf{\eta })=\mathbf{\eta }+0+0+0=\mathbf{\eta }$$

证毕。

2.6 相对加速度时间演化方程

记牵连速度为 $\breve{\mathbf{\xi }}={\mathrm{Ad}}_{{\mathbf{h}}^{-1}}{\mathbf{\xi }}^0$。由于 $\frac{\mathrm{d}}{\mathrm{d}t}{\mathbf{h}}^{-1}=-{\tilde{\mathbf{\xi }}}^{\wedge }{\mathbf{h}}^{-1}$，根据李代数伴随算子求导法则（见原论文附录完整展开）：

$$\frac{\mathrm{d}}{\mathrm{d}t}\left({\mathrm{Ad}}_{{\mathbf{h}}^{-1}}{\mathbf{\xi }}^0\right)=-{\mathrm{ad}}_{\tilde{\mathbf{\xi }}}{\mathrm{Ad}}_{{\mathbf{h}}^{-1}}{\mathbf{\xi }}^0+{\mathrm{Ad}}_{{\mathbf{h}}^{-1}}{\dot{\mathbf{\xi }}}^0\text{\hspace{1em}(22)}$$

因此，相对加速度 $\dot{\tilde{\mathbf{\xi }}}=\dot{\mathbf{\xi }}-\frac{\mathrm{d}}{\mathrm{d}t}\breve{\mathbf{\xi }}$ 的严格微分关系为：

$$\dot{\tilde{\mathbf{\xi }}}=\dot{\mathbf{\xi }}+{\mathrm{ad}}_{\tilde{\mathbf{\xi }}}{\mathrm{Ad}}_{{\mathbf{h}}^{-1}}{\mathbf{\xi }}^0-{\mathrm{Ad}}_{{\mathbf{h}}^{-1}}{\dot{\mathbf{\xi }}}^0\text{\hspace{1em}(23)}$$

将从航天器动力学式 (5) 两边同乘以惯量 $\mathbb{I}$ 并代入，得到相对运动动力学核心控制方程：

$$\mathbb{I}\dot{\tilde{\mathbf{\xi }}}={\mathrm{ad}}_{\mathbf{\xi }}^{\ast }\mathbb{I}\mathbf{\xi }+{\mathbf{\tau }}_g+{\mathbf{\tau }}_c+{\mathbf{\tau }}_d+\mathbb{I}\left({\mathrm{ad}}_{\tilde{\mathbf{\xi }}}{\mathrm{Ad}}_{{\mathbf{h}}^{-1}}{\mathbf{\xi }}^0-{\mathrm{Ad}}_{{\mathbf{h}}^{-1}}{\dot{\mathbf{\xi }}}^0\right)\text{\hspace{1em}(24)}$$

---

三、SE(3) 终端滑模控制律 (TSMC) 与有限时间收敛证明 (III. TSMC DESIGN)

3.1 终端滑模面构建与参数约束 (p, q)

在李群 $\mathrm{SE}(3)$ 上，结合指数构型误差与相对速度，定义终端滑模面 $\mathbf{s}(t)\in {\mathbb{R}}^6$：

$$\mathbf{s}=\tilde{\mathbf{\xi }}+\mathbf{C}{\mathrm{sig}}^{q/p}(\tilde{\mathbf{\eta }})\text{\hspace{1em}(25)}$$

其中：

• $\mathbf{C}=\mathrm{diag}(c_1,\dots ,c_6)>0$ 为对角正定增益矩阵；
• 分数幂向量函数定义为分量形式：${\mathrm{sig}}^{q/p}(\tilde{\mathbf{\eta }})=[{\mathrm{sig}}^{q/p}({\tilde{\eta }}_1),\dots ,{\mathrm{sig}}^{q/p}({\tilde{\eta }}_6){]}^{\top }$，其中 ${\mathrm{sig}}^{q/p}(x)=|x{|}^{q/p}\mathrm{sgn}(x)$；
• 参数设计准则：$p,q$ 必须选取为正奇数，且满足 $p<q<2p$（论文仿真中选取 $p=3,q=5$，即 $q/p=5/3\approx 1.667$）。这一选取保证了求导项中幂次 $q/p-1=2/3>0$，从代数机理上彻底避免了原点奇点！

对滑模面求时间导数：

$$\dot{\mathbf{s}}=\dot{\tilde{\mathbf{\xi }}}+\mathbf{A}(\tilde{\mathbf{\eta }})\dot{\tilde{\mathbf{\eta }}}=\dot{\tilde{\mathbf{\xi }}}+\mathbf{A}(\tilde{\mathbf{\eta }})\mathbf{G}(\tilde{\mathbf{\eta }})\tilde{\mathbf{\xi }}\text{\hspace{1em}(26)}$$

其中对角雅可比增益矩阵为：

$$\mathbf{A}(\tilde{\mathbf{\eta }})=\mathrm{diag}\left(\frac{c_{1}q}{p}|{\tilde{\eta }}_1{|}^{q/p-1},\dots ,\frac{c_{6}q}{p}|{\tilde{\eta }}_6{|}^{q/p-1}\right)\ge 0\text{\hspace{1em}(27)}$$

3.2 TSMC 控制律与定理 1 证明

若假定未知环境外扰存在已知常数上界，即 $|{\tau }_{di}|\le F_i$（$i=1,\dots ,6$）。

定理 1 (SE(3) 终端滑模有限时间稳定性)
针对相对耦合动力学系统 (24)，若采用滑模面 (25)，设计 TSMC 控制律为：

$${\mathbf{\tau }}_c=-{\mathbf{\tau }}_g-{\mathrm{ad}}_{\mathbf{\xi }}^{\ast }\mathbb{I}\mathbf{\xi }-\mathbb{I}\left({\mathrm{ad}}_{\tilde{\mathbf{\xi }}}{\mathrm{Ad}}_{{\mathbf{h}}^{-1}}{\mathbf{\xi }}^0-{\mathrm{Ad}}_{{\mathbf{h}}^{-1}}{\dot{\mathbf{\xi }}}^0+\mathbf{A}(\tilde{\mathbf{\eta }})\mathbf{G}(\tilde{\mathbf{\eta }})\tilde{\mathbf{\xi }}\right)-\mathbf{K}\mathrm{sgn}(\mathbf{s})\text{\hspace{1em}(28)}$$

其中切换增益矩阵 $\mathbf{K}=\mathrm{diag}(k_1,\dots ,k_6)$ 满足 $k_i>F_i$。则系统状态轨迹将在有限时间内到达滑模面 $\mathbf{s}(t)=0$，且在滑模面上在有限时间内收敛到期望构型与速度 $(\tilde{\mathbf{\eta }},\tilde{\mathbf{\xi }})=(0,0)$。

证明过程：
构造李雅普诺夫候选函数：

$$V=\frac{1}{2}{\mathbf{s}}^{\top }\mathbb{I}\mathbf{s}\text{\hspace{1em}(29)}$$

对 $V$ 求导并代入动力学 (24) 与控制律 (28)：

$$\begin{array}{rl}\dot{V}& ={\mathbf{s}}^{\top }\mathbb{I}\left(\dot{\tilde{\mathbf{\xi }}}+\mathbf{A}(\tilde{\mathbf{\eta }})\mathbf{G}(\tilde{\mathbf{\eta }})\tilde{\mathbf{\xi }}\right)\\ & ={\mathbf{s}}^{\top }\left[{\mathbf{\tau }}_d-\mathbf{K}\mathrm{sgn}(\mathbf{s})\right]=\sum _{i=1}^6\left({\tau }_{di}{s}_i-k_i|s_i|\right)\\ & \le -\sum _{i=1}^6(k_i-F_i)|s_i|\le -\underset{1\le i\le 6}{\min }(k_i-F_i)\Vert \mathbf{s}{\Vert }_1\\ & \le -\gamma \sqrt{\frac{2}{{\lambda }_{\max }(\mathbb{I})}}{V}^{1/2}\end{array}\text{\hspace{1em}(30)}$$

其中 $\gamma ={\min }_i(k_i-F_i)>0$。根据有限时间稳定性判据，滑模到达时间有严格上界：

$$t_{\mathrm{reach}}\le \frac{2V(0{)}^{1/2}}{\gamma \sqrt{2/{\lambda }_{\max }(\mathbb{I})}}=\frac{\sqrt{2{\lambda }_{\max }(\mathbb{I})}}{\gamma }V(0{)}^{1/2}\text{\hspace{1em}(31)}$$

到达滑模面后，$\tilde{\mathbf{\xi }}=-\mathbf{C}{\mathrm{sig}}^{q/p}(\tilde{\mathbf{\eta }})$，由运动学 $\dot{\tilde{\mathbf{\eta }}}=-\mathbf{G}(\tilde{\mathbf{\eta }})\mathbf{C}{\mathrm{sig}}^{q/p}(\tilde{\mathbf{\eta }})$ 保证误差在第二阶段有限时间收敛到零。证毕。

3.3 连续饱和边界层消除抖振

由于符号函数 $\mathrm{sgn}(s_i)$ 在滑模面法向发生高频不连续切换，会激发出推力器高频抖振。论文采用连续边界层饱和函数替代：

$$\mathrm{sat}(s_i,ϵ)=\{\begin{array}{ll}{s}_i/ϵ,& |s_i|\le ϵ\\ \mathrm{sgn}(s_i),& |s_i|>ϵ\end{array}\text{\hspace{1em}(32)}$$

其中 $ϵ$ 为薄边界层厚度（仿真中取 $10^{-3}$），将控制量平滑化，系统状态收敛至边界层内准滑模态。

---

四、鲁棒自适应终端滑模控制 (RATSMC) 与到达律设计 (IV. RATSMC DESIGN)

在真实深空环境中，未知干扰上界 $F_i$ 往往难以先验测量，且人为放大增益 $k_i$ 会导致控制力严重溢出。为此，Lee 2015 提出了全自适应 RATSMC 方案。

4.1 未知干扰上界自适应快速终端到达律

设计带有自适应估计项的快速双幂次到达律：

$$\dot{\mathbf{s}}(t)=-{\mathbf{K}}_1\mathbf{s}-{\mathbf{K}}_2{\mathrm{sig}}^{q/p}(\mathbf{s})-{\mathrm{sgn}}_{6\times 2}(\mathbf{s})\widehat{\bar{\mathbf{d}}}\text{\hspace{1em}(33)}$$

其中：

• ${\mathbf{K}}_1\in {\mathbb{R}}^{6\times 6},{\mathbf{K}}_2\in {\mathbb{R}}^{6\times 6}$ 为正定对角增益矩阵；
• $\widehat{\bar{\mathbf{d}}}=[{\hat{\bar{T}}}_d,{\hat{\bar{F}}}_d{]}^{\top }\in {\mathbb{R}}^2$ 为外界扰动力矩与扰动推力上界的在线动态估计值；
• 投影符号矩阵 ${\mathrm{sgn}}_{6\times 2}(\mathbf{s})\in {\mathbb{R}}^{6\times 2}$ 定义为：

$${\mathrm{sgn}}_{6\times 2}(\mathbf{s})=\left[\begin{array}{cc}\mathrm{sgn}(s_1)& 0\\ \mathrm{sgn}(s_2)& 0\\ \mathrm{sgn}(s_3)& 0\\ 0& \mathrm{sgn}(s_4)\\ 0& \mathrm{sgn}(s_5)\\ 0& \mathrm{sgn}(s_6)\end{array}\right]\text{\hspace{1em}(34)}$$

4.2 RATSMC 控制律与参数更新律设计

定理 2 (RATSMC 鲁棒自适应控制与有限时间稳定)
针对系统 (24)，在外界扰动上界 $\bar{\mathbf{d}}=[{\bar{T}}_d,{\bar{F}}_d{]}^{\top }$ 未知的情况下，设计控制器与自适应更新律：

$$\{\begin{array}{l}{\mathbf{\tau }}_c=-[{\mathbf{\tau }}_g+{\mathrm{ad}}_{\mathbf{\xi }}^{\ast }\mathbb{I}\mathbf{\xi }+\mathbb{I}\left({\mathrm{ad}}_{\tilde{\mathbf{\xi }}}{\mathrm{Ad}}_{{\mathbf{h}}^{-1}}{\mathbf{\xi }}^0-{\mathrm{Ad}}_{{\mathbf{h}}^{-1}}{\dot{\mathbf{\xi }}}^0+\mathbf{A}(\tilde{\mathbf{\eta }})\mathbf{G}(\tilde{\mathbf{\eta }})\tilde{\mathbf{\xi }}\right)\\ +{\mathbf{K}}_1\mathbf{s}+{\mathbf{K}}_2{\mathrm{sig}}^{q/p}(\mathbf{s})+{\mathrm{sgn}}_{6\times 2}(\mathbf{s})\widehat{\bar{\mathbf{d}}}]\\ \dot{\widehat{\bar{\mathbf{d}}}}=\mathbf{\Psi }{\mathrm{sgn}}_{2\times 6}(\mathbf{s})\mathbf{s}=\mathbf{\Psi }\left[\begin{array}{c}{\sum }_{i=1}^3|s_i|\\ {\sum }_{i=4}^6|s_i|\end{array}\right]\end{array}\text{\hspace{1em}(35)}$$

其中 $\mathbf{\Psi }=\mathrm{diag}({\psi }_1,{\psi }_2)>0$ 为自适应学习率矩阵。该控制律可保证系统误差与滑模面在有限时间内收敛到零。

4.3 复合李雅普诺夫函数证明与调节时间解析上界

定义参数估计误差向量 $\widetilde{\stackrel{ˉ}{\mathbf{d}}}=\widehat{\bar{\mathbf{d}}}-\bar{\mathbf{d}}$。构建复合 Lyapunov 函数：

$$V_2=\frac{1}{2}{\mathbf{s}}^{\top }\mathbb{I}\mathbf{s}+\frac{1}{2}{\widetilde{\stackrel{ˉ}{\mathbf{d}}}}^{\top }{\mathbf{\Psi }}^{-1}\widetilde{\stackrel{ˉ}{\mathbf{d}}}\text{\hspace{1em}(36)}$$

对时间求导：

$${\dot{V}}_2={\mathbf{s}}^{\top }\mathbb{I}\left(\dot{\tilde{\mathbf{\xi }}}+\mathbf{A}\mathbf{G}\tilde{\mathbf{\xi }}\right)+{\widetilde{\stackrel{ˉ}{\mathbf{d}}}}^{\top }{\mathbf{\Psi }}^{-1}\dot{\widehat{\bar{\mathbf{d}}}}\text{\hspace{1em}(37)}$$

将动力学 (24) 与控制律 (35) 代入：

$$\begin{array}{rl}{\dot{V}}_2& ={\mathbf{s}}^{\top }\left[{\mathbf{\tau }}_d-{\mathbf{K}}_1\mathbf{s}-{\mathbf{K}}_2{\mathrm{sig}}^{q/p}(\mathbf{s})-{\mathrm{sgn}}_{6\times 2}(\mathbf{s})\widehat{\bar{\mathbf{d}}}\right]+{\widetilde{\stackrel{ˉ}{\mathbf{d}}}}^{\top }{\mathbf{\Psi }}^{-1}\left(\mathbf{\Psi }{\mathrm{sgn}}_{2\times 6}(\mathbf{s})\mathbf{s}\right)\\ & =-{\mathbf{s}}^{\top }{\mathbf{K}}_1\mathbf{s}-{\mathbf{s}}^{\top }{\mathbf{K}}_2{\mathrm{sig}}^{q/p}(\mathbf{s})+{\mathbf{s}}^{\top }{\mathbf{\tau }}_d-{\widehat{\bar{\mathbf{d}}}}^{\top }{\mathrm{sgn}}_{2\times 6}(\mathbf{s})\mathbf{s}+(\widehat{\bar{\mathbf{d}}}-\bar{\mathbf{d}}{)}^{\top }{\mathrm{sgn}}_{2\times 6}(\mathbf{s})\mathbf{s}\\ & =-{\mathbf{s}}^{\top }{\mathbf{K}}_1\mathbf{s}-{\mathbf{s}}^{\top }{\mathbf{K}}_2{\mathrm{sig}}^{q/p}(\mathbf{s})+\left[{\mathbf{s}}^{\top }{\mathbf{\tau }}_d-{\bar{\mathbf{d}}}^{\top }{\mathrm{sgn}}_{2\times 6}(\mathbf{s})\mathbf{s}\right]\end{array}\text{\hspace{1em}(38)}$$

由于 ${\mathbf{s}}^{\top }{\mathbf{\tau }}_d={\sum }_{i=1}^3{s}_i{T}_{di}+{\sum }_{i=4}^6{s}_i{F}_{di}\le {\bar{T}}_d{\sum }_{i=1}^3|s_i|+{\bar{F}}_d{\sum }_{i=4}^6|s_i|={\bar{\mathbf{d}}}^{\top }{\mathrm{sgn}}_{2\times 6}(\mathbf{s})\mathbf{s}$，方括号内的项恒小于等于零！因此：

$${\dot{V}}_2\le -{\mathbf{s}}^{\top }{\mathbf{K}}_1\mathbf{s}-{\mathbf{s}}^{\top }{\mathbf{K}}_2{\mathrm{sig}}^{q/p}(\mathbf{s})\le 0\text{\hspace{1em}(39)}$$

系统李雅普诺夫导数严格半负定，参数估计误差有界。一旦滑模量进入微小区间，由到达律诱导的滑模面李雅普诺夫函数 $V_s=\frac{1}{2}{\mathbf{s}}^{\top }\mathbb{I}\mathbf{s}$ 满足：

$${\dot{V}}_s<-2{\underline{k}}_1{V}_s-2^{(q/p+1)/2}{\underline{k}}_2{V}_s^{(q/p+1)/2}\text{\hspace{1em}(40)}$$

根据快速微分包含定理，系统到达滑模面的显式有限调节时间上界为：

$$t_s\le \frac{1}{{\underline{k}}_2(1-q/p)}\ln \frac{{\underline{k}}_1{V}_{s0}^{(1-q/p)/2}+2^{(q/p-1)/2}{\underline{k}}_2}{2^{(q/p-1)/2}{\underline{k}}_2}\text{\hspace{1em}(41)}$$

其中 ${\underline{k}}_1={\lambda }_{\min }({\mathbf{K}}_1),{\underline{k}}_2={\lambda }_{\min }({\mathbf{K}}_2)$。

---

五、执行机构物理输入饱和约束处理 (V. ACTUATOR SATURATION)

图 2：执行机构控制力矩与控制推力分量独立硬饱和特性曲线。

5.1 力矩与推力分量独立饱和指示矩阵 χ(τ)

在真实航天器平台上，推进系统无法提供无限大的加速度。若计算出的控制指令超出物理极限，实际执行机构将发生硬饱和截断：

$$\mathrm{satc}({\mathbf{\tau }}_c)=\left[\begin{array}{c}\mathrm{satc}({\mathbf{T}}_c)\\ \mathrm{satc}({\mathbf{F}}_c)\end{array}\right]\in {\mathbb{R}}^6\text{\hspace{1em}(42)}$$

各分量饱和截断定义为：

$$\{\begin{array}{ll}\mathrm{satc}(T_{ci})=\{\begin{array}{ll}{T}_{c,\max }\mathrm{sgn}(T_{ci}),& |T_{ci}|>T_{c,\max }\\ T_{ci},& |T_{ci}|\le T_{c,\max }\end{array},& i=1,2,3\\ \mathrm{satc}(F_{ci})=\{\begin{array}{ll}{F}_{c,\max }\mathrm{sgn}(F_{ci}),& |F_{ci}|>F_{c,\max }\\ F_{ci},& |F_{ci}|\le F_{c,\max }\end{array},& i=1,2,3\end{array}\text{\hspace{1em}(43)}$$

引入对角饱和指示矩阵 $\mathbf{\chi }({\mathbf{\tau }}_c)\in {\mathbb{R}}^{6\times 6}$，使得 $\mathrm{satc}({\mathbf{\tau }}_c)=\mathbf{\chi }({\mathbf{\tau }}_c){\mathbf{\tau }}_c$：

$${\chi }_i({\mathbf{\tau }}_c)=\{\begin{array}{ll}\min \left(1,\frac{T_{c,\max }}{|T_{ci}|}\right),& i=1,2,3\\ \min \left(1,\frac{F_{c,\max }}{|F_{c,i-3}|}\right),& i=4,5,6\end{array}\text{\hspace{1em}(44)}$$

显然 $0<{\chi }_i\le 1$。当 ${\chi }_i=1$ 时表示该通道未饱和；当 ${\chi }_i\to 0$ 时表示该通道深度饱和。

5.2 控制主导性假设与饱和稳定性

假设 2 (控制物理主导性)
执行机构的最大可用物理出力严格大于环境未知外扰的最大极值：

$$T_{c,\max }>T_{d,\max },F_{c,\max }>F_{d,\max }\text{\hspace{1em}(45)}$$

在假设 2 成立的前提下，即使控制器在机动初期发生推力饱和，执行器依然提供沿着滑模流态反向的最大有效恢复力矩/推力，保证了系统的能量函数单调递减，最终退出饱和区并渐进平稳着陆到滑模面上。

---

六、本地 Python 完整复现与莫尼娅高偏心率轨道基准仿真 (VI. NUMERICAL BENCHMARKS)

为全景重现 Lee 2015 论文的所有实验，我们在本地工程库构建了高精度仿真验证平台。

6.1 莫尼娅（Molniya）极高偏心率轨道测试基准

目标主航天器运行于一条典型的高偏心率莫尼娅轨道上（周期约 12 小时），近地点与远地点高度差异巨大，引力场摄动极为剧烈。

表 1：主航天器莫尼娅轨道初始六根数

轨道六根数	物理参数值	说明
半长轴 $a$	$26,628\mathrm{km}$	临界倾角椭圆轨道
偏心率 $e$	$0.7417$	极高偏心率，速度变化剧烈
轨道倾角 $i$	$63.4^{\circ }$	冻结近地点漂移
升交点赤经 $\Omega$	$0^{\circ }$	初始节点
近地点幅角 ${\omega }_p$	$-90^{\circ }$	远地点位于北半球高纬度
真近点角 $\nu$	$120^{\circ }$	初始真近点角

表 2：物理参数、初始工况与控制器增益配置

参数大类	参数符号与变量名	取值与量纲
主星参数	$m^0,{\mathbf{J}}^0$	$56.7\mathrm{kg},\mathrm{diag}(4.85,5.10,4.76)\mathrm{kg}\cdot {\mathrm{m}}^2$
从星参数	$m,\mathbf{J}$	$60.7\mathrm{kg},\mathrm{diag}(4.85,4.76,5.10)\mathrm{kg}\cdot {\mathrm{m}}^2$
惯量失配	$\Delta \mathbf{J}$	$+30\%$ 对角惯量模型误差（测试强鲁棒性）
初始相对位姿	${\mathbf{p}}_r(0),{\theta }_r(0)$	$[-300,1000,100{]}^{\top }\mathrm{m}$ (初始相距 $1048\mathrm{m}$)，姿态误差 $120^{\circ }$
初始相对速度	${\mathbf{v}}_r(0),{\mathbf{\omega }}_r(0)$	$[3.10,1.47,-1.95{]}^{\top }m/s$，角速度 $10^{-3}\times [0.036,0.176,0.264{]}^{\top }rad/s$
执行器硬限幅	$T_{c,\max },F_{c,\max }$	$0.1\mathrm{N}\cdot \mathrm{m}$（力矩限幅），$0.607\mathrm{N}$（推力限幅）
控制器参数	$p,q,\mathbf{C},{\mathbf{K}}_1,\mathbf{\Psi }$	$p=3,q=5,\mathbf{C}=0.076{\mathbf{I}}_6,{\mathbf{K}}_1=0.12{\mathbf{I}}_6,\mathbf{\Psi }=\mathrm{diag}(5\times 10^{-3},5\times 10^{-7})$
外扰时变模型	${\mathbf{\tau }}_d(t)$	幅值 $10^{-5}\mathrm{N}\cdot \mathrm{m}$（力矩）与 $10^{-4}\mathrm{N}$（推力）的多频正弦叠加

6.2 仿真图表深度全景对比分析

本地 Python 仿真时长设定为 $t_f=3600\mathrm{s}$（1 小时），步长 $\Delta t=0.1\mathrm{s}$，积分器采用高保真 Runge-Kutta 求解器。

1. 外界干扰力矩/推力与自适应上界估计响应 (Fig 3)

图 3：时变外部环境干扰（多频叠加）及其自适应上界估计值 $({\widehat{\bar{\mathbf{d}}}}_{\tau },{\widehat{\bar{\mathbf{d}}}}_{\varphi })$ 的时间演化历程。

机制透视：如图 3 所示，自适应估计器在初值设为 $0$ 的情况下，随着滑模面残差的积分迅速单调抬升，并在约 $200\mathrm{s}$ 内平稳收敛到包裹真实外部扰动的安全上界之上。值得注意的是，自适应参数并没有无休止地发散发热，这是因为一旦滑模面收敛至零，${\mathrm{sgn}}_{2\times 6}(\mathbf{s})\mathbf{s}=0$，更新导数自然停止更新，表现出极佳的数值稳定性。

2. 相对位置与速度跟踪误差收敛曲线 (Fig 4)

图 4：相对期望位置的位置跟踪误差范数 (a) 与相对速度跟踪误差范数 (b) 对比曲线。

指标考据：追踪星从相距 $1048\mathrm{m}$ 的初始距离出发，在 RATSMC 控制下在 $3000\mathrm{s}$ 内将位置误差压低至 $0.15\mathrm{m}$ 以内，末端进入对接走廊时误差仅为 $0.030\mathrm{m}$；相对速度在终端被精确减速至 $0.015m/s$，完全满足了 ATV-ISS 欧洲空间站小于 $0.02m/s$ 的严苛横向软对接速度指标。相比之下，传统 TSMC 的末端位置误差高达 $0.405\mathrm{m}$，发生明显超调。

3. 相对姿态与角速度跟踪误差收敛曲线 (Fig 5)

图 5：相对主航天器的姿态旋转误差范数 (a) 与相对角速度误差范数 (b) 对比曲线。

姿态优先特征：姿态同步在 $300\mathrm{s}$（5 分钟）之内即迅速完成，姿态跟踪误差降低至 $0.015^{\circ }$，角速度误差降低至 $2\times 10^{-6}rad/s$。这在航天物理上具有鲜明的设计意图：必须先完成对接口的视线指向对准，再执行轴向逼近推进，防止了在姿态偏转状态下推进导致的“越推越偏”现象。

4. 控制力矩、推力及范数对比 (Fig 6)

图 6：(a) RATSMC 各通道力矩与推力时域波形；(b) RATSMC 与 TSMC 的控制力矩与推力范数对比。

饱和与平滑表现：如图 6(a) 所示，在机动初始的 $0\sim 50\mathrm{s}$ 内，推力分量触及物理上限 $0.607\mathrm{N}$，饱和指示函数 $\mathbf{\chi }({\mathbf{\tau }}_c)$ 启动；随后随着速度误差减小退出饱和，平稳衰减至维持轨道扰动所需的 $0.04\mathrm{N}$ 平衡推力。借助连续边界层，输出信号没有任何令人望而生畏的高频高阶切换震颤。

5. 控制能量时间积分与燃料节约突破 (Fig 7)

图 7：控制力矩与控制推力时间积分（推进剂累积消耗）对比曲线。

表 3：RATSMC 与经典 TSMC 关键终值性能指标对比

终值考核指标	论文基准 RATSMC	传统固定增益 TSMC	提升幅度 / 工业评价
末端相对姿态误差 $\Vert \mathbf{\Theta }(t_f)\Vert$	$0.015^{\circ }$	$0.016^{\circ }$	极高精度同步 ($<5^{\circ }$ 标准)
末端相对位置误差 $\Vert {\mathbf{p}}_e(t_f)\Vert$	$0.030\mathrm{m}$	$0.405\mathrm{m}$	精度提升 13.5 倍 ($<0.10\mathrm{m}$ 标准)
末端相对线速度 $\Vert {\mathbf{v}}_e(t_f)\Vert$	$0.015m/s$	$0.016m/s$	达成安全软对接接触速度
末端相对角速度 $\Vert {\mathbf{\omega }}_e(t_f)\Vert$	$3.0\times 10^{-5}rad/s$	$4.05\times 10^{-4}rad/s$	角速率抖动降低一个数量级
特征速度增量 $\Delta v=\int \frac{\Vert {\mathbf{F}}_c\Vert }{m}\mathrm{d}t$	$5.915m/s$	$13.905m/s$	节省推进剂 $57.5\%$（突破性成效）
力矩时间积分 $\int \Vert {\mathbf{T}}_c\Vert \mathrm{d}t$	$0.321\mathrm{N}\cdot \mathrm{m}\cdot \mathrm{s}$	$0.314\mathrm{N}\cdot \mathrm{m}\cdot \mathrm{s}$	力矩消耗相当，姿态均表现优异

6. 空间六自由度相对位姿三维逼近轨迹 (Fig 8)

图 8：航天器六自由度相对位形三维机动轨迹（本体坐标系沿飞行轨迹分布）。

机动空间全景：图 8 绘制了追踪星在 $0\mathrm{s},300\mathrm{s},600\mathrm{s},900\mathrm{s},3600\mathrm{s}$ 时的本体姿态三维指向。追踪星首先在前 $300\mathrm{s}$ 调整姿态，使得本体坐标系 $\{\mathcal{B}\}$ 迅速与目标星 $\{{\mathcal{B}}^0\}$ 平行对齐，随后沿平滑的空间测地流线在姿态锁定的状态下平稳减速巡航，最终实现对目标对接端口的平稳进近。

7. 滑模面分量与模长演化过程

图 9：本地复现仿真输出的终端滑模面六个分量时域收敛历程。

图 10：本地复现仿真输出的终端滑模面总范数 $\Vert \mathbf{s}(t)\Vert$ 演化历程。

---

七、核心代码实现解剖与工程踩坑指南 (VII. SOURCE CODE & ENGINEERING PITFALLS)

在本地工程库 projects/AstroSMC/reproduction_rendezvous_and_docking/Lee_2015_Robust_Adaptive_Control_on_SE3/ 中，核心控制器封装在 src/controller.py 中。以下梳理工程落地的四大关键核心：

7.1 无状态控制器评估器设计 (Stateless Controller)

在调用 SciPy 的 solve_ivp 或高阶 Runge-Kutta 变步长积分器时，如果控制器内部维护了私有演化状态，一旦积分步长因局部误差过大而发生试探步回滚 (Step Retry)，控制器内部的状态将被错误推进，破坏确定性！ 为此，我们将二维自适应扰动估计变量 $\widehat{\bar{\mathbf{d}}}=[{\hat{\bar{T}}}_d,{\hat{\bar{F}}}_d{]}^{\top }$ 提升为与系统状态向量并列的 ODE 全局微分状态：

# 状态向量整体拼接：16 维微分流形状态
# state = [eta (6D), relative_twist (6D), leader_pose (16D flat), leader_twist (6D), disturbance_bound (2D)]
def system_ode(t, y):
    eta = y[0:6]
    xi_e = y[6:12]
    d_hat = y[-2:]  # 扰动上界自适应变量作为 ODE 状态演化
    
    # 无状态评估控制器
    res = controller.evaluate(
        eta=eta,
        relative_twist=xi_e,
        disturbance_bound_estimate=d_hat,
        ...
    )
    # 返回对应的导数，包括 d_hat 的更新率
    return np.hstack([d_eta, d_xi_e, ..., res["estimate_derivative"]])

7.2 李代数指数映射与伴随缓存优化

在单步控制计算中，相对姿态逆矩阵与伴随矩阵 inv_SE3、Ad_SE3_m、G(eta) 被多个动力学校正项共同调用：

# 缓存变换，避免在一拍中执行多次 6x6 密集伴随矩阵与奇异值分解计算
error_pose = exp_se3(relative_pose_error_coords)
relative_pose = h_d @ error_pose
inv_relative_pose = inv_SE3(relative_pose)
Ad_inv_rel = Ad_SE3_m(inv_relative_pose)

# 牵连速度与加速度投影
transported_leader_twist = Ad_inv_rel @ leader_twist
transported_leader_acceleration = Ad_inv_rel @ leader_acceleration

7.3 分数幂符号保持与数值防溢出

在计算 ${\mathrm{sig}}^{q/p}(\mathbf{x})$ 与雅可比 $\mathbf{A}(\mathbf{\eta })$ 时，必须严格使用带符号的绝对值幂次：

def signed_power(val: np.ndarray, power: float) -> np.ndarray:
    # 计算 sig^power(x) = |x|^power * sgn(x)
    return np.abs(val) ** power * np.sign(val)

# 避免在 eta 极度接近 0 时出现 0 ** (负数)
power_deriv = self.power - 1.0  # q/p - 1 = 5/3 - 1 = 2/3 > 0
lambda_diag = self.power * np.diag(C) * (np.abs(eta) ** power_deriv)

---

八、深度学术述评、局限性批判与未来演进 (VIII. CRITICAL REVIEW & OUTLOOK)

作为发表于 2015 年的奠基之作，Lee 2015 的 RATSMC 方案在国际控制界树立了流形滑模控制的标准范式，但用现代几何非线性控制（2024–2026）的最高学术标准审视，该工作依然存在若干值得深思的理论断代与技术局限性：

8.1 奇异性规避与“几乎全局 (Almost-Global)”的几何本质

论文在引言与定理中反复强调“除相对转角为 $\pi$ 弧度之外，在全状态空间实现收敛”。 这是由李群的微分几何拓扑本质所决定的：

• 三维旋转李群 $\mathrm{SO}(3)$ 拓扑同胚于实射影空间 ${\mathbb{RP}}^3$，它是紧致无边界的非欧流形；
• 根据微分拓扑学的布劳威尔不动点定理（Poincaré-Hopf 定理），在紧致光滑流形上不存在任何全局连续的状态反馈向量场能够实现单平衡点的全局渐近稳定；
• 对数映射 $\mathrm{logm}$ 在对径割迹（Cut Locus，即转角 $\Vert \mathbf{\theta }\Vert =\pi$）处失去单射性。虽然这一割迹在测度意义下是零测集（Lebesgue measure zero），从而满足“几乎全局（Almost-Global）”的学术声称，但在工程对抗极端工况下，若追踪星以接近 $180^{\circ }$ 的姿态偏差启动，数值对数求解器可能发生剧烈跳变。

8.2 缺乏持续激励 (PE) 导致的扰动上界“伪收敛”

从图 3 的仿真曲线可以清晰看出，自适应扰动估计值 $\widehat{\bar{\mathbf{d}}}$ 虽然保持有界并趋于常数，但其最终数值并未收敛至真实的扰动峰值。 这是自适应控制系统未满足持续激励（Persistently Exciting, PE）条件时的经典特征：

• 自适应更新律 $\dot{\widehat{\bar{\mathbf{d}}}}=\mathbf{\Psi }[\Vert {\mathbf{s}}_{\tau }{\Vert }_1,\Vert {\mathbf{s}}_{\varphi }{\Vert }_1{]}^{\top }$ 只有在状态处于滑模面之外时才驱动；
• 一旦系统进入准滑动模态，驱动信号归零，参数估计便“冻结”在当前值；
• 这种估计本质上是“保证李雅普诺夫导数定负的最小保守集”，而非真实外界扰动的精确观测器。这也是为什么在随后的技术演进中，几何扩张状态观测器 (SE(3)-ESO) 与非线性扰动观测器 (NDOB) 逐渐取代纯自适应律，成为更高阶抗扰方案的原因。

8.3 终端滑模 (TSM) 到固定时间 / 预设时间控制的技术代际跨越

在式 (41) 给出的调节时间估计公式中：

$$t_s\le \mathcal{O}\left(\ln \frac{{\underline{k}}_1{V}_0^{1-q/p}+{\underline{k}}_2}{{\underline{k}}_2}\right)$$

调节时间 $t_s$ 高度依赖于系统的初始状态 $V(0)$！

• 如果初始位置误差不是 $1\mathrm{km}$ 而是 $10\mathrm{km}$，或者初始角速度增加数倍，有限收敛时间将大幅后延；
• 在空间非合作目标紧急捕获等窗口极其严苛的任务中，“初始状态依赖”可能导致对接超期失控；
• 这直接推动了后继研究向**固定时间滑模（Fixed-Time SMC，收敛时间存在独立于初始条件的固定常数上界）与预设时间滑模（Prescribed-Time SMC，用户任意显式预设指定收敛秒数）**的大步迈进。

8.4 对现代几何 CDDP 与管状 NMPC 的反哺价值

即便如此，Lee 2015 贡献的指数坐标动力学精确分离表示、引理 1 的 $G(\eta )\eta =\eta$ 代数抵消特性、以及针对力矩/推力的双通道分块矩阵设计，成为了现代几何模型预测控制（Geometric NMPC）和约束微分动态规划（Geometric CDDP）设计中极高价值的辅助底层原语（Ancillary Feedforward/Feedback Primitives）。通过将李群几何拓扑的保形特性与变结构滑模的超强抗扰能力深度融合，Lee 2015 无愧为空间航天器几何流形控制领域的一座经典学术里程碑。