[论文解读] SE(3) based Extended Kalman Filter for Spacecraft Attitude Estimation
本文提出了一种基于SE(3)的扩展卡尔曼滤波器（SE(3)-EKF），通过将姿态和陀螺仪偏差建模为特殊欧几里得群SE(3)的元素，实现对航天器姿态的估计。通过利用SE(3)的几何结构，SE(3)-EKF提供了一个统一的框架，恢复了几何扩展卡尔曼滤波器（GEKF），并为不变性滤波提供了新视角，与右不变EKF具有紧密的理论联系，并在姿态估计中表现出更强的数值稳定性。
In this paper, the spacecraft attitude estimation problem has been investigated making use of the concept of matrix Lie group. Through formulation of the attitude and gyroscope bias as elements of SE(3), the corresponding extended Kalman filter, termed as SE(3)-EKF, has been derived. It is shown that the resulting SE(3)-EKF is just the newly-derived geometric extended Kalman filter (GEKF) for spacecraft attitude estimation. This provides a new perspective on the GEKF besides the common frame errors definition. Moreover, the SE(3)-EKF with reference frame attitude error is also derived and the resulting algorithm bears much resemblance to the right invariant EKF.
研究动机与目标
- 解决传统姿态估计方法依赖欧拉角或四元数等局部参数化方式所带来的局限性。
- 开发一种几何上一致的滤波框架，尊重航天器姿态与陀螺仪偏差的内在流形结构。
- 通过SE(3)群的表述，提供几何扩展卡尔曼滤波器（GEKF）的新推导。
- 建立SE(3)-EKF与现有不变EKF方法（尤其是右不变EKF）之间的理论联系。
- 改善数值条件，避免传统EKF方法中使用四元数或欧拉角时固有的奇异性。
提出的方法
- 将航天器姿态与陀螺仪偏差表示为SE(3)李群的元素，将旋转与平移统一于一个状态空间中。
- 利用SE(3)上的矩阵指数与对数映射推导状态转移模型与测量模型，以确保几何一致性。
- 通过在群元素处的切空间对系统动力学与测量模型进行线性化，构建SE(3)-EKF。
- 利用群结构通过对数映射定义误差状态，确保估计误差保持在切空间内，从而保持几何不变性。
- 通过SE(3)上状态转移与测量函数的雅可比矩阵推导协方差更新方程，保持与群代数性质的一致性。
- 证明所得滤波器等价于几何EKF（GEKF），并与右不变EKF在结构上具有相似性，验证其几何基础。
实验结果
研究问题
- RQ1如何通过SE(3)李群重新表述姿态与陀螺仪偏差估计问题，以提升几何一致性？
- RQ2SE(3)-EKF与现有几何扩展卡尔曼滤波器（GEKF）在公式化与性能方面有何关系？
- RQ3能否证明SE(3)-EKF与右不变EKF等价或密切相关，从而验证其不变性特性？
- RQ4与使用四元数或欧拉角的传统EKF方法相比，SE(3)-EKF如何避免奇异性并改善数值条件？
- RQ5在航天器姿态估计中，使用SE(3)框架对设计不变观测器有何影响？
主要发现
- SE(3)-EKF在数学上等价于几何扩展卡尔曼滤波器（GEKF），并通过SE(3)群结构为GEKF提供了新的几何推导。
- 该滤波器公式自然避免了欧拉角等局部参数化中常见的奇异性与坐标奇异性。
- 通过参考坐标系姿态误差的SE(3)-EKF与右不变EKF高度相似，证实其在群作用下的不变性特性。
- 使用对数映射表示误差可确保估计误差始终位于SE(3)的切空间内，从而保持几何结构。
- 所提出的方法提供了一个统一框架，将姿态与偏差估计整合于单一李群中，增强了数值稳定性与一致性。
- 与GEKF及右不变EKF的理论等价性，确立了SE(3)-EKF作为传统EKF方法在航天器姿态估计中一种稳健且几何上合理的替代方案。
更好的研究，从现在开始
从阅读论文到最终审阅，大幅缩短您的研究时间。
无需绑定信用卡
本解读由 AI 生成，并经人工编辑审核。