精读笔记
Problem Setting
这篇论文处理的是 bearing-only 目标定位中的主动轨迹规划：UAV 不只是被动采角度，而是通过机动制造更好的观测几何，从而降低 bearing-only 估计的不适定性。
真正困难点在于 bearing-only 的信息质量高度依赖视线几何。单 UAV 需要随时间制造足够视差；双 UAV 需要保持互补视线角。如果 UAV 长时间沿着与目标相近的视线方向运动，FIM 会接近奇异，CRLB 发散，估计器即使有高频观测也可能沿某些方向不可辨。
以前方法卡住的地方有两层：一是 D-optimal FIM 在理论上等价于最小不确定椭球体积，但作为在线优化目标时，退化几何附近 det(FIM) 很小且梯度信号差，优化器容易困在坏几何；二是轨迹优化器常在角度或自由 waypoint 空间中搜索，生成的轨迹不一定满足 UAV 机动约束。也就是说，信息指标和执行约束没有真正对齐。
这个任务的关键矛盾是：最有信息的观测几何往往需要主动机动，但可执行机动空间受速度、加速度和短时规划窗口限制；如果优化目标只看信息量，可能不可飞；如果只保证可飞，又可能无法摆脱 bearing-only 的退化观测几何。
Motivation
作者的核心观察是：传统 FIM/D-optimality 不是错在最优性定义，而是错在作为在线启发式目标时的优化动力学。det(FIM) 和 log det(FIM) 有相同极值，但在退化附近给优化器的信号完全不同。论文想补的不是 estimator，而是 planner 在坏几何附近“怎么被推开”。
第二个缺口是多 UAV 规划中信息量最大化并不自动等价于良好协同。两个 UAV 如果都朝着单机 FIM 最优方向移动，可能形成轨迹聚集或视线冗余。双平台 bearing-only 的本质是交叉视线几何，而不是两个单平台信息项的简单相加。因此需要显式加入交会角 inductive bias。
第三个动机更工程但很关键：PSO 类优化器若不嵌入动力学约束，会在大量不可达 waypoint 上搜索，导致所谓最优信息轨迹无法执行。作者把规划变量从抽象方向/角度拉回到由加速度约束诱导的可达位置域，这实际上是把优化问题从“几何最优”改成“可飞几何最优”。
Core Idea
论文真正核心不是提出一种新的 bearing-only 定位算法，而是重塑 active perception 的优化景观：把 FIM 从 raw determinant 改成 log-spectral aggregation，使退化观测几何附近产生更强的反退化搜索信号；同时在双 UAV 中用 sin(intersection angle) 显式编码 triangulation 的正交视线偏好。
本质区别在于它没有试图让估计器更复杂，而是让 planner 更懂 bearing-only 的失败模式。传统路线往往把 FIM 当作单一信息量标量，然后交给通用优化器；这篇把“退化几何不可接受”“双平台视线应互补”“候选轨迹必须可达”这些 domain prior 直接注入目标函数和搜索空间。
理论上它可能有效，因为 bearing-only 的不可观测性主要是几何性的。只要能把平台从共线/小视差状态推开，估计精度会出现数量级变化。这里的 inductive bias 很明确：不要平均提升所有观测，而是优先避免信息矩阵的最小谱方向塌缩。
Method
关键机制一：spectrally-weighted FIM。作者定义的是 sum log eigenvalues，即 log det(FIM)。严格说这不是新的最优准则，而是 D-optimality 的单调变换；最优点集合不变。它解决的是退化几何附近优化信号不足的问题。det 接近 0 时，log-det 的梯度尺度按 1/det 放大，因此会更强烈地排斥 rank-deficient geometry。需要注意：论文称其为 spectrally-weighted，但实际形式基本就是 log-det，不是复杂谱加权。
关键机制二：dual-UAV intersection angle sine。对于双 bearing triangulation，视线交角接近 90 度时几何稀释最小，接近平行时 GDOP 发散。作者用 sin(theta) 作为显式协同项，解决多 UAV 只优化个体 FIM 时可能轨迹聚集的问题。核心变化是从“多平台信息叠加”变为“多平台几何互补”。
关键机制三：motion-constrained PSO。粒子不是任意 waypoint，而是由当前 UAV 状态和可采样加速度生成；PSO 更新后若越界，再投影回可达加速度域。这解决了优化器与飞行动力学脱节的问题。它带来的核心变化很大：搜索空间从全局几何空间缩成一阶/二阶可达域，虽然可能牺牲全局性，但显著提高在线可执行性。
关键机制四：particle normalization。不同目标项尺度差异很大，log-FIM 也可能与 sin(theta) 不在同一量纲。作者用初代粒子内各目标最大绝对值归一化。它解决的是多目标加权中的尺度支配问题，但严格说这仍是启发式 normalization，不是 principled multi-objective optimization。
Key Insight / Why It Works
最可能的核心贡献其实不是 log-det，而是“把 PSO 搜索空间限制到动力学可达域”。单 UAV 消融非常清楚：S+PSO 几乎不比 D+PSO 好，而 D+IPSO 带来数量级提升。这说明原 baseline 的主要失败不是 FIM 指标本身，而是标准 PSO 在不合适的搜索空间和尺度下找不到可执行的好轨迹。换句话说，论文最大增益很可能来自 engineering of optimization domain，而非新的信息理论。
log-det 的理论论证是成立的：det 与 log det 最优点相同，但退化附近梯度性质不同。问题是论文使用的是 PSO，而不是梯度优化；“梯度发散”能否直接解释 PSO 的性能提升，文中未充分说明。对于 population-based search，log 变换更多影响 fitness ranking 的局部尺度、数值动态范围和多目标组合，而不是显式梯度逃逸。因此作者关于 gradient dynamics 的解释有一定合理性，但和实际算法之间存在解释缺口。
双 UAV 场景中，sin(theta) 是非常强的几何先验。它的有效性来自 bearing-only triangulation 的低维结构：距离、噪声等因素给出尺度，交角决定条件数。这个先验比单纯最大化总 FIM 更直接地约束“两个传感器应该看得不一样”。但它也可能过于理想化：等距、等噪声、无遮挡、无限 FOV 下 90 度交角最优；真实 UAV 系统中通信、视场、航迹安全和能耗会改变最优交角。
归因上，论文的强结果更像三个启发式机制的协同，而不是单一理论突破：motion constraint 提升搜索有效性，normalization 防止多目标尺度崩坏，angle prior 防止双机几何退化，log-det 稳定 FIM 项动态范围。若把它放进常见方法分类，它更接近 better inductive bias + test-time heuristic compute，而不是 scaling/data/retrieval/learning。
需要直接指出：单 UAV 99% 改善相对于 D+PSO baseline 可能放大了方法效果，因为 baseline 使用标准 PSO 且明显不适配动力学约束。真正公平的问题应是与其他 constrained trajectory optimizer、MPC、CMA-ES with dynamics、CBF observability planning 比较，而不是只和 naive PSO 比。
Relation To Prior Work
这篇属于 active perception / informative path planning / bearing-only observability-guided planning 的谱系，而不是定位滤波或视觉测量本身的工作。它接近 FIM/CRLB-based sensor trajectory optimization，也接近多 UAV cooperative bearing-only localization 中的 geometry-aware planning。
和传统 D-optimal FIM 路线的本质差异是：不改变最优信息准则，而改变在线优化过程中的目标尺度和退化边界行为。log-det 在优化和实验设计里并不新，甚至是标准 D-optimal 的常见形式；论文的新意在于把它包装为退化几何逃逸机制并嵌入 UAV bearing-only 在线规划。
和 formation-control / multi-UAV localization 的差异是：它没有预设静态队形，而是把交会角作为优化目标随目标状态更新。这个点比单纯队形控制更贴近机动目标 tracking，但仍停留在二机、单目标、理想几何层面。
和 learning-based IPP 相比，它不依赖训练数据，也没有 learned policy 的泛化问题；代价是每个 planning step 都要做启发式搜索，scalability 和实时性上限取决于 PSO 维度、粒子数和 UAV 数量。它本质上是 model-based online optimization，而不是 data-driven planner。
实质创新主要在组合方式：log-det FIM + 交会角先验 + 动力学可达 PSO + 归一化。单个组件都不是全新思想，但组合后针对 bearing-only UAV planning 的失败模式比较对症。
Dataset / Evaluation
评估完全是 MATLAB 仿真，没有真实世界数据、无真机飞行、无真实视觉 pipeline，也没有复杂场景变化。任务覆盖范围较窄：单目标、固定初始构型、固定噪声模型、固定规划频率、单/双 UAV 两种配置。它验证的是在受控几何和噪声条件下，所提 planner 能比 naive FIM+PSO 产生更好的观测几何。
实验支持“组合方法在这些仿真条件下优于 baseline”的 claim，但不足以支持“长时间、远距离、高机动目标下具有普适优势”的强表述。目标机动虽然包含加速度，但仍是简单轨迹模型；没有 abrupt maneuver、遮挡、视场约束、控制跟踪误差、异步观测、多目标干扰。
消融有价值，因为它揭示了增益来源：单 UAV 主要由 improved PSO 驱动；双 UAV 需要 angle objective 和 improved PSO 配合。这个消融反而削弱了论文对 spectral FIM 作为主要贡献的叙事。文中未充分说明为什么与更强的 constrained optimizer 或 MPC-based planner 相比仍有优势。
另一个评估问题是 baseline 偏弱。D+PSO 若不满足可达约束，本身就不是实际可部署方法；用它作为主要对照会高估提升。更合理的 benchmark 应包括 constrained D-opt MPC、log-det with standard constrained optimizer、CMA-ES in reachable set、以及显式 bearing-separation constraints。
Limitation
第一，方法依赖目标状态预测和初始观测积累。论文承认需要先沿预设轨迹观测一段时间，否则收敛慢或失败。这说明 planner 不是从零解决 bearing-only 初始化问题，而是在已有较可靠估计的基础上优化后续几何。
第二，目标运动模型假设较强。文中使用短时匀加速/轨迹阶次近似；如果目标突然机动，FIM 基于预测状态构造，规划方向可能立刻失效。这里的 active perception 不是 robust planning under adversarial maneuver，而是 model-predictive geometry shaping。
第三，scalability 不清楚。PSO 在单步 waypoint 层面还可用，但扩展到长 horizon、多 UAV、多目标、避障、FOV、通信约束后维度会快速上升。论文没有证明该方法比 MPC/CEM/CMA-ES 或 sampling-based IPP 更可扩展。
第四，log-det 的效果归因不够干净。理论上它改变梯度，但实际优化器是 PSO；单 UAV 消融显示 spectral objective 单独几乎无效。其真正作用可能主要是数值尺度压缩和 multi-objective balancing，而不是所谓退化附近梯度逃逸。
第五，双 UAV 的 sin(theta) 先验有隐含前提：两平台噪声相同、距离相近、目标位置已知到足以计算交角、无视场/遮挡/安全间隔/能耗约束。现实中最优几何未必是单纯 90 度交会。
第六，实验没有闭环控制误差和真实视觉误差。论文说 motion-constrained PSO 保证可执行，但可达 waypoint 不等于飞控能精准跟踪，也不等于相机能持续观测目标。deployment gap 仍然很大。
Takeaway
- 1. 对 bearing-only active perception，最重要的不是无限提高测角精度，而是避免 FIM 最小谱方向塌缩；planner 应该显式优化观测几何条件数，而不是只堆测量。
- 2. log-det 作为 D-optimality 的单调变换，在退化边界附近比 raw det 更适合在线优化和多目标组合；这个 insight 可迁移到其他信息矩阵接近奇异的 active sensing 问题。
- 3. 对机器人 informative planning，优化变量必须从一开始就在可达域中定义。
- 很多看似信息目标失败的问题，其实是搜索空间和动力学不匹配。
一句话总结
这篇论文是一个针对 UAV bearing-only active localization 的 model-based 几何规划增强方案，真正贡献在于把退化规避、双机交会角先验和动力学可达搜索结合起来，而不是提出新的定位理论。