精读笔记
Problem Setting
论文实际解决的是冗余机器人 MAAM 的长航程轨迹优化：给定已经生成的空间/表面沉积路径，寻找一条 joint trajectory，使喷嘴位置严格经过每个沉积点，同时满足姿态、碰撞、joint limit、速度/加速度/jerk 等约束。真正困难不在 IK 本身，而在数万 waypoint 上同时保持制造级位置精度和全局轨迹平滑。
关键矛盾是：MAAM 的 deposition position 是制造约束，不是普通 tracking objective；但如果把它作为硬约束，优化变量和约束规模会随 waypoint 数线性爆炸，传统 SQP 或 graph-search 很快变重。以前方法卡在两端：penalty 方法快但会漂离路径；显式冗余参数化只适合低维结构；SQP/离散搜索能严肃处理约束但长路径扩展性差，尤其面对打印过程中不断增长的工件几何。
Motivation
作者的核心动机是反对把所有东西都写成 soft objective。对于 MAAM，喷嘴位置误差不是可接受的 trade-off；一旦为了避碰或降 jerk 允许毫米级漂移，优化结果在制造意义上就失效。因此需要一种机制，把路径精度从权重调参中剥离出来。
另一个缺口是动态碰撞建模。打印件不是静态环境，而是沿 deposition sequence 逐步增长的几何体。很多 motion planning 方法默认环境静态，或者先离散冗余自由度做 graph pruning；这在短路径可能有效，但对数万点和高冗余系统并不自然。作者的观察是：如果碰撞能被写成 waypoint-wise differentiable signal，那么它可以直接并入梯度投影框架，而不需要离散搜索预筛。
Core Idea
论文的核心思想是：不要在全 joint space 里优化一条“尽量贴近”工具路径的轨迹，而是在每个 waypoint 对应的 self-motion manifold 上优化冗余运动。位置约束 FK_p(q)=p_i 定义了一个低维流形；优化器每步先把 q 投影回这个流形，再把损失梯度投影到该流形切空间。这样，位置精度成为几何约束，平滑性、姿态和碰撞只使用 null-space 自由度。
这和 prior 的本质区别在于建模重心变了：不是通过 penalty weight 平衡 path following 和 feasibility，也不是通过显式角度变量参数化冗余，而是把“任务必须满足的部分”和“可以优化的冗余部分”在微分几何上分离。这个 inductive bias 很强：它假设真正可调的是 self-motion，而不是 task-space path 本身；因此对高冗余系统更 general，对长路径更 scalable。
碰撞部分的核心思想也类似：不是重建随时间变化的全局环境，而是把已经打印的几何离散成 query points，用机器人 link 的局部 SDF 给出距离和梯度。它重新组织了 collision information：动态工件变成随 waypoint 增长的 sample set，机器人几何变成可复用的 link-wise distance oracle。
Method
1. Relative kinematics：解决双机器人/机器人+变位机系统中任务约束定义在喷嘴相对工件坐标系的问题。它的必要性在于 MAAM 的 deposition path 不是某个单独机械臂末端的绝对轨迹，而是 nozzle-object relative pose。核心变化是把姿态约束、位置 Jacobian、collision gradient 都统一接到 stacked joint space。
2. Hard manifold projection：解决 soft penalty 下路径漂移的问题。每个 waypoint 通过 damped pseudoinverse IK correction 投影到 FK_p(q)=p_i 的 self-motion manifold；之后的梯度通过 null-space projector 限制在切空间。核心变化是让 deposition accuracy 不再和 smoothness/collision 竞争权重。
3. Differentiable SDF collision：解决打印件随时间增长导致静态碰撞模型失效的问题。机器人 link 预计算 SDF，已打印部分用 query points 表示，在当前 waypoint 查询距离和梯度。核心变化是把动态几何约束转成局部可微 penalty，从而能和 projected gradient descent 同构。
4. Penalized inequalities：姿态、gravity posture、joint limit、dynamic limit、collision 仍以 softplus penalty 进入目标。这里不是理论创新，而是把非硬性的安全/质量约束转成可微信号。需要注意：除了 deposition position，其他约束并没有被严格投影保证，而是靠大权重和最终 constraint check。
5. Trajectory-level optimization：平滑项通过速度、加速度、jerk finite difference 作用在整条 joint trajectory 上，而不是逐 waypoint 独立 IK。核心变化是保留跨时间耦合，避免 waypoint-wise redundancy resolution 造成 joint discontinuity。
Key Insight / Why It Works
最关键的 insight 是：在冗余 MAAM 里，位置约束的 null space 才是优化的真实自由度。只要初始轨迹已经能投影到每个 waypoint 的位置流形，后续优化就不该再修改 task-space position，而应该在 tangent/null space 中寻找更平滑、更安全的 posture sequence。这个切分直接消除了 penalty formulation 中最麻烦的权重竞争。
方法有效的主要来源不是 Adam 或 softplus，而是更好的 inductive bias：把“绝对不能错”的制造约束作为几何投影，把“可以 trade-off 的约束”作为 penalty。这种结构非常适合 MAAM，因为喷嘴位置是硬制造语义，而 orientation/collision/dynamics 在实际实现中往往允许 margin-based soft handling。
第二个有效来源是并行化和问题分解。每个 waypoint 的投影、SDF 查询、active collision gradient 很大程度上可独立计算；相比 SQP 每轮解大型 constrained subproblem，projected gradient 的单步成本低很多。文中的速度优势很可能主要来自这种工程/计算结构，而不是优化理论上更强的收敛性质。换句话说，10x speedup 的本质更像 scalable first-order formulation + GPU-friendly collision evaluation，而不是某个新 optimizer。
SDF collision model 是实质贡献，但它的保证边界要看清：它提供的是 sampled differentiable repulsion，不是完整 continuous collision certificate。Top-K active set 是必要的 scaling trick，但也意味着梯度只来自当前最危险的少数样本；它可能足够工程有效，但理论上不能排除漏掉非 active 却即将变 active 的碰撞区域。
最可能的核心贡献排序：第一是 hard self-motion manifold projection；第二是 fabrication-sequence-aware differentiable collision；第三才是 relative Jacobian 的系统化推导。relative Jacobian 本身不是新思想，但在这个任务里是让整套方法适配双机器人 MAAM 的必要 glue。其它优化细节更多是 engineering。
Relation To Prior Work
它最接近三条线：path-constrained redundant manipulator optimization、CHOMP/STOMP/TORM 类 trajectory optimization、以及 manufacturing 中的 SQP/SCvx-style constrained trajectory optimization。论文不是开辟全新优化范式，而是把经典 null-space projection / self-motion manifold 思想重新组织到长航程 MAAM 上，并和动态打印几何的 SDF 碰撞模型结合。
和 penalty-based 方法的本质差异是：路径位置不再是 loss term，而是优化域本身。这个差异很实质，因为制造任务里 millimeter-level drift 会直接破坏 deposition。
和显式冗余参数化方法的差异是：它不要求找到“绕喷嘴轴旋转”这类低维语义变量。对 8-DOF 或双机器人系统，冗余自由度可能没有单一可解释参数；直接在 joint-space manifold 上做投影更 general。
和 SQP baseline 的差异不是约束意识更强，而是 computational organization 不同。SQP 每轮维护/求解大规模线性化约束子问题；本文用投影保证最关键的等式约束，用一阶 penalty 梯度处理其它约束，因此更轻、更并行，但理论保证也更弱。
看似新的部分中，null-space projected gradient 和 link-wise SDF 都有明显前史；真正新增的信息是它们在 MAAM 这个“动态增长工件 + 硬沉积路径 + 超长 waypoint”的组合问题上形成了一个可工作的系统。
Dataset / Evaluation
实验覆盖两类 MAAM 场景：support-free spatial printing 和 conformal surface printing；路径规模从几千到近九万 waypoint，并且包含真实 8-DOF ABB 平台的物理打印。这个覆盖范围对验证 scalability 和制造可用性是有说服力的，尤其是相比只在短路径仿真上展示的规划工作。
评价基本验证了三件事：位置误差能被 projection 压到制造可接受范围；约束违反能在 sampled model 下消除；相对 SQP baseline 更快达到可行并降低 jerk。这些都直接对应论文核心 claim。
但 evaluation 也有明显边界。第一，collision-free 是在离散 waypoint 和 sampled SDF 查询下成立，不是 swept-volume 或 continuous-time certificate。第二，baseline 主要是 SQP-based solver；缺少与更现代的 GPU-parallel first-order constrained optimizer、sampling+optimization hybrid、或 specialized IK trajectory solvers 的强比较。第三，初始化来源和失败案例没有充分展开，因此“泛化到困难任务”的证据有限。
真实打印结果增强了可信度，但更多证明的是轨迹平滑对 deposition artifact 有帮助，而不是严格证明 collision model 或 optimizer 在广泛工业场景下可靠。
Limitation
最大限制是初始化敏感性。该方法是局部一阶优化，且每步投影到当前位置附近的 self-motion manifold；如果初始轨迹落在错误连通分支、深碰撞、严重 joint-limit violation 或奇异邻域附近，优化很可能只是局部修补，未必能找到全局可行姿态序列。作者也承认需要 sampling-based search 作为前端。
第二个限制是约束保证不均衡。位置是硬投影，其他约束是 penalty；因此 collision/orientation/dynamics 的满足依赖权重、margin、采样密度和优化预算。论文语言里有时接近“guarantee collision-free”，但严格说只是在 adopted sampled SDF collision model 下最终检查无违反。
第三，scalability 的上限被转移到 SDF/query point 数量和 active-set 策略上。Top-K 查询让计算可控，但也引入信息截断；采样间距、bounding box、safety margin 的选择会直接决定漏检概率和 runtime。文中未充分说明在更大构件、更密集 link geometry、更多机器人/夹具/线缆场景下的内存和时间增长。
第四，奇异性没有显式处理。速度/加速度 penalty 只能间接避开坏 conditioning；在 self-motion manifold 附近 Jacobian rank 下降时，projection 和 tangent gradient 都可能不稳定。对机器人制造而言，这不是小问题。
第五，增益归因不完全清晰。相对 SQP 的加速可能主要来自并行一阶实现、GPU SDF 查询和较弱的约束处理，而不一定说明 projected gradient 在优化质量上普遍优于 SQP。这里的 claim 应理解为“在该问题建模和工程实现下更 scalable”，不是一般 constrained trajectory optimization 的结论。
Takeaway
- 1. 对高精度制造规划，最值得迁移的思想是把不可交易的 task constraint 从 loss 中拿出来，直接定义优化流形；否则 penalty tuning 会把制造语义破坏掉。
- 2. 对长航程冗余轨迹，真正 scalable 的路线可能不是更强的全局 NLP solver，而是把硬任务约束做局部投影，把剩余约束转成可并行的一阶可微信号。
- 3. 动态环境不一定要重建全局场；如果环境演化有明确序列结构，可以把它表示成时间条件化的 query set，再用可复用的 geometry oracle 提供梯度。
- 这一点可迁移到焊接、喷涂、铺丝、加工等过程规划。
一句话总结
这篇论文把冗余 MAAM 轨迹优化从“带路径 penalty 的大规模约束优化”重构为“位置流形上的一阶冗余优化”，核心贡献是用 hard manifold projection 保住制造精度，并用可微 SDF 把动态打印碰撞接入可扩展的梯度框架。