现代几何最优控制论文写作规范与范式手册

📌 导读与使用说明
本文旨在为后续面向 IEEE Transactions on Automatic Control (TAC)、Automatica、IEEE Transactions on Robotics (T-RO) 以及 IEEE TAES 等控制与航空航天顶刊发表的 Chu_2024（基于 LGR 配点的 SE(3) 几何 NMPC）与 Chu_2026（SE(3) 几何约束 DDP）系列论文提供一套标准化的数学符号体系、问题描述模板、审稿防守策略与 LaTeX 源码库。
本手册在吸收消化经典文献（Bullo 2019 [6]、Kobilarov 2011 [8]、Boutselis 2020 [12]、Teng 2022 [13,14]、Alcan 2023 [26]）优良结构的基础上，系统性补全了工业界论文常被理论审稿人挑刺的“左右平凡化歧义、对偶伴随映射缺失、数值离散破坏流形正交性”等学术薄弱环节。

---

目录

1. 顶刊写作架构与核心符号规范 (Notations)
2. 标准第二节：数学预备知识与李代数工具 (Preliminaries)
3. 标准第三节：切丛流形动力学与最优控制问题描述 (Problem Formulation)
4. 文献横向对比与四大理论升华 (Comparison & Critical Upgrades)
5. 顶级审稿人高频质询防御指南 (Reviewer Defense Playbook)
6. 现成 LaTeX 宏与英文论文高分句式库 (LaTeX & Phrasing Toolkit)

---

1 顶刊写作架构与核心符号规范 (Notations)

在几何控制领域，审稿人打开论文的第一件事就是审查第 II 节（Preliminaries）与第 III 节（Problem Formulation）。优秀的论文应当在前两页以最紧凑、无歧义的现代数学语言确立全篇基调。

1.1 核心状态与旋量顺序公理（必须白纸黑字声明）

在论文的符号约定段落（Notations），必须白纸黑字写明以下三项公理，彻底杜绝歧义：

1. 旋量排序（Twist Ordering）： 空间或机体系广义速度（Twist）统一采用角速度在前、线速度在后的国际标准：

   $$\xi =\left[\begin{array}{c}\omega \\ v\end{array}\right]\in {\mathbb{R}}^6,\omega \in {\mathbb{R}}^3,v\in {\mathbb{R}}^3$$

   (绝不留给审稿人猜测是 $[v^{\top },{\omega }^{\top }{]}^{\top }$ 还是 $[{\omega }^{\top },v^{\top }{]}^{\top }$ 的空间)。

2. 平凡化约定（Trivialization Choice）： 明确声明采用机体固定坐标系（Body-fixed Frame / Left-trivialization）：

   $$\dot{g}=g{\xi }^{\wedge }⟺{\xi }^{\wedge }=g^{-1}\dot{g}\in \mathfrak{se}(3)$$

   若采用空间系（Spatial / Right-trivialization），则对应 $\dot{g}={\xi }_s^{\wedge }g$。全篇数学推导、李代数伴随与控制器实现必须 100% 保持体坐标系一致。

3. 对偶伴随映射转置约定（Dual Adjoint Convention）： 针对标准内积诱导的对偶配对 $⟨\eta ,{\mathrm{ad}}_{\xi }\zeta ⟩=⟨{\mathrm{ad}}_{\xi }^{\ast }\eta ,\zeta ⟩$，在李代数矩阵表示下满足：

   $${\mathrm{ad}}_{\xi }^{\ast }=({\mathrm{ad}}_{\xi }{)}^{\top }$$

---

2 标准第二节：数学预备知识与李代数工具 (Preliminaries)

💡 论文参考写法模板（可直接中英翻译后放入 Manuscript Section II）：

II. MATHEMATICAL PRELIMINARIES AND GEOMETRIC NOTATIONS

A. 刚体构型空间 $\mathrm{SE}(3)$ 与李代数 $\mathfrak{se}(3)$

三维空间刚体的位姿演化由特殊欧几里得李群 $\mathrm{SE}(3)\cong \mathrm{SO}(3)⋉{\mathbb{R}}^3$ 严格刻画，其群元素及其逆元表示为：

$$g=\left[\begin{array}{cc}R& p\\ 0_{1\times 3}& 1\end{array}\right]\in \mathrm{SE}(3),g^{-1}=\left[\begin{array}{cc}{R}^{\top }& -R^{\top }p\\ 0_{1\times 3}& 1\end{array}\right]$$

其中 $R\in \mathrm{SO}(3)=\{R\in {\mathbb{R}}^{3\times 3}\mid R^{\top }R=I_3,\det (R)=1\}$ 为姿态旋转矩阵，$p\in {\mathbb{R}}^3$ 为位置向量。

李代数 $\mathfrak{se}(3)\cong T_I\mathrm{SE}(3)$ 是李群在单位元处的切空间。定义向量空间同构算子 $(\cdot {)}^{\wedge }:{\mathbb{R}}^6\to \mathfrak{se}(3)$ 与逆算子 $(\cdot {)}^{\vee }:\mathfrak{se}(3)\to {\mathbb{R}}^6$：

$${\xi }^{\wedge }={\left[\begin{array}{c}\omega \\ v\end{array}\right]}^{\wedge }=\left[\begin{array}{cc}{\omega }^{\wedge }& v\\ 0_{1\times 3}& 0\end{array}\right]\in \mathfrak{se}(3),({\xi }^{\wedge }{)}^{\vee }=\xi \in {\mathbb{R}}^6$$

其中 ${\omega }^{\wedge }\in \mathfrak{so}(3)$ 为标准反对称矩阵（Skew-symmetric Matrix）：

$${\omega }^{\wedge }=\left[\begin{array}{ccc}0& -{\omega }_3& {\omega }_2\\ {\omega }_3& 0& -{\omega }_1\\ -{\omega }_2& {\omega }_1& 0\end{array}\right]\in \mathfrak{so}(3)$$

满足对任意 $y\in {\mathbb{R}}^3$，${\omega }^{\wedge }y=\omega \times y$。

B. 指数映射、对数映射与测地线度量

李代数与李群之间的局部微分同胚由群指数映射 $\mathrm{Exp}(\cdot ):{\mathbb{R}}^6\to \mathrm{SE}(3)$ 与群对数映射 $\mathrm{Log}(\cdot ):\mathrm{SE}(3)\to {\mathbb{R}}^6$ 给出：

$$\mathrm{Exp}(\xi )\triangleq \mathrm{expm}({\xi }^{\wedge })=\left[\begin{array}{cc}\exp ({\omega }^{\wedge })& V(\omega )v\\ 0_{1\times 3}& 1\end{array}\right]$$ $$\mathrm{Log}(g)\triangleq \mathrm{logm}(g{)}^{\vee }=\left[\begin{array}{c}\log (R{)}^{\vee }\\ V(\omega {)}^{-1}p\end{array}\right]\in {\mathbb{R}}^6$$

其中 $\exp ({\omega }^{\wedge })$ 由经典的 Rodrigues 旋转公式封闭给出：

$$\exp ({\omega }^{\wedge })=I_3+\frac{\sin \Vert \omega \Vert }{\Vert \omega \Vert }{\omega }^{\wedge }+\frac{1-\cos \Vert \omega \Vert }{\Vert \omega {\Vert }^2}({\omega }^{\wedge }{)}^2$$

平移解耦矩阵 $V(\omega )$ 满足：

$$V(\omega )=I_3+\frac{1-\cos \Vert \omega \Vert }{\Vert \omega {\Vert }^2}{\omega }^{\wedge }+\frac{\Vert \omega \Vert -\sin \Vert \omega \Vert }{\Vert \omega {\Vert }^3}({\omega }^{\wedge }{)}^2$$

流形上两点 $g_1,g_2\in \mathrm{SE}(3)$ 之间的内蕴李代数测地线度量定义为：

$$d_{\mathrm{SE}(3)}(g_1,g_2)\triangleq \Vert \mathrm{Log}(g_1^{-1}{g}_2){\Vert }_P=\sqrt{\mathrm{Log}(g_1^{-1}{g}_2{)}^{\top }P\mathrm{Log}(g_1^{-1}{g}_2)}$$

其中 $P\succ 0$ 为正定权重矩阵。当旋转角满足 $\Vert \log (R{)}^{\vee }\Vert <\pi$ 时，对数映射处于严格单射微分同胚区域内，无奇异性。

C. 大伴随作用、伴随映射与对偶伴随映射

伴随算子在多坐标系旋量变换与非线性动力学推导中起着枢纽作用：

1. 李群大伴随作用 ${\mathrm{Ad}}_g:\mathfrak{se}(3)\to \mathfrak{se}(3)$：
   表示参考系刚体变换对切向量的基底变换：

   $$({\mathrm{Ad}}_g\xi {)}^{\wedge }\triangleq g{\xi }^{\wedge }{g}^{-1}⟺{\mathrm{Ad}}_g=\left[\begin{array}{cc}R& 0_{3\times 3}\\ p^{\wedge }R& R\end{array}\right]\in {\mathbb{R}}^{6\times 6}$$

2. 李代数小伴随映射 ${\mathrm{ad}}_{\xi }:\mathfrak{se}(3)\to \mathfrak{se}(3)$：
   由李括号诱导的切空间线性自同构：

   $$({\mathrm{ad}}_{\xi }\eta {)}^{\wedge }\triangleq [{\xi }^{\wedge },{\eta }^{\wedge }]={\xi }^{\wedge }{\eta }^{\wedge }-{\eta }^{\wedge }{\xi }^{\wedge }⟺{\mathrm{ad}}_{\xi }=\left[\begin{array}{cc}{\omega }^{\wedge }& 0_{3\times 3}\\ v^{\wedge }& {\omega }^{\wedge }\end{array}\right]\in {\mathbb{R}}^{6\times 6}$$

3. 对偶伴随映射 ${\mathrm{ad}}_{\xi }^{\ast }:\mathfrak{se}(3{)}^{\ast }\to \mathfrak{se}(3{)}^{\ast }$（刚体动力学的核心工具）：
   根据李代数配对 $⟨\mu ,{\mathrm{ad}}_{\xi }\eta ⟩=⟨{\mathrm{ad}}_{\xi }^{\ast }\mu ,\eta ⟩$，在标准坐标系下其矩阵形式即为小伴随的转置：

   $${\mathrm{ad}}_{\xi }^{\ast }=({\mathrm{ad}}_{\xi }{)}^{\top }=\left[\begin{array}{cc}-{\omega }^{\wedge }& -v^{\wedge }\\ 0_{3\times 3}& -{\omega }^{\wedge }\end{array}\right]\in {\mathbb{R}}^{6\times 6}$$

---

3 标准第三节：切丛流形动力学与最优控制问题描述 (Problem Formulation)

3.1 连续时间六自由度相对耦合动力学方程

在非合作航天器空间交会对接或移动机械臂跟踪任务中，系统的状态生活在正切丛流形 $T\mathrm{SE}(3)\simeq \mathrm{SE}(3)\times {\mathbb{R}}^6$ 之上。

设追踪航天器位姿为 $g\in \mathrm{SE}(3)$，旋量速度为 $\xi =[{\omega }^{\top },v^{\top }{]}^{\top }\in {\mathbb{R}}^6$；目标航天器位姿为 $g_t\in \mathrm{SE}(3)$，旋量速度为 ${\xi }_t\in {\mathbb{R}}^6$。

定义目标坐标系下的相对位姿 $g_e$ 与相对旋量 ${\xi }_e$：

$$g_e\triangleq g_t^{-1}g\in \mathrm{SE}(3),{\xi }_e\triangleq \xi -{\mathrm{Ad}}_{g_e^{-1}}{\xi }_t\in {\mathbb{R}}^6$$

由微分几何李群运动学推导，相对构型运动方程为：

$${\dot{g}}_e=g_e{\xi }_e^{\wedge }$$

引入空间惯量矩阵 $\mathbb{I}=\mathrm{diag}(J,m{I}_3)\in {\mathbb{R}}^{6\times 6}$，由欧拉-庞加莱方程（Euler-Poincaré equations）和对偶伴随映射 ${\mathrm{ad}}^{\ast }$，严谨展开的相对旋量动力学方程为：

$$\mathbb{I}{\dot{\xi }}_e={\mathrm{ad}}_{{\xi }_e}^{\ast }(\mathbb{I}{\xi }_e)+u+{\varphi }_d-\mathbb{I}{\mathrm{Ad}}_{g_e^{-1}}{\dot{\xi }}_t+{\mathrm{ad}}_{{\xi }_e}^{\ast }\mathbb{I}{\mathrm{Ad}}_{g_e^{-1}}{\xi }_t$$

其中：

• $u=[{\tau }^{\top },f^{\top }{]}^{\top }\in {\mathbb{R}}^6$ 为追踪航天器施加的机体系三轴控制力矩与推力；
• ${\varphi }_d\in {\mathbb{R}}^6$ 为集总未知外部空间摄动与模型摄动（由 NDOB 在线估计补偿）；
• $\mathbb{I}{\mathrm{Ad}}_{g_e^{-1}}{\dot{\xi }}_t$ 为目标航天器机动或翻滚角加速度产生的惯性牵连项；
• ${\mathrm{ad}}_{{\xi }_e}^{\ast }\mathbb{I}{\mathrm{Ad}}_{g_e^{-1}}{\xi }_t$ 为相对运动产生的非线性科里奥利与离心动量耦合项。

---

3.2 离散时间几何约束最优控制问题 (Discrete-Time Constrained OCP)

在时间视界 $N$ 内，以采样步长 $\Delta t$ 离散化，构建顶刊标准的离散几何优化命题：

$$\begin{array}{rlrl}\underset{u_0,\dots ,u_{N-1}}{\min }& {\ell }^f(g_{e,N},{\xi }_{e,N})+\sum _{k=0}^{N-1}\ell (g_{e,k},{\xi }_{e,k},u_k)& & \\ \text{s.t.}& g_{e,k+1}=g_{e,k}\mathrm{expm}({\xi }_{e,k+1}^{\wedge }\Delta t),& & k=0,\dots ,N-1,\\ & {\xi }_{e,k+1}=F_{\xi }(g_{e,k},{\xi }_{e,k},u_k),& & k=0,\dots ,N-1,\\ & u_{\min }\le u_k\le u_{\max },& & k=0,\dots ,N-1,\\ & {\mathbf{g}}_{\mathrm{corridor}}(g_{e,k})\le 0,& & k=0,\dots ,N-1,\\ & {\mathbf{g}}_{\mathrm{avoid}}(g_{e,k})\le 0,& & k=0,\dots ,N-1,\\ & \Vert {\xi }_{e,k}{\Vert }_2\le v_{\max }(d_k),& & k=0,\dots ,N-1,\\ & g_{e,0},{\xi }_{e,0}\text{ 给定},[g_{e,N},{\xi }_{e,N}]\in {\Omega }_{ϵ}& & \end{array}\text{\hspace{1em}(OCP)}$$

约束细节规范化展开：

1. 执行器幅值饱和约束 (Actuator Limits)： $$-{\tau }_{\max }\le {\tau }_k\le {\tau }_{\max },-f_{\max }\le f_k\le f_{\max }$$
2. 进场走廊锥体约束 (Line-of-Sight Docking Corridor)： 限制追踪器必须在目标对接面法向正前方半顶角 ${\theta }_{\mathrm{cone}}$ 内平稳接近： $$\sqrt{y_{e,k}^2+z_{e,k}^2}-x_{e,k}\tan ({\theta }_{\mathrm{cone}})\le 0,x_{e,k}\ge 0$$
3. 几何避障与位形安全超球约束 (Obstacle / Configuration Avoidance)： $$\Vert p_{e,k}-p_{\mathrm{obs}}{\Vert }_2\ge r_{\mathrm{obs}},\Vert \mathrm{Log}(R_{\mathrm{unsafe}}^{-1}{R}_{e,k}){\Vert }_2\ge {\alpha }_{\mathrm{safe}}$$
4. 制动一致性速度包络线 (Safe Braking Envelope)： 防止近场以危险高航速接近导致制动失效碰撞： $$v_{\max }(d_k)=\min \left(v_{\mathrm{cruise}},\sqrt{v_{\mathrm{contact}}^2+2a_{\mathrm{brake}}\max (d_k-d_{\mathrm{safe}},0)}\right)$$ 且当接近距离 $d_k<1.0\text{m}$ 时强制切入近场极限上限 $v_k\le 0.15\text{m/s}$。
5. 终端不变吸引集约束 (Terminal Set)： $${\Omega }_{ϵ}=\left\{[g_e,{\xi }_e]|\frac{1}{2}{\mathbf{x}}_e^{\top }P{\mathbf{x}}_e\le ϵ\right\},{\mathbf{x}}_e=\left[\begin{array}{c}\mathrm{Log}(g_e)\\ {\xi }_e\end{array}\right]\in {\mathbb{R}}^{12}$$

3.3 顶刊理论阐述要点：次优性 (Suboptimality)、有限时域截断与闭环稳定性保证

在顶刊审稿中，控制理论审稿专家常提出疑问：“你用 DDP / SQP 求解的是局部最优解甚至次优解，预测时域又只有有限步（Receding Horizon），凭什么能证明闭环系统的渐进稳定性？”
本小节提供标准的学术回答架构与写作论据：

1. 次优性 (Suboptimality) 的双重来源与学术定性

必须在论文的稳定性分析章节（Stability Analysis）清晰界定两层理论含义：

• 时间维度（Horizon Truncation）：预测时域 $N<\infty$ 的有限滚动特性导致其在宏观无限时域下天然属于次优控制（Suboptimal Control）；
• 空间维度（Non-convex Local Trajectory）：受限于 $\mathrm{SE}(3)$ 流形曲率与障碍物非凸性，基于二阶梯度的求解器（DDP / SQP）仅能保证收敛到局部极小值；此外，在在线计算时间受限（Real-Time Iteration, RTI）下提前终止输出的解亦属于次优解。

2. 次优控制下的闭环渐进稳定性标准证明范式

根据现代 MPC 稳定性奠基理论（Scokaert & Mayne 1999 [Mayne-Suboptimal-MPC]、Diehl 2005 [RTI-Stability]）：在线闭环系统的渐进稳定并不依赖于每一步都求得全局最优解，甚至不依赖于单步局部解严格收敛！
只要设计满足以下四大闭环证据链公理，次优策略即可严格保证渐进稳定性：

1. 递归可行性（Recursive Feasibility）：若在时刻 $k$ 存在满足输入/状态硬约束的可行解序列 $U_k^{\ast }$，则在将该序列向前平移（Time-shift）并在末端拼接局部辅助反馈控制器 ${\kappa }_f(x)$ 后，在时刻 $k+1$ 必然存在一个满足硬约束的可行候选序列 ${\tilde{U}}_{k+1}$；
2. 终端控制不变集（Control Invariant Terminal Set ${\Omega }_{ϵ}$）：在终端椭球内，局部状态反馈律 $u={\kappa }_f(x)$ 满足控制饱和硬约束，且保证状态永远不逃逸出 ${\Omega }_{ϵ}$： $$\forall x\in {\Omega }_{ϵ}⟹f(x,{\kappa }_f(x))\in {\Omega }_{ϵ}$$
3. 离散李雅普诺夫降落不等式（Discrete Lyapunov Decrease）：终端代价函数 $V_f(x)$ 在 ${\Omega }_{ϵ}$ 内充当局部控制 Lyapunov 函数，满足： $$V_f(f(x,{\kappa }_f(x)))-V_f(x)\le -\ell (x,{\kappa }_f(x))$$
4. 单调值函数递减：即便当前步因时间用尽而提前终止（Suboptimal Output），只要输出的次优解满足 $J({\tilde{U}}_{k+1})\le J(U_k^{\ast })-\alpha (\Vert x_k\Vert )$，闭环系统即可经由离散 Barbalat 引理或 LaSalle 不变集原理严格证明几乎全局渐进稳定（Almost GAS）！

3.4 约束函数的空间提升规范（杜绝 Alcan 2023 的符号跳变与笔误）

在矩阵李群轨迹优化（如 CDDP / NMPC）中，原始物理约束定义在流形空间上（例如视场锥、姿态禁飞区、近场避障），而优化算法的梯度与 Hessian 展开均运行在李代数局部切空间 ${\mathbb{R}}^{12}$ 中。

为杜绝 Alcan 2023 中“第 4 节用 $\mathbf{g}$，5.2 节突然空降 $\overline{\mathbf{c}}$，5.3 节又变回 $\overline{\mathbf{g}}$ 且声称是式 (16) 引入”的低级符号断层与笔误，在撰写论文时必须遵循严格单调一致的提升规范（Consistent Lifted Constraint Mapping）：

1. 流形原始约束声明（Global Manifold Domain）：
   在问题定义节中，明确状态定义在 $T\mathrm{SE}(3)$ 上，约束记为： $$\mathbf{g}(g_k,{\xi }_k,u_k)\le 0,g_k\in \mathrm{SE}(3),{\xi }_k\in {\mathbb{R}}^6,u_k\in {\mathbb{R}}^6$$
2. 切空间提升约束定义（Locally Lifted Function via Retraction）：
   在进入 DDP 反向传播或 NMPC 连续配点时，严禁突然更换为其他未定义的字母（如 $c$），必须统一使用上横线 $\overline{\mathbf{g}}$ 并白纸黑字写出提升映射定义式： $$\overline{\mathbf{g}}({\mathbf{x}}_k,\delta u_k)\triangleq \mathbf{g}\left({\bar{g}}_k\mathrm{Exp}({\eta }_k^{\wedge }),{\bar{\xi }}_k+\delta {\xi }_k,{\bar{u}}_k+\delta u_k\right)\le 0$$ 其中 ${\mathbf{x}}_k=[{\eta }_k^{\top },\delta {\xi }_k^{\top }{]}^{\top }\in {\mathbb{R}}^{12}$ 为标称轨迹处的切空间误差状态；
3. 一致性继承：
   后续在增广拉格朗日函数 ${\mathcal{L}}_A$、KKT 乘子更新式 ${\lambda }_{k+1}$ 以及互补松紧度检验中，全文 100% 保持使用 $\overline{\mathbf{g}}$，彻底消除审稿人对符号自洽性的质疑；
4. 半直积强解耦原则（严禁采用 Alcan 的 6 维李代数超球避障）：
   在 $\mathrm{SE}(3)$ 刚体系统中，严禁将位置平移与姿态旋转简单混合计算李代数范数 $\Vert \psi \Vert \le r$（因米与弧度量纲错位）；必须严格解耦为：三维欧氏物理防撞/视场锥走廊（作用于平移 $p_e\in {\mathbb{R}}^3$）与球形内积视线禁飞区（作用于旋转姿态 $R_e\in \mathrm{SO}(3)$）。

---

4 文献横向对比与四大理论升华 (Comparison & Critical Upgrades)

下表将 Alcan 2023、Teng 2022、Howell 2019 以及本框架的设计原则进行深度透视，明确提炼出您在撰写论文时的创新贡献点：

理论维度	Alcan 2023 (IEEE T-RO)	Teng 2022 (IROS/CDC)	Howell 2019 (ALTRO)	Chu_2024 / Chu_2026 (本论文范式)
研究空间	抽象矩阵李群 $\mathcal{G}\times \mathfrak{g}$	紧流形李代数 $\mathfrak{g}$ 误差	欧氏平直空间 ${\mathbb{R}}^n\times {\mathbb{R}}^m$	空间刚体切丛 $T\mathrm{SE}(3)\simeq \mathrm{SE}(3)\times {\mathbb{R}}^6$
旋量与平凡化声明	仅写 $\dot{\mathcal{X}}=\mathcal{X}{\xi }^{\wedge }$，未声明左右平凡化	左误差 $\eta =\log (X^{-1}\bar{X})$	欧氏向量减法 $\delta x=x-\bar{x}$	白纸黑字声明机体系左平凡化与 $[\omega ,v]$ 旋量序
对偶伴随映射 ${\mathrm{ad}}^{\ast }$	❌ 缺失，将动力学写成黑盒 $f(\cdot )$	❌ 未在动力学中明确对偶	❌ 欧氏无伴随概念	✅ 严谨保留 ${\mathrm{ad}}^{\ast }$ 并从欧拉-庞加莱方程导出
流形离散化保结构性	文中口误称可使用一阶欧拉积分	保留一阶群指数积	经典 RK4 离散化	✅ 严格使用保流形指数积分 / LGR 伪谱正交配点
相对运动学项	单刚体，无双体系伴随项	腿部机体系，单刚体	单刚体	✅ 双体追逃：包含伴随运输项 ${\mathrm{Ad}}_{g_e^{-1}}{\dot{\xi }}_t$
安全约束体系	静态单点避障、速度常数截断	无显式非线性约束	欧氏状态/控制硬约束	✅ 视场走廊锥 + 动力学速度包络线 + 终端不变集

4.2 核心文献溯源指南：如何精准引用与评述 Teng 2022 与 Alcan 2023

在撰写相关论文（特别是引言 Related Work 与推导第 III/IV 节）时，必须极其准确地界定 Teng 等人与 Alcan 等人的学术分工，切忌混淆：

1. 切空间误差状态动力学 ($\dot{\psi }=\delta \xi -{\mathrm{ad}}_{\xi }\psi$) 的归属：
   必须严格归功并引用 Teng et al. [13] (IROS 2022)。Alcan 2023 也是直接引用并继承了 Teng 的推导。
   推荐标准英文写法：

   “Following the Lie-algebraic error-state perturbation formulation initiated by Teng et al. [13], the linearized tangent dynamics of configuration error are given by $\dot{\psi }=\delta \xi -{\mathrm{ad}}_{\xi }\psi$.”

2. 李代数测地线对数代价函数的设计与二阶展开：
   应引用 Teng et al. [14] (CDC 2022) 与 Alcan et al. [26] (T-RO 2023)。Teng 证明了李代数对数代价相比传统矩阵迹代价（Trace Cost）的曲率优势与指数收敛；Alcan 则在此基础上推导了切空间的张量展开矩阵。
   推荐标准英文写法：

   “Unlike conventional trace-based metric potentials that suffer from sluggish convergence at large angular errors, we adopt the Lie-algebraic geodesic cost design [14, 26], parameterizing the stage cost via the intrinsic logarithmic error.”

3. 如何精确定位本课题（Chu et al. 2024 / 2026）对 Teng 与 Alcan 的超越创新点：

   • 对 Teng 2022 的超越：Teng 仅限于无约束或仅含控制界限的足式机器人平衡，无法处理空间交会中的对接锥（Line-of-Sight Cone）、禁飞区避障与近场刹车包络线等高维非线性状态硬约束；
   • 对 Alcan 2023 的超越：Alcan 仅针对单刚体经验轨迹优化，完全缺失双刚体非合作翻滚的李括号动量牵连项（$-\mathbb{I}{\mathrm{Ad}}_{g_e^{-1}}{\dot{\xi }}_t$），且无扰动观测器（NDOB）与鲁棒正不变管（Tube RPI）的理论证明；
   • 本框架集成了保流形正交配点（LGR / GL-RK）、扰动观测补偿与紧缩管递归可行性认证，完成了从“开环优化器”到“全闭环鲁棒安全控制”的全面升华！

4.3 离散化与求导方法论抉择：坚决采用 DtL 而杜绝 LtD

在 IEEE TAC / Automatica 等理论顶刊的审稿中，关于“离散化（Discretization）”与“线性化（Linearization）”的执行次序是严谨性的分水岭：

1. 先线性化后离散化 (LtD, Linearize-then-Discretize) 的致命弊端：
   Alcan 2023 与 Teng 2022 采用的 LtD 方案（连续时间求导，再用 $A_d\approx I+A_c\Delta t$ 简单欧拉离散），在数学上引入了离散-线性化非对易误差（Non-commuting Residual）。当步长 $\Delta t>0.05\text{s}$ 时，反向传播计算的下降方向与真实流形正向指数积分发生脱节，迫使线搜索步长大幅回退，破坏优化收敛性；
2. 先离散化后线性化 (DtL, Discretize-then-Linearize) 的顶刊规范：
   在 Chu_2024（LGR 配点）与 Chu_2026（几何 CDDP）中，统一采用 DtL 路线：
   • 首先通过保流形数值积分算子（如 Lie-Euler $g_{k+1}=g_k\mathrm{expm}(\Delta t{\xi }_k^{\wedge })$ 或高阶 Gauss-Legendre 配点）定义精确的离散步进映射 $x_{k+1}={\Phi }_{\Delta t}(x_k,u_k)$；
   • 随后在离散算子上求切空间解析导数（或利用 JAX 自动微分提取精确离散雅可比矩阵）；
   • 这保证了优化算法的反向梯度与前向物理积分在浮点精度下（残差 $<10^{-13}$）实现 100% 精确匹配！

---

5 顶级审稿人高频质询防御指南 (Reviewer Defense Playbook)

在向 TAC / Automatica 投稿时，以下 4 个问题是几何控制领域的“必考题”。本文为您准备了可以直接采纳的学术答辩策略：

Q1：为什么不用单位四元数（Quaternion），而一定要用矩阵李群 $\mathrm{SE}(3)$？

• 审稿动机：四元数计算效率高，仅需 4 个浮点数。
• 标准防御论据：
  1. 拓扑双覆盖与解绕（Unwinding Phenomenon）：四元数满足球形双覆盖 $S^3\to \mathrm{SO}(3)$，每个物理姿态对应 $+q$ 和 $-q$。连续控制律或优化器极易在 $+q$ 与 $-q$ 之间发生符号误判，导致控制器出现多旋转 $360^{\circ }$ 的解绕灾难；
  2. 冗余非线性等式约束：四元数在 DDP 或 NMPC 中必须在每一个时间步强制施加非线性等式约束 $\Vert q_k{\Vert }^2=1$，这使得 NLP 的 KKT 条件退化降秩，优化复杂度徒增；
  3. 位置与姿态的天然流形解耦：四元数与位置是简单的笛卡尔积 ${\mathbb{R}}^3\times S^3$，无法通过半直积伴随作用 ${\mathrm{Ad}}_g$ 自然捕捉旋转对偏心平移的运动学耦合（如对接机构远离质心时的旋转摆臂效应）。

Q2：欧拉离散化会不会导致旋转矩阵漂移出 $\mathrm{SO}(3)$？

• 审稿动机：审稿人怀疑算法在长时间仿真中是否具有数值保几何结构性。
• 标准防御论据：
  • 明确澄清：本框架在正向传播（Forward Pass）中严格杜绝直接向量累加（即绝不出现 $R_{k+1}=R_k+{\dot{R}}_k\Delta t$）；
  • 状态更新统一通过群指数映射进行缩回（Retraction）： $$R_{k+1}=R_k\exp ({\omega }_{k+1}^{\wedge }\Delta t)$$
  • 利用 Rodrigues 展开式，$R_{k+1}$ 在有限浮点精度下（$<10^{-14}$）解析地恒等于正交矩阵，正交性残差 $\Vert R^{\top }R-I_3{\Vert }_F\approx 0$，无需任何后期 SVD 正交化重投影。

Q3：为什么李代数误差动力学可以丢弃二阶项 ${\psi }^{\wedge }({\xi }_p^{\wedge }-{\xi }^{\wedge })$？

• 审稿动机：审查局部线性化/切空间泰勒展开的严谨性。
• 标准防御论据：
  • 扰动误差分析属于局部摄动论（Local Perturbation Theory）。根据量级阶次，$\psi =\mathcal{O}(ϵ)$ 为小位形摄动，$\delta \xi ={\xi }_p-\xi =\mathcal{O}(ϵ)$ 为小速度摄动；
  • 乘积项 ${\psi }^{\wedge }({\xi }_p^{\wedge }-{\xi }^{\wedge })=\mathcal{O}({ϵ}^2)$ 是两小量的二阶张量交叉项，在计算 DDP 一阶动力学雅可比矩阵 $A_t,B_t$ 时，二阶项的切线导数为零；在二阶海森近似中，该残差完全被扰动观测器（NDOB）的有界观测误差集吸收，因此在小邻域内保证渐进无偏。

Q4：在控制收敛性证明中，能否直接声称系统“全局渐进稳定（Globally Asymptotically Stable）”？

• 审稿动机：考验作者对微分流形拓扑学的敬畏心。
• 标准防御论据：
  • 切忌声称全局平滑稳定！根据拓扑学中的 Stuelpnagel 定理 与 Poincaré-Hopf 指标定理，在具有非平凡拓扑的紧致无界流形（如 $\mathrm{SO}(3),S^2$）上，不存在任何连续且全局渐进稳定的时不变反馈控制律；
  • 严谨表述应为：“系统在去掉了全反向奇点集合 $\mathcal{S}=\{g\in \mathrm{SE}(3)\mid \mathrm{tr}(R)=-1\}$ 的几乎全局意义下（Almost Globally Asymptotically Stable）渐进稳定”；在离散采样与存在扰动观测误差时，严格表述为“局部输入-状态稳定 (Local ISS) 或 最终一致有界 (Uniform Ultimate Boundedness, UUB)”。

Q5：DDP / NMPC 求解出来的是不是“次优解”？为什么能够保证闭环渐进稳定？

• 审稿动机：审稿人质疑有限时域截断与局部/提前终止求解器的理论严密性。
• 标准防御论据：
  1. 坦诚阐述非凸性与次优性本质：在非凸流形 $T\mathrm{SE}(3)$ 与非凸障碍物约束下，任何实用的多项式时间求解器求出的均是局部最优/次优解，但这正是现代控制理论中 Suboptimal MPC（Scokaert & Mayne, Automatica 1999）的标准研究范畴，工程实用的追求是安全可行性而非全局极致；
  2. 区分开环次优与闭环渐进稳定：开环单步轨迹的次优性并不妨碍闭环的严格渐进稳定。只要通过终端代价矩阵 $P$（求解离散代数 Riccati 方程 DARE 获得）与终端正不变集 ${\Omega }_{ϵ}$ 构筑起递归可行性与值函数单调递减证据链，即可在理论上严格消除有限时域截断效应，提供完整的李雅普诺夫渐进稳定性保证。

Q6：流形优化中采用先离散后线性化 (DtL) 还是先线性化后离散化 (LtD)？对算法收敛性有何影响？

• 审稿动机：审稿人核查算法是否存在梯度失配（Gradient Mismatch）与数值积分漂移。
• 标准防御论据：
  1. 明确声明采用严格的 DtL 范式：澄清本框架坚决杜绝粗暴的一阶连续欧拉近似（LtD），而是首先基于 Lie 群指数映射构造精确的离散状态转移映射，随后在流形切空间中直接对离散映射求解析偏导（DtL）；
  2. 数值自洽性与收敛性保障：DtL 保证了反向传播计算的 $Q$-函数一阶与二阶梯度是离散最优控制目标函数在当步的严格无偏真实导数。在本地仿真测试中，DtL 解析梯度与高精度自动微分的一致性残差低至 $1.55\times 10^{-13}$，彻底消除了时间步长 $\Delta t$ 引起的交换子误差，即使在较大步长下也能保证线搜索步长 $\alpha \approx 1$ 满步接受，实现超线性二次收敛。

Q7：原系统约束定义在流形上，而优化算法运行在切空间，两者数学形式如何严格衔接？

• 审稿动机：核查作者对非欧流形上约束映射（Constraint Lifting & Pull-back）的数学严谨度，防止符号跳跃与定义脱节。
• 标准防御论据：
  1. 明确定义局部提升约束（Lifted Constraint via Exponential Retraction）：指出流形上的物理约束 $\mathbf{g}(g,\xi ,u)\le 0$ 通过群指数缩回映射（Retraction）被拉回到当前迭代标称点处的李代数切空间： $$\overline{\mathbf{g}}(\mathbf{x},\delta u)=\mathbf{g}(\bar{g}\mathrm{Exp}({\eta }^{\wedge }),\bar{\xi }+\delta \xi ,\bar{u}+\delta u)$$
  2. 局部微分与几何不变性：在切空间原点 $\mathbf{x}=0$ 处，$\overline{\mathbf{g}}(0,0)=\mathbf{g}(\bar{g},\bar{\xi },\bar{u})$；其关于切空间坐标 $\mathbf{x}$ 的一阶雅可比矩阵通过链式法则与伴随算子严格导出，二阶展开直接提供约束海森矩阵；正向传播（Forward Pass）时再通过群指数映射缩回至 $\mathrm{SE}(3)$ 流形，保证优化解在全过程中严格位于流形内部并处处满足原物理约束。

Q8：为什么航天器交会对接不采用流形切空间全维超球避障（如 Alcan 2023 式 18），而必须显式解耦平移走廊与姿态视线角？

• 审稿动机：核查作者对多自由度非欧刚体系统的物理量纲自洽性与空间任务几何特性的理解深度。
• 标准防御论据：
  1. 量纲不自洽（Dimensional Inconsistency）的致命隐患：若直接在李代数 $\mathfrak{se}(3)\simeq {\mathbb{R}}^6$ 上构造超球范数 $\Vert \psi {\Vert }_2\le r_c$，平移误差（米，$\text{m}$）与姿态误差（弧度，$\text{rad}$）在模长中被迫直接平方相加。由于弧度数值量纲极大（$1\text{rad}\approx 57.3^{\circ }$），微小的姿态旋转就会淹没几厘米的近场碰撞风险，造成严重虚假安全；
  2. 物理半直积结构的天然解耦性：航天器交会对接的几何约束在物理上天然解耦：平移通道受视场进近锥走廊（Line-of-Sight Cone）与太阳翼物理椭球包络约束主导；姿态通道受对接机构对准轴与敏感器防日光灼伤夹角主导。本框架通过半直积解耦分别投影至对应切空间，利用 JAX 自动微分提取精确梯度，既确保了严格物理安全性，又避免了流形全维范数的虚假避障。

---

6 现成 LaTeX 宏与英文论文高分句式库 (LaTeX & Phrasing Toolkit)

6.1 常用数学命令宏定义 (Preamble Macros)

可直接复制粘贴到论文的 LaTeX 导言区：

% --- Lie Groups and Lie Algebras Macros ---
\newcommand{\SO}{\mathrm{SO}(3)}
\newcommand{\SE}{\mathrm{SE}(3)}
\newcommand{\so}{\mathfrak{so}(3)}
\newcommand{\se}{\mathfrak{se}(3)}
\newcommand{\Ad}{\operatorname{Ad}}
\newcommand{\ad}{\operatorname{ad}}
\newcommand{\Exp}{\operatorname{Exp}}
\newcommand{\Log}{\operatorname{Log}}
\newcommand{\expm}{\operatorname{expm}}
\newcommand{\logm}{\operatorname{logm}}
\newcommand{\skewop}[1]{\left[#1\right]^\wedge}
\newcommand{\unskewop}[1]{\left[#1\right]^\vee}
\newcommand{\iner}{\mathbb{I}}

6.2 顶刊引言与方法论高频学术句式 (Paper Phrasing Snippets)

引入非欧几何的必要性：

“Unlike standard Euclidean configurations where linear arithmetic applies, the configuration space of rigid bodies is inherently non-Euclidean, evolving on the Lie group $\mathrm{SE}(3)$. Parameterizing rotations via local Euler angles invariably incurs singular configurations (e.g., gimbal lock), while unit quaternions demand non-convex norm preservation constraints that can destabilize numerical gradient updates.”

阐述切空间提升与缩回：

“To preserve the manifold geometry without introducing coordinate singularities, the trajectory optimization problem is locally lifted to the Lie algebra $\mathfrak{se}(3)$ via the logarithmic mapping, wherein standard differential dynamic programming (DDP) can be executed. Subsequently, the derived optimal policy is retracted back to the Lie group using the group exponential map, ensuring exact orthogonality throughout all iterations.”

描述保流形离散化与对偶动力学：

“The relative coupled kinematics and dynamics are rigorously derived on the tangent bundle $T\mathrm{SE}(3)$ using the Euler-Poincaré reduction. By exploiting the dual adjoint operator ${\mathrm{ad}}^{\ast }$, the nonlinear momentum transfer is preserved algebraically. Numerical integration is governed by structure-preserving geometric integrators, precluding artificial dissipation or drift from the underlying Lie group manifold.”

---

🌐 关联工程与源码对照

本写作手册对应的底层数理推导与工程实现，均已在本地代码生态中实现闭环：

• 符号与推导全景：详见本站笔记 《基于李代数微分动态规划的矩阵李群约束轨迹优化》；
• 欧氏对照算法：本地工程 Howell_2019_ALTRO/src/solver.py；
• 流形 DDP 源码：本地工程 Alcan_2023_DDP_Constraints/src/solver.py；
• 航天器全驱动 SE(3) NMPC：本地工程 Chu_2024_Geometric_NMPC_on_SE3_for_Rendezvous_and_Docking_with_a_Tumbling_Target_via_LGR_Collocation。