首页/论文/2004.00828

arXiv 2004.008282020-04eess.SYcs.SY

李群上运动系统的等变滤波器设计

Equivariant Filter Design for Kinematic Systems on Lie Groups

Robert Mahony, Jochen Trumpf

摘要：

众所周知，李群上系统的不变性和等变性可以用于设计高性能和鲁棒的观测器和滤波器，用于现实世界的机器人系统。本文提出了一个分析框架，允许李群上的任何运动系统以自然的方式嵌入到一个等变运动系统。这个框架使我们能够描述不变系统、群仿射系统和等变系统的性质和它们之间的关系。我们提出了一种新的滤波器设计，等变滤波器（EqF），利用系统嵌入的等方差特性，可以应用于李群上的任何运动系统。

英文摘要：

It is known that invariance and equivariance properties for systems on Lie groups can be exploited in the design of high performance and robust observers and filters for real-world robotic systems. This paper proposes an analysis framework that allows any kinematic system on a Lie group to be embedded in a natural manner into an equivariant kinematic system. This framework allows us to characterise the properties of, and relationships between, invariant systems, group affine systems, and equivariant systems. We propose a new filter design, the Equivariant Filter (EqF), that exploits the equivariance properties of the system embedding and can be applied to any kinematic system on a Lie group.

机构、总结、中文摘要均由AI分析而来，可能存在错误，请以论文正文为准。

阅读原文

阅读 PDF ↗

arXiv 页面 ↗HTML 原文 ↗

本文内容

摘要英文摘要相关论文

机构、总结、中文摘要均由AI分析而来，可能存在错误，请以论文正文为准。

继续探索

相关论文

矩阵李群上二阶运动系统的等变系统理论与观测器设计

Equivariant Systems Theory and Observer Design for Second Order Kinematic Systems on Matrix Lie Groups

本文给出了矩阵李群上二阶运动系统的等变系统理论和观测器设计。矩阵李群上二阶运动系统的状态自然地置于群的切丛上，输入位于切丛的切线上，称为双切丛。我们提供了一个简单的参数化的切丛状态空间和输入空间（双切丛的纤维空间），然后引入一个半直积群和群作用的状态和输入空间。我们表明，与建议的组行动的二阶运动学是等变的。定义了运动学到对称群上的等变提升，并利用非线性构造性设计技术在提升的状态空间上设计了非线性观测器。一个简单的气垫船仿真验证了我们的观测器的性能。

2021-05-11cs.SYeess.SY

等变滤波器（EqF）：齐次空间上系统的一般滤波器设计

Equivariant filter (EqF): A general filter design for systems on homogeneous spaces

在机器人和其他领域中遇到的许多机械系统的运动学，例如单轴承姿态估计和SLAM，自然地被置于齐次空间上：也就是说，它们的状态位于具有传递李群对称性的光滑流形上。本文证明了在齐次空间中的任何系统都可以推广到在对称作用下等变的更大的系统。利用系统的等变结构，提出了一种新的新的过滤器，等变过滤器（EqF），基于线性化的全球误差动态来自对称行动。将EqF应用于估计固定地标相对于移动单目相机的位置的示例，这对于之前提出的基于对称性的滤波器设计方法来说是棘手的。

2021-07-12cs.SYeess.SY

离散时间系统的等变滤波器设计

Equivariant Filter Design for Discrete-time systems

许多非线性控制系统的运动学，特别是在机器人领域，承认一个传递李群对称，这是有用的高性能观测器的设计。最近提出的等变滤波器（EqF）利用等方差生成高性能的过滤器，为广泛的现实世界的系统。然而，现有的等变滤波器和控制系统的等变一般是基于连续时间公式。本文首先给出了离散时间系统的等变结构。然后，我们使用这个提出一个离散时间版本的等变滤波器。该方法的新颖之处在于，对称群的几何形状自然地出现在滤波器的重置步骤中作为并行传输。线性二阶运动学与单独的轴承和范围测量的初步结果表明，离散EqF显着优于离散版本的连续EqF和经典的离散EKF。

2022-09-12cs.SYeess.SY

一种用于航天器非线性相对导航的等变滤波器，基于距离和方位测量

An Equivariant Filter for Spacecraft Nonlinear Relative Navigation with Range and Bearing Measurements

Institute for Systems and Robotics, Laboratory of Robotics and Engineering Systems, Instituto Superior Técnico, University of Lisbon（里斯本大学技术学院系统与机器人研究所机器人与系统工程实验室）；CTS/Uninova and LASI, School of Science and Technology, NOVA University Lisbon（新里斯本大学理学院科学和技术中心/创新研究所激光与智能系统研究所）；GNC Division, Flight Segment and Robotics, GMV（GMV公司飞行段与机器人部门制导导航与控制分部）

针对航天器相对导航，利用非线性轨道动力学的等变李群对称性设计等变滤波器，通过群提升估计相对位置与速度，仿真验证其有效性。

2026-09-14cs.SYeess.SY

等变滤波器是等变的

Equivariant Filters are Equivariant

李群对称系统的观测器是一个活跃的研究领域，在许多实际领域，包括航空航天，机器人和机电一体化，都有着重大的影响。本文建立在最近提出的等变滤波器（EqF）的理论，这是一个一般的观察器设计系统的齐次空间，利用对称性，以产生显着的性能优势。结果表明，EqF误差动态是不变的输入信号的变换和等变的参数化向量场。主要定理表明，两个EqF的不同选择的本地坐标和原点和等效噪声建模产生相同的性能。换句话说，EqF是系统方程和对称性的固有性质。这在一个2D机器人定位问题的仿真中得到了验证，该仿真还显示了为EqF选择原点的能力如何通过减轻浮点精度误差来产生实际的性能优势。

2022-10-25cs.SYeess.SY

等变滤波器（EqF）

Equivariant Filter (EqF)

Systems Theory and Robotics Group（系统理论与机器人组）；Australian Centre for Robotic Vision（澳大利亚机器人视觉中心）；Australian National University（澳大利亚国立大学）；I3S (University Côte d’Azur, CNRS, Sophia Antipolis)（I3S（蔚蓝海岸大学、法国国家科学研究中心、索菲亚安提波利斯））；Insitut Universitaire de France（法兰西学院）

等变滤波器通过利用系统输出的等变性减少线性化误差，提高滤波性能。

2026-01-16cs.SYeess.SY

更多相关论文收起更多论文

用于相对姿态、目标角速度和陀螺仪偏置估计的等变滤波级联

Equivariant Filter Cascade for Relative Attitude, Target's Angular Velocity, and Gyroscope Bias Estimation

本文提出了一种等变滤波器级联方法，用于估计相对姿态、目标角速度和陀螺仪偏置，通过星跟踪器和非共线向量观测实现稳定估计。

2025-12-16cs.SYeess.SY

EqVIO：一种用于视觉惯性里程计的等变滤波器

EqVIO: An Equivariant Filter for Visual Inertial Odometry

Systems Theory and Robotics Group（系统理论与机器人组）；Australian Centre for Robotic Vision（澳大利亚机器人视觉中心）；Australian National University（澳大利亚国立大学）

本文提出基于李群对称性的等变滤波器EqVIO，通过改进滤波一致性与降低线性化误差，提升了视觉惯性里程计的精度和效率。

2026-01-16cs.ROcs.SYeess.SY

具有输入测量偏差的惯性导航系统等变滤波器设计

Equivariant Filter Design for Inertial Navigation Systems with Input Measurement Biases

University of Klagenfurt（克拉根福大学）；Australian National University（澳大利亚国立大学）

惯性导航系统（INS）是自主车辆应用的关键技术。INS问题的估计和滤波器设计的最新进展已经利用几何和对称性来克服经典的扩展卡尔曼滤波器（EKF）方法的局限性，该方法自二十世纪中期以来形成了INS系统的主流。工业标准INS滤波器，乘法扩展卡尔曼滤波器（MEKF），使用几何构造用于姿态估计，与经典的欧几里德构造耦合用于位置、速度和偏差估计。最新的不变扩展卡尔曼滤波器（IEKF）提供了一个完整的导航状态的几何框架，集成了姿态、位置和速度，但仍然使用经典的欧几里德结构来建模偏差状态。在本文中，我们使用最近提出的等变滤波器（EqF）的框架，推导出一种新的观测器偏置惯性导航在一个完整的几何框架。引入具有相关虚拟偏差的虚拟速度输入会导致增强系统上的完全等变对称性。由此产生的滤波器性能与模拟和真实世界的数据进行评估，并证明了增加的鲁棒性，以广泛的错误的初始条件，并提高精度相比，行业标准的乘法EKF（MEKF）的方法。

2022-02-04cs.ROcs.SYeess.SY

迭代等变滤波器

The Iterative Equivariant Filter

The University of Sydney（悉尼大学）；McGill University（麦吉尔大学）

本文提出迭代等变滤波器（IterEqF），结合迭代扩展卡尔曼滤波与等变滤波的优点，通过迭代更新和协方差重置提升移动机器人距离定位的精度，尤其在瞬态收敛阶段表现更优。

2026-09-14cs.ROcs.SYeess.SY

等方差非线性系统的观测器设计

Observer Design for Nonlinear Systems with Equivariance

等方差是许多非线性控制系统的共同和自然属性，特别是那些与机电和导航系统模型相关的系统。这样的系统承认一个对称性，相关的等方差，提供结构，使设计强大的和高性能的观察员。一个关键的见解是使观察者状态位于对称群中，而不是位于系统状态空间中。这使得人们可以定义一个全局定义的内在等变误差，但在定义内部动态的观察员提出了挑战。通过选择的观测器内部模型的系统动态的等变升降机，我们表明，误差动态有一个特别好的形式。将扩展卡尔曼滤波（EKF）方法应用于等变误差状态，得到等变滤波器（EqF）。状态空间流形的几何形状自然地表现为对经典EKF Riccati方程的曲率修正。等变滤波器利用对称性，并尊重等变系统模型的几何形状，并产生高性能的鲁棒滤波器，用于各种机电和导航系统。

2022-05-06cs.SYeess.SY

等变对称性用于辅助惯性导航

Equivariant Symmetries for Aided Inertial Navigation

University of Klagenfurt（克拉根福大学）；Australian National University（澳大利亚国立大学）；University of Toronto（多伦多大学）；University of Minnesota（明尼苏达大学）

本论文利用等变系统理论，引入切群对称性以几何处理IMU偏差，推导出具有自主误差动态的等变滤波器（EqF），在精度、收敛速度、鲁棒性和一致性上优于最先进方法，并形式化了滤波器与对称性选择的关系。

2024-07-19cs.ROcs.SYeess.SY

仅测距SLAM的等变滤波器设计

Equivariant Filter Design for Range-only SLAM

Australian National University（澳大利亚国立大学）；University of Twente（特文特大学）

针对仅测距SLAM问题，基于与距离测量兼容的对称李群推导出等变滤波器（EqF），无需地标位置初始化且对无先验情况具有鲁棒性，在真实数据集上准确性和鲁棒性显著优于EKF。

2025-03-05cs.ROcs.SYeess.SY

MSCEqF：一种用于视觉辅助惯性导航的多状态约束等变滤波器

MSCEqF: A Multi State Constraint Equivariant Filter for Vision-aided Inertial Navigation

University of Klagenfurt（克拉根福大学）；Australian National University（澳大利亚国立大学）

针对VINS问题提出多状态约束等变滤波器MSCEqF，通过定义包含IMU偏置和相机标定的对称群结构，解决了现有IEKF方法状态附加问题，在显著误差下保持内在一致性，显著提升了估计性能。

2023-11-20cs.ROcs.SYeess.SY

等变系统理论与观测器设计

Equivariant Systems Theory and Observer Design

现代机器人和航空电子应用中的大量系统模型都承认自然对称性。这样的系统被称为等变的和结构所提供的对称性是一个强大的工具，在设计的观察员。在过去的十年中，已经取得了显着的进展，在设计的滤波器和观察器的姿态和姿态估计，跟踪单应性，和速度辅助姿态估计，利用其固有的李群状态空间结构。然而，几乎没有工作已经做了系统的齐次空间，这是系统的流形上的李群的行为，而不是系统的李群本身。机器人视觉领域的最新研究发现了齐次空间上的对称性和等变结构，这些问题包括视觉里程计和视觉同时定位和映射的关键问题。这些发现激发了对齐次空间上的等变系统的结构的更深入的研究。本文提供了一个全面发展的基础理论进行观测器和滤波器设计这样的系统。

2020-08-30cs.SYeess.SY

紧耦合激光雷达-惯性里程计的等变滤波器

Equivariant Filter for Tightly Coupled LiDAR-Inertial Odometry

School of Geodesy and Geomatics, Wuhan University（武汉大学测绘学院）；GNSS Research Center, Wuhan University（武汉大学卫星导航定位技术研究中心）

针对传统EKF在处理IMU和LiDAR模型非线性时的不足，提出基于等变滤波器的紧耦合LIO状态估计器Eq-LIO，利用半直积群对称性耦合系统状态以抑制线性化误差，提升了估计的一致性与鲁棒性。

2025-03-04cs.ROcs.SYeess.SY

克服偏差：面向带偏差姿态估计与在线标定的等变滤波器设计

Overcoming Bias: Equivariant Filter Design for Biased Attitude Estimation with Online Calibration

University of Klagenfurt（克拉根福大学）；Australian National University（澳大利亚国立大学）

本文提出一种基于等变几何结构的陀螺仪辅助姿态估计器新公式，将导航、外参标定和陀螺仪偏差状态集成于单一对称性中，显著提升了瞬态响应及渐近偏差和外参标定估计性能。

2022-09-24cs.ROcs.SYeess.SY

相对姿态与目标角速度估计的等变滤波器

Equivariant Filter for Relative Attitude and Target's Angular Velocity Estimation

Institute for Systems and Robotics, Instituto Superior Técnico, Universidade de Lisboa（系统机器人研究所，技术高等学院，里斯本大学）；CTS/Uninova and LASI, School of Science and Technology at NOVA University Lisbon（CTS/Uninova 和 LASI，里斯本 NOVA 大学科学与技术学院）；GNC Division, Flight Segment and Robotics, GMV（飞行段与机器人部，GMV）

提出一种等变滤波器（EqF），利用两个已知非共线向量观测，同时估计相对姿态和目标角速度，并通过仿真和实验验证其性能。

2026-05-26cs.ROcs.SYeess.SY

等价滤波变换用于一致且高效的视觉-惯性导航

Equivariant Filter Transformations for Consistent and Efficient Visual--Inertial Navigation

School of Astronautics, Harbin Institute of Technology（哈尔滨工程大学航天学院）

本文提出了一种等价滤波变换方法，通过建立不同对称性的等价滤波器之间的分析联系，实现系统一致性设计和高效实现。

2026-09-03cs.ROcs.SYeess.SY

惯性导航系统的等变对称性

Equivariant Symmetries for Inertial Navigation Systems

Control of Networked Systems Group, University of Klagenfurt, Austria（网络化系统控制组，克雷格弗尔特大学）；Robotics Lab, Australian Centre for Robotic Vision, Australian National University, Australia（机器人实验室，澳大利亚机器人视觉中心，澳大利亚国立大学）

本文从对称性视角研究惯性导航系统滤波器设计，提出两种新对称性，并将现代EKF变体统一解释为等变滤波器方法，最后对IMU/GNSS组合导航中的不同滤波方案进行比较分析。

2025-06-03cs.ROcs.SYeess.SY

雅可比增广可行运动学安全滤波器

Jacobian State Augmented Viable Kinematic Safety Filter

Oak Ridge National Lab（橡树岭国家实验室）

本研究提出雅可比增广可行运动学安全滤波器，通过嵌套QP公式在线计算可行规划器，在2R平面机械臂仿真中，相比CBF-QP等方法，计算时间更优且可行性违规显著减少，还可扩展至多自由度机械臂。

2026-10-14cs.ROcs.SYeess.SY

适用于全球的辅助惯性导航系统的误差状态卡尔曼滤波器运动学推导

Derivations of Error-State Kalman Filter Kinematics for Globally Applicable Aided Inertial Navigation Systems

Airbus Central Research and Technology（空客中央研究与技术部）；Department of Engineering Cybernetics, Norwegian University of Science and Technology（挪威科技大学工程控制论系）

研究全球导航系统中处理地球曲率等因素的状态估计算法，通过不变误差状态卡尔曼滤波器利用李群对称性，给出四种经典和不变的误差状态卡尔曼滤波器数学公式供比较与实现。

2026-07-07cs.ROcs.SYeess.SY

水下机器人动力学和运动学模型驱动的扩展卡尔曼滤波器（EKF）定位比较

Comparison of Dynamic and Kinematic Model Driven Extended Kalman Filters (EKF) for the Localization of Autonomous Underwater Vehicles

University of Illinois at Urbana-Champaign（伊利诺伊大学厄巴纳-香槟分校）

自主水下航行器（AUV）和遥控潜水器（ROV）用于与勘探和科学研究有关的各种任务。这些系统的成功导航需要良好的定位系统。基于卡尔曼滤波器的定位技术自20世纪60年代初以来一直很流行，并且在开发和设计中使用它们进行了广泛的研究。已经发现，在卡尔曼滤波器中使用动态模型（而不是运动学模型）可以导致更准确的预测，因为动态模型考虑了作用在AUV上的力。提出了一种基于简化动力学模型的水下机器人运动预测扩展卡尔曼滤波器（EKF）。首先建立了水下机器人的动力学模型，然后对该模型进行了简化，该机器人是一种用于简单水下勘探、海底结构物、管道和沉船检测的潜水器。该滤波器在一个名为UUV模拟器的开源海洋车辆模拟器中用模拟车辆实现，并将结果与地面实况进行比较。结果表明，动态滤波器具有良好的预测精度，但在EKF可以实时使用之前需要改进。一些观点和讨论的实际实施，以显示这一概念所需的后续步骤。

2021-05-26cs.ROcs.SYeess.SY

使用李群约束扩展卡尔曼滤波器和减少的IMU计数估计下半身运动

Estimating Lower Body Kinematics using a Lie Group Constrained Extended Kalman Filter and Reduced IMU Count

目标：本文提出了一种算法，估计骨盆，大腿，小腿和脚的运动学在步行过程中，只有两个或三个可穿戴惯性传感器。方法：该算法采用了基于李群的扩展卡尔曼滤波器。该算法迭代预测（运动学方程）、测量（骨盆位置伪测量、零速度更新和平坦地板假设）和约束更新（铰链膝关节和踝关节、恒定腿长）。结果如下：惯性运动捕捉算法在两个数据集上进行了广泛的评估，这两个数据集显示了其相对于光学运动捕捉中的两个标准基准方法的性能（即，插入式步态（常用于步态分析）和运动学拟合（常用于动画、机器人和肌肉骨骼模拟）），深入了解不同应用领域中使用的所述方法之间的相似性和差异。我们的算法（$n=14$参与者）自由行走的总体平均身体节段位置（相对于骨盆中部原点）和方向误差幅度为$5.93 \pm 1.33$ cm和$13.43 \pm 1.89^\circ$（当使用放置在足部和骨盆上的三个IMU时），以及$6.35 \pm 1.20$ cm和$12.71 \pm 1.60^\circ$（当仅使用放置在足部上的两个IMU时）。结论：该算法能够很好地跟踪直线行走的矢状面中的关节角度，但需要改进无脚本运动（例如，转身，侧步），尤其是对于动态运动或考虑临床应用时。意义：这项工作使我们更接近使用鞋子上的IMU进行全面的远程步态监测。低计算成本也表明它可以与步态辅助设备实时使用。

2021-03-21cs.ROcs.SYeess.SY

惯性导航的构造性等变观测器设计

Constructive Equivariant Observer Design for Inertial Navigation

针对惯性导航系统中扩展卡尔曼滤波器缺乏强稳定性保证的问题，本文利用李群对称性提出首个误差动力学几乎全局渐近且局部指数稳定的非线性观测器，仅靠GNSS位置辅助，仿真验证其可从极端初始误差收敛。

2023-08-22cs.SYeess.SY

大地坐标系下的无迹卡尔曼滤波器远程船舶跟踪

Unscented Kalman Filter for Long-Distance Vessel Tracking in Geodetic Coordinates

Massachusetts Institute of Technology（麻省理工学院）

本文介绍了一种新的跟踪滤波器，主要用于自动地面车辆（ASV）的防撞系统。所提出的方法利用实时动态信息广播通过自动信息系统（AIS）的消息协议，以估计附近的合作目标的位置，速度和航向。每个目标的状态递归估计在大地坐标系中使用无迹卡尔曼滤波器（UKF）与运动学方程推导出的余弦球定律。这改进了以前的方法，其中许多采用扩展的卡尔曼滤波器（EKF），因此需要一个局部平面坐标系的规格，以便于描述的状态运动学在一个容易微分的形式。建议的大地UKF消除了对这个本地平面的需要。该特征对于远程ASV特别有利，否则远程ASV必须周期性地重新定义新的局部平面以减少线性化误差。在现实世界的行动中，这种重复的重新定义可能会引入错误并使任务规划复杂化。通过仿真和现场测试表明，建议的大地UKF执行以及，或优于传统的平面笛卡尔EKF，无论是在估计误差和稳定性。

2021-11-25cs.AIcs.ROcs.SY