Unscented Kalman filter (UKF)-based underwater robot state and parameter joint estimation method

Abstract

The invention discloses an unscented Kalman filter (UKF)-based underwater robot state and parameter joint estimation method. According to the method, expansion reference models of an underwater robot are established, and comprise a kinetic model of the underwater robot and a fault model of a propeller. According to pose information detected by a position sensor, the expansion reference models are subjected to on-line joint estimation through states of the underwater robot, including pose and speed, and propeller fault parameters by a UKF algorithm, and the speed information of the underwater robot and the propeller fault information are estimated in real time. The method has a high real-time property, and the states and parameters of a system can be subjected to joint estimation; and under the condition that prior information of process noise and measurement noise is known, high estimation accuracy can be achieved by the method.

Description

Technical field [0001] The invention relates to a joint estimation method of the state and parameters of an underwater robot based on the Unscented Kalman Filter (UKF), in particular to a joint estimation method of the state and thruster fault parameters of an underwater robot based on the UKF. technical background [0002] With the rapid development of marine development, there are more and more underwater construction and construction projects, and the performance requirements for underwater action means are getting higher and higher. Since underwater robots can observe, photograph, salvage and construction operations underwater, they are widely used in marine development. With the continuous development and maturity of underwater robot technology, its missions are becoming more and more complicated. In many cases, the environment of underwater robots mainly includes their own behavior environment, external natural environment, target environment, etc., which are complex and un...

AI Technical Summary

Problems solved by technology

Traditional pre-programmed underwater robots generally take measures such as dumping and floating when detecting a fault in the propeller. In fact, in many cases, the propeller of the underwater robot is not completely invalid. If the efficiency loss factor can be identified in real time , and then redistribute the thrust, the underwater robot may still complete the expected task

Images