精读笔记
Problem Setting
[Motor Angular Speed Preintegration for Multirotor UAV State Estimation]（arXiv preprint / 2026-06-19）
这篇论文实际处理的是 UAV 上高频状态传播源的失效问题。LiDAR/VO 给出的 pose constraint 频率低，需要一个高频运动先验补齐 scan/image 之间的状态；传统选择是 IMU preintegration，但在多旋翼上 IMU 正好处在最糟糕的测量环境里：桨叶振动强、MEMS 噪声高、滤波带来延迟、外参/时间同步/内参标定敏感。真正困难点不是写一个新的 odometry，而是找到一个在 UAV 机体上比 IMU 更适合作为高频 propagation source 的信号。
关键矛盾是：控制和状态估计需要高频、低延迟、低噪声的速度/加速度信息；但通用 inertial sensing 在多旋翼平台上被平台自身推进系统破坏。已有 LIO/VIO 的优势在 ground vehicle / handheld 场景中成立，但搬到 UAV 后，IMU 不是天然可靠的 motion prior。论文的切入点就是把“测运动结果”的 IMU 换成“测产生运动原因”的 motor angular speed。
Motivation
已有路线主要在 IMU 上做补救：机械减振、低通/陷波滤波、精细标定、在线校准、甚至 learned denoising。这些方法的问题是它们都在修复一个被推进系统污染后的信号，而且修复通常引入额外延迟或新的不可观问题。对 agile flight 来说，这个代价很实质，因为反馈控制更关心及时且干净的速度/加速度，而不是离线轨迹是否平滑。
作者的核心观察是：ESC 报告的电机转速本身是推进系统内部信号，不会像 IMU 那样被机体振动污染；同时它又直接决定 thrust/torque，是 UAV 动力学的上游变量。缺口在于，过去 MAS 多用于控制增强或作为 IMU/VIO 的辅助项，没有被系统性地构造成可以替代 IMU preintegration 的 factor。论文要补的是这个建模层面的空位。
Core Idea
核心思想很直接但有价值：不要把 UAV 当成一个携带 IMU 的刚体来估计，而是把它当成一个由若干已知转速螺旋桨驱动的动力系统来估计。每个 rotor 的 angular speed 经推进模型生成 body-frame force/torque，再得到 linear/angular acceleration；这些 acceleration 不逐点加入图，而是在局部切空间预积分成相邻状态之间的 full-state delta constraint。
本质区别在于信息流被重新组织了：IMU preintegration 是从外部测得的 acceleration/angular rate 推 state；MAS preintegration 是从 actuator-side 的 motor speed 通过动力学模型推 acceleration，再推 state。前者的 inductive bias 是“惯性测量可信”，后者是“推进模型在短时窗口内足够可信，剩余误差可由 bias 和低频 pose constraint 修正”。这使它在 UAV 场景中可能更 scalable：不需要为每个平台把 IMU 振动隔离做到极致，而是利用 ESC 已经提供的高频、低噪信号。
Method
方法里真正关键的不是 MAS-LO 这个完整系统，而是 MAS factor 的构造。
第一，推进模型把每个电机转速平方映射为 thrust 和 drag torque，再根据 rotor geometry、mass、inertia 得到 body-frame linear/angular acceleration。它解决的是高频 motion prior 的来源问题；核心变化是把观测从 IMU 的结果侧测量移到 actuator/propulsion 的原因侧测量。
第二，MAS preintegration 在局部坐标中累计 position、rotation、linear velocity、angular velocity 的增量，并传播 covariance。它解决的是计算和优化一致性问题：如果每个 MAS sample 都进 factor graph，图会过大；如果每次线性化都重积分，又无法实时。局部切空间预积分让 delta measurement 与初始状态解耦，这是它能直接替代 IMU factor 的关键。
第三，bias factor 把随机游走 bias、常量 offset、COG 偏移、未建模气动、参数误差和外扰都压进 acceleration bias。它解决的是模型不完美问题，但也意味着方法的成功并不等价于推进模型完全准确，而是“模型 + bias + LiDAR constraint”组成的闭环足够可观。
第四，LiDAR odometry 只负责提供低频 pose constraint 来压制双积分漂移。MAS 本身不是独立定位源；它承担的是 scan 间 propagation 和 velocity/acceleration 估计增强。
Key Insight / Why It Works
这篇最重要的 insight 是：在多旋翼上，IMU 的高频性并不自动等于高质量；motor speed 频率虽然可能更低，但它的噪声结构更适合估计线性动力学。MAS 有效的原因不是更复杂的优化，而是更好的 inductive bias：UAV 的短时平动加速度高度受 thrust 支配，而 thrust 又主要由 rotor speed 决定。只要 LiDAR 周期内外扰不至于主导、参数误差可被 bias 吸收，MAS 给出的线加速度就可能比被振动污染的 IMU 更接近有用信号。
最可能的核心贡献是“MAS preintegration as a drop-in factor”，而不是 MAS-LO 的 LiDAR 部分。LiDAR odometry 基本沿用 LIO-SAM 思路，engineering 成分较多；真正新增的信息是把 actuator dynamics 变成 factor graph 中的可复用高频约束。这个贡献的价值在于接口层面：它让已有 GTSAM-based inertial methods 有机会把 IMU factor 换成或补充为 MAS factor。
增益主要不是 scaling，也不是 data coverage，更不是 learning/retrieval；它是更合适的 representation alignment：把估计变量、控制输入、推进模型和传感信号对齐到了同一个动力学因果链上。线速度提升大而姿态误差变差也符合这个判断：MAS 对 thrust-driven translation 更强，对 rotation 尤其姿态积分链条更脆弱，因为角运动从 torque 到 angular acceleration 再到 angular velocity/orientation，积分层级和模型误差都更重。
需要警惕的是 bias term 的作用很大。论文声称参数鲁棒，但这种鲁棒可能部分来自 bias factor 和 LiDAR pose constraint 对模型错误的吸收，而不是 MAS 模型天然准确。换句话说，MAS factor 的贡献可能是提供了低噪、方向大致正确的短时动力学先验；精确物理建模并不是唯一增益来源。
Relation To Prior Work
它最接近两条谱系：一条是 IMU preintegration / factor-graph LIO/VIO，另一条是 model-based UAV dynamics estimation / motor speed feedback。论文的新意不是发明预积分，也不是首次使用 motor speed，而是把 MAS 组织成与 IMU preintegration 同等地位的 on-manifold factor。
相对 LIO-SAM、VINS、OKVIS 这类方法，区别在于高频先验源从 inertial measurement 变成 propulsion-derived acceleration。图优化、滑窗、LiDAR scan matching 都不是实质创新。相对 VIMO、Burri dynamics EKF、MAS+IMU UKF、hybrid dynamics VIO 等工作，区别在于它不把 MAS 当辅助项，而是主张 MAS 可独立承担 propagation，至少在线性状态估计上可替代 IMU。
看似新的 MAS-LO 系统本质上是已有 LO/SAM 框架加一个新 motion factor；实质创新集中在 MAS preintegration 的数学封装、噪声传播、bias 建模，以及证明它可在真实 UAV 数据上替代 IMU factor。它属于“platform-specific dynamics prior 替代 generic inertial prior”的方法演化。
Dataset / Evaluation
评估是实机户外飞行，有 LiDAR、IMU、MAS、RTK ground truth，覆盖 hover、单轴运动、矩形、loop 等不同运动模式；这比纯仿真或 mocap 室内小范围实验更有说服力。它确实验证了核心 claim 的一部分：在同一类 LiDAR odometry 框架下，用 MAS preintegration 替换 IMU preintegration，可以显著改善平移和速度估计，并降低经滤波 IMU 带来的测量延迟。
但评估仍然偏窄：单一 UAV 平台、单一推进系统、单一 LiDAR 配置、主要是中等动态户外飞行。它没有充分覆盖强风、近地效应、载荷变化、桨叶老化/损伤、高速前飞气动、室内退化 LiDAR 环境或 aggressive racing 级机动。姿态 ground truth 还依赖 FCU 内部估计而不是独立高精度姿态真值，这会影响 rotation error 解读。
benchmark 基本支持“MAS 对线性状态估计有优势”，但不足以支持“MAS 可以普遍替代 IMU”。更合理的结论是：MAS 是 UAV 场景下很强的 propagation factor，尤其适合补 IMU 的线加速度短板；完全替代 IMU 在旋转估计上还没有被证明。
Limitation
最大前提是多旋翼动力学模型在短时窗口内足够有效。转速到 thrust/torque 的映射依赖桨、气流、ESC、空气密度、电池状态、载荷和机体结构；论文用 bias 吸收未建模项，但这也把问题从传感噪声转移到模型误差可观性上。若外扰持续、强风主导、地效明显或 payload 改变 COG，bias 可能不再只是慢变小误差。
MAS 不是 self-contained localization。它仍然双积分漂移，必须依赖 LiDAR/视觉/GNSS 等低频约束。因此它解决的是 high-rate propagation 的质量问题，不解决全局可观性问题。在 LiDAR 退化场景中，MAS 不能像 magic prior 一样防止长期漂移。
旋转估计是明显短板。IMU gyroscope 直接测 angular rate，而 MAS 需要从 torque 推 angular acceleration 再积分到 angular velocity/orientation；这条链对 inertia、drag torque coefficient、rotor geometry 和未建模 moment 都敏感。论文结果中 ARE 变差不是偶然现象，而是方法建模选择的结构性代价。
参数鲁棒性的结论要谨慎。文中展示单参数扫描，但不是联合参数扰动，也不是跨平台验证。增益来源不清的一点是：究竟多少来自 MAS 信号低噪，多少来自 bias factor 的强吸收能力，多少来自 LIO-SAM baseline 的 IMU 数据被滤波/振动严重污染。
Takeaway
- 1. 最值得迁移的 insight 是 actuator-side sensing 可以成为比 inertial sensing 更合适的高频 motion prior，尤其在平台自身制造强传感污染时。
- 2. MAS factor 的价值在于接口化：把平台动力学封装成可插拔 preintegrated factor，而不是为某个 LO 系统写死一套 pipeline。
- 未来更自然的方向不是 MAS-only，而是 MAS + IMU + LiDAR/Vision 的互补融合。
- 3. 这篇推动的是 UAV state estimation 的建模视角转变：从 generic sensor fusion 转向 platform-aware dynamics fusion。
一句话总结
这篇论文把多旋翼 UAV 的高频状态传播从 IMU-centric 改为 propulsion-dynamics-centric，真正贡献是把电机转速预积分成可替代 IMU factor 的平台动力学先验，而不是一个新的 LiDAR odometry 系统。