The kinematics of many nonlinear control systems, especially in the robotics field, admit a transitive Lie-group symmetry, which is useful in high performance observer design. The recently proposed equivariant filter (EqF) exploits equivariance to generate high performance filters for a wide range of real-world systems. However, existing work on the equivariant filter, and equivariance of control systems in general, is based on a continuous-time formulation. In this paper, we first present the equivariant structure of a discrete-time system. We then use this to propose a discrete-time version of the equivariant filter. A novelty of the approach is that the geometry of the symmetry group naturally appears as parallel transport in the reset step of the filter. Preliminary results for linear second order kinematics with separate bearing and range measurements indicate that the discrete EqF significantly outperforms both a discretized version of the continuous EqF and a classical discrete EKF.
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公司飞行段与机器人部门制导导航与控制分部)
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(法兰西学院)
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)
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(机器人实验室,澳大利亚机器人视觉中心,澳大利亚国立大学)