This paper proposes a heading fault tolerance scheme for operation-level underwater robots subject to external interference.The scheme is based on a double-criterion fault detection method using a redundant structure ...This paper proposes a heading fault tolerance scheme for operation-level underwater robots subject to external interference.The scheme is based on a double-criterion fault detection method using a redundant structure of a dual electronic compass.First,two subexpansion Kalman filters are set up to fuse data with an inertial attitude measurement system.Then,fault detection can effectively identify the fault sensor and fault source.Finally,a fault-tolerant algorithm is used to isolate and alarm the faulty sensor.The program can effectively detect the constant magnetic field interference,change the magnetic field interference and small transient magnetic field interference,and conduct fault tolerance control in time to ensure the heading accuracy of the system.Test verification shows that the system is practical and effective.展开更多
基金supported by the Natural Science Foundation of Heilongjiang Province(E2017024)13th Five-Year Pre-Research(J040717005)+1 种基金National Defense Basic Research(A0420132202)China International Ministry of Science and Technology International Cooperation Project(2014DFR10010)
文摘This paper proposes a heading fault tolerance scheme for operation-level underwater robots subject to external interference.The scheme is based on a double-criterion fault detection method using a redundant structure of a dual electronic compass.First,two subexpansion Kalman filters are set up to fuse data with an inertial attitude measurement system.Then,fault detection can effectively identify the fault sensor and fault source.Finally,a fault-tolerant algorithm is used to isolate and alarm the faulty sensor.The program can effectively detect the constant magnetic field interference,change the magnetic field interference and small transient magnetic field interference,and conduct fault tolerance control in time to ensure the heading accuracy of the system.Test verification shows that the system is practical and effective.