The invention discloses a centrosymmetric multi-
cell-body-based
Kalman filter AUV Doppler velocimeter fault
interval estimation method, a program, equipment and a storage medium, and belongs to the field of autonomous
underwater robot fault diagnosis. The method comprises the following steps: firstly, acquiring a
state space system model through a
system identification method, and constructing an augmented
system equivalent to an original system by taking a sensor fault as an auxiliary
state vector; then, in combination with Kalman filtering and a centrosymmetric polytope, all possible states are contained in the centrosymmetric polytope through prediction and updating; and finally, performing interval envelope operation on the updated centrosymmetric multi-
cell body to obtain the
interval estimation of the Doppler velocimeter fault. An optimal
gain matrix is obtained through optimization by adopting a Frobenius
norm minimization method, the influence of unknown disturbance and
noise is reduced, and the precision is improved. According to the method, under the condition that
noise and disturbance are unknown but bounded, it can still be ensured that a fault true value is strictly wrapped by an
estimation interval, and the method is more practical and reliable in a complex disturbance scene.