Autonomous underwater robot fault detection method based on intersection detection

Through the fault detection method based on intersection detection, the central symmetric multicellular body and linear planning equations are used to solve the problem of insufficient accuracy in complex environments of fault detection of underwater robot sensors, and achieve higher fault detection accuracy and system reliability. Suitable for autonomous underwater robots of various configurations and motion conditions.

CN118897533APending Publication Date: 2024-11-05HARBIN ENG UNIV
View PDF 0 Cites 3 Cited by

Patent Information

Application Number
CN202410929536.5
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-11
Publication Date
2024-11-05

AI Technical Summary

Technical Problem

The existing fault detection methods for underwater robot sensors rely on the Gaussian distribution assumption and are difficult to work effectively in complex marine environments, resulting in insufficient fault detection accuracy and reliability.

Method used

The fault detection method based on intersection detection is adopted, and the state space model is obtained through systematic identification, and the uncertainty range is represented by central symmetric multicellular bodies. The semi-space intersection of the predicted state set and the measured state set is constructed, and the linear planning equation is solved to judge the occurrence of the fault. .

Benefits of technology

It improves the accuracy of fault detection and system reliability, and can effectively deal with various noise and uncertain factors in complex environments, reduce the impact of faults on underwater robots, reduce maintenance costs, and extend equipment life.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118897533A_ABST
    Figure CN118897533A_ABST
Patent Text Reader

Abstract

The invention designs a method based on intersection verification by taking a Beaver II AUV (Autonomous Underwater Vehicle) as a research object and considering modeling errors and noise in order to solve the problem of fault detection of the autonomous underwater robot in a complex environment. The method comprises the following steps: firstly, acquiring a state space model of a robot through a system identification method, and representing an uncertainty range by using a centrosymmetric multi-cell body; then constructing a half-space intersection of the prediction state set and the measurement state set, and solving a corresponding linear programming equation; and finally, according to the solution of the equation, judging whether a fault occurs. Compared with the prior art, the invention provides a systematic, accurate and effective fault detection method.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention belongs to the field of autonomous underwater robot fault detection, and specifically relates to a fault detection method based on intersection test. The method is applicable to autonomous underwater robots of various configurations and motion conditions, and achieves more accurate fault detection through intersection test technology, aiming to improve the accuracy of fault detection and the reliability of the system. Background Art

[0002] With the rapid development of society, human demand for resources is also increasing day by day. As non-renewable resources on land are gradually depleted, people urgently need to develop natural resources in the ocean to ensure sustainable development. To achieve the development of natural resources in the ocean, we must rely on modern equipment and technical guidance to provide support. Since underwater robots are currently the only equipment that can operate in deep-sea environments, they play a key role in the development of marine resources.

[0003] Existing underwater robots can be mainly divided into manned underwater robots (HOV: Human Occupied Vehicle) and unmanned underwater robots (UUV: Unmanned Underwater Vehicle). Unmanned underwater robots are further divided into remotely operated underwater robots (ROV: Remotely Operated Vehicle) and autonomous underwater robots (AUV: Autonomous Underwater Vehicle). Among them, autonomous underwater robots (AUV) play an irreplaceable role in submarine cable and pipeline inspection, marine resource exploration and development, and oceanographic and biological surveys with their wide working range and excellent maneuverability. AUV can work autonomously in complex marine environments. In order to ensure that it can successfully complete its tasks, its own safety must be guaranteed. Among them, fault detection is a key technology to ensure the safety of AUV. AUV is composed of multiple components, among which the sensor is responsible for real-time monitoring of the robot's status and perception of the surrounding environment information, and feeds data back to the control system to achieve precise motion control. Therefore, the reliability of the sensor is an important prerequisite for AUV to successfully complete underwater operations. However, once a sensor fails, it may not accurately reflect the underwater status of the robot, or even cause the entire operating system to be paralyzed, seriously affecting the safety of the AUV. Therefore, studying the fault detection technology of AUV sensors has important theoretical research significance and practical application value for improving the safety of AUVs and accelerating their practical application.

[0004] The traditional method of using Kalman filtering technology to detect faults in AUV sensors requires the assumption that the uncertainties in the AUV itself and the external environment follow a Gaussian distribution, but this assumption is difficult to meet during the actual operation of the AUV. To address the above problems, the previous method is to draw the centrosymmetric polyhedron of the system state and the centrosymmetric polyhedron of the measured output, and observe whether they have an intersection to determine whether a fault has occurred. This paper proposes a fault detection method based on intersection testing, which can convert the centrosymmetric polyhedron of the system state and the centrosymmetric polyhedron of the measured output into a polyhedron form and establish a linear programming equation. By judging whether the linear programming equation has a solution, it is possible to determine whether a fault has occurred, thereby realizing fault detection of autonomous underwater robots.

[0005] The present invention requires the following definitions, properties and theorems:

[0006] Definition 1: Set and The Minkowski sum operation is defined as follows:

[0007]

[0008] in, Represents the Minkowski sum operator symbol.

[0009] Definition 2: Given a vector and generate vector A centrosymmetric polytope is defined as:

[0010]

[0011] in, is the unit interval. For the convenience of expression, the central symmetric polyhedron It can be written in terms of the center and generator matrix Where G = [g1g2…g m ].

[0012] Definition 3: Given a centrally symmetric polytope Its F-radius is defined as the Frobenius norm of its generating matrix, i.e.

[0013]

[0014] Definition 4: A polyhedron is a combination of hyperplanes and has the following form:

[0015]

[0016] Where n is the dimension of the polyhedron, A,b are matrices of hyperplanes of appropriate dimensions, and Ker(A) represents the kernel of the matrix A.

[0017] Property 1: Two centrosymmetric polytopes and The Minkowski sum of is still a centrosymmetric polytope and satisfies the following equation:

[0018]

[0019] Property 2: Given a centrally symmetric polyhedron and a matrix K, whose linear transformation about the matrix is ​​still a centrally symmetric polyhedron and satisfies the following equation:

[0020] K<c,G> =<Kc,KG> (6)

[0021] Property 3: Given a centrally symmetric polyhedron and an integer q (n<q<m), the matrix obtained by reordering the columns of G in descending order of the Euclidean norm is expressed as So in G a Depend on The first qn columns of G b is a diagonal matrix of the form:

[0022]

[0023] Property 4: For matrices X, A, B, C with appropriate dimensions, the following equality holds:

[0024]

[0025] Lemma 1: Given a centrosymmetric polytope in Its half-space representation is The specific forms of Q and q are:

[0026]

[0027] in

[0028]

[0029] is the matrix obtained by selecting the m-n+1 columns of G, Does not include The matrix of the jth row, Indicates Q + The i-th row of and Δqi Respectively represent q + ,q - and the i-th row of Δq, Representative Matrix The infinite norm of .

[0030] Lemma 2: Given two polyhedra in Their intersection can be simply expressed as:

[0031] Summary of the invention

[0032] The present invention aims to solve the fault detection problem of an autonomous underwater robot when it is affected by various uncertain factors in an actual complex environment, and proposes an autonomous underwater robot fault detection method based on intersection test.

[0033] The technical solution adopted by the present invention to solve the above technical problems is: first, the state space model of the robot is obtained by a system identification method, and the range of uncertainty is represented by a central symmetric polyhedron. Then, the half-space intersection of the predicted state set and the measured state set is constructed, and the corresponding linear programming equation is solved. Finally, according to the solution of the equation, it can be determined whether a fault occurs. Specifically, the following steps are included:

[0034] Step 1: Based on the "Beaver-II" AUV experimental platform independently built by the laboratory, the horizontal plane linear state space model of the AUV experimental platform regarding the straight-line speed and heading angle is obtained through the water tank experimental data identification:

[0035]

[0036] in is the state vector of the AUV system, is the control input vector of the AUV system, is the disturbance vector generated by the error between the identified system and the actual system, is the measurement output vector of the AUV system, is the measurement noise vector generated by the AUV sensor’s own measurement accuracy, is the AUV sensor fault vector, A and B are the parameter matrices obtained by system identification, and D ω , C, D υ and E are known constant matrices.

[0037] Select the constant matrix D ω , D υ If and E are both unit matrices of appropriate dimensions, then equation (12) can be rewritten as

[0038]

[0039] When the AUV is operating normally, the centrosymmetric polyhedron of the system state contains the set of all possible states. In order to ensure that the propagation of the centrosymmetric polyhedron of the AUV system state is still a centrosymmetric polyhedron at every moment, a correction system needs to be designed. According to formula (13), the following correction system can be obtained:

[0040] x(k)=Ax(k-1)+Bu(k-1)+D ω ω(k-1)+L k [y(k-1)-Cx(k-1)-υ(k-1)] (14)

[0042] in, represents the correction matrix.

[0043] During the operation of the AUV, the historical data of the disturbance ω(k) generated by the error between the identification system and the actual system and the sensor's measurement noise υ(k) are analyzed. After removing a few values ​​with large amplitudes, the boundaries of the disturbance and measurement noise can be determined, and their values ​​at every moment vary within their boundaries. During the operation of the AUV, its motion state changes within the specified range, so the state quantity of the AUV system is also bounded during the operation. Then, the initial state of the AUV system, the disturbance ω(k) and the measurement noise υ(k) satisfy

[0044]

[0045] in and are all known vectors. According to (2), equation (15) can be re-expressed in the form of a centrosymmetric polyhedron as:

[0046]

[0047] in

[0048]

[0049] Step 2: Calculate the reachable set of AUV system states.

[0050] The state of the AUV system at time k-1 is a centrally symmetric polyhedron that satisfies According to the correction system (14) and equation (16), the state x(k) of the AUV system at time k satisfies:

[0051]

[0052] According to the Minkowski sum and linear transformation of the centrosymmetric polytope in Properties 1 and 2, the centrosymmetric polytope of the AUV system state can be obtained Center of k and the generator matrix G k The specific form is:

[0053]

[0054] in

[0055]

[0056] Here, q is a fixed integer and m is the generator matrix G. k-1 The number of columns.

[0057] G k-1 Replace with This is to reduce the computational complexity, because each iteration step G k The dimension of will increase. It is worth noting that the central symmetric polyhedron of the AUV system state The propagation depends on the correction matrix L k In order to obtain satisfactory fault detection performance, L k The choice should make the AUV system state centrosymmetric polytope The size of the AUV system is the smallest. In this paper, the central symmetric polyhedron of the AUV system state The size of is characterized by the F-radius, i.e.

[0058]

[0059] According to Definition 3, the above size characterization can be expressed as follows:

[0060]

[0061] According to the central symmetric polyhedron of the AUV system state in equation (19) The generator matrix G k , we can get:

[0062]

[0063] According to property 4, size criterion J k Correction matrix L k The partial derivative of can be obtained:

[0064]

[0065] make The minimum size criterion J can be obtained k The optimal correction matrix for :

[0066]

[0067] in

[0068]

[0069] L k can be obtained by (25), but this only means that it is a stationary point. According to formula (16), we know that the element is a positive number, so Q υ is positive definite, so we know that Y k-1 is reversible. Then, L obtained from formula (25) k It's J k In addition, since J k ≥0 and it is L k is a quadratic function, so J k YesL k Therefore, L obtained by formula (25) k It's J k That is, L obtained by formula (25) k is the optimal correction matrix.

[0070] According to the optimal correction matrix L k The central symmetric polyhedron of the AUV system state can be obtained by (19): specific form.

[0071] Step 3: Calculate the predicted state set of the AUV system

[0072] According to (13) and (15), the state x(k-1) of the AUV system at time k-1 is a centrally symmetric polyhedron As the boundary, the predicted state set of the AUV system can be defined as a central symmetric polyhedron The set of all possible solutions of x(k) that can be obtained is expressed as:

[0073]

[0074] According to the central symmetric polyhedron of the AUV system state obtained and the definition of the predicted state set of the AUV system (27), the predicted state set of the AUV system It can also be easily calculated:

[0075]

[0076] According to the Minkowski sum and linear transformation of the centrosymmetric polytope in (5) and (6), the predicted state set of the AUV system is Center of k / k-1 And the generator matrix G k / k-1 It is easy to get:

[0077]

[0078] Step 4: Calculate the measurement state set of the AUV system

[0079] According to (13) and (15), the measurement state set of the AUV system is defined as the set of all possible solutions of x(k) that can be obtained based on y(k) and υ(k), and its specific expression is:

[0080]

[0081] According to the definition of the measurement state set of the AUV system (30), the measurement state set of the AUV system is The shape of is not clear, it is worth noting that the measured output of the AUV system in (13) can be restated as:

[0082]

[0083] in,(*) i ,i∈{1,2,…,n y} represents the i-th row of *.

[0084] For the i-th sub-expression y i (k) = C i x(k)+υ i (k), the corresponding measurement state set strip of the AUV system is:

[0085]

[0086] in, yes The i-th component of .

[0087] So, It can be understood as a strip. Therefore, the measurement state set of the AUV system can be understood as the intersection of a set of strips, and its specific form is:

[0088]

[0089] Step 5: Use intersection test method for fault detection

[0090] The predicted state set Converted into half-space representation, its specific form is:

[0091]

[0092] where Q and q are predicted states by using Lemma 1. It can be obtained when converted to a polyhedron.

[0093] The measurement state set It can be expressed in half space, that is,

[0094]

[0095] in

[0096]

[0097] According to Lemma 2, and The intersection of has the following form:

[0098]

[0099] We transform the fault detection condition (37) into a linear programming problem, which is expressed as follows:

[0100]

[0101] if and There is no intersection between them, then there will be a moment This makes the above linear programming problem (38) invalid, so we can conclude that This means Established. At this point, it can be detected that the AUV's sensor is faulty.

[0102] Beneficial effects:

[0103] 1. The present invention proposes an AUV sensor fault detection method based on intersection test, which is applicable to autonomous underwater robots of various configurations and motion conditions, has wide applicability and versatility, and greatly expands the scope of application;

[0104] 2. The AUV sensor fault detection method based on intersection test proposed in the present invention effectively improves the accuracy of fault detection through precise mathematical models and algorithms; compared with traditional methods, the present invention can achieve higher fault detection accuracy, thereby discovering potential faults earlier, reducing the impact of faults on the normal operation of AUVs, and ensuring the safety and reliability of AUVs in complex environments;

[0105] 3. The sensor fault detection method proposed in the present invention can effectively deal with various environmental noises and uncertainties, and has high robustness. Whether in a still water environment or in a dynamic and complex marine environment, the method can maintain high sensor fault detection performance;

[0106] 4. Due to the high accuracy and real-time performance of the method of the present invention, faults can be discovered and resolved at an early stage, thereby reducing the maintenance and repair costs of the AUV, extending the service life of the equipment, and improving economic benefits; at the same time, the sensor fault detection method of the present invention can be seamlessly integrated with the existing AUV control system, is easy to implement, and does not require large-scale transformation of the existing system, and has high practicality and promotion value. BRIEF DESCRIPTION OF THE DRAWINGS

[0107] Figure 1 It is a flow chart of the fault detection method based on intersection test;

[0108] Figure 2 This is the overall structure diagram of the "BeaverⅡ" AUV;

[0109] Figure 3 This is the propulsion arrangement of the "BeaverⅡ" AUV;

[0110] Figure 4 The detection results of Doppler velocimeter sudden fault at k<50 and k>50. DETAILED DESCRIPTION

[0111] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0112] In the description of the present invention, it should be understood that the terms "upper", "middle", "outer", "inner" and the like indicating directions or positional relationships are only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the components or elements referred to must have a specific direction, be constructed and operated in a specific direction, and therefore should not be understood as limiting the present invention.

[0113] The specific implementation method of the present invention is described below based on the "BeaverⅡ" AUV experimental platform and the accompanying drawings.

[0114] like Figure 2As shown in the figure, the overall structure of the "BeaverⅡ" AUV adopts an open-frame design. The length, width and height of the "BeaverⅡ" AUV are 0.8m, 0.5m and 0.4m respectively, and the mass in the air is 50kg. The hull depth, attitude and speed information of the "BeaverⅡ" AUV are obtained through sensors such as the digital compass, Doppler speed meter and depth gauge installed on the hull. The control system of the "BeaverⅡ" AUV adjusts the thrust of the propeller according to the data collected by the sensor to achieve position, speed control and hull attitude adjustment. The "BeaverⅡ" AUV has two main thrusters, two side thrusters and two vertical thrusters, which are symmetrically installed relative to the center, as shown in the figure. Figure 3 The power cabin and the electronic cabin are installed on the top of the AUV in a symmetrical manner, the digital compass is fixed on the top of the two cabins, and the Doppler speed meter and depth gauge are installed on the bottom of the AUV.

[0115] Specific embodiments of the present invention are as follows:

[0116] First, the experiment was conducted in a water pool environment without water flow and faults, focusing on obtaining the state quantity of the AUV to complete the identification task of the model parameters. During the experiment, the AUV started and reached the preset stable state, and maintained operation in this state, showing a stable speed and attitude. The sampling work started from the moment the AUV started, and was carried out at a frequency of 5Hz, that is, sampling was performed every 0.2 seconds, and a total of 200 cycles of data were obtained. The straight-line motion is mainly achieved by the thrust of the two main thrusters, while the bow motion is achieved by adjusting the thrust difference of the two main thrusters. The thrust size of the two main thrusters is determined by the control voltage of the thrusters, and the thrust models of the two main thrusters are:

[0117] The relationship between the left thruster control voltage and thrust:

[0118] Forward: T1 = 6.7785*V-4.0768 (39)

[0119] Backward: T1=7.5499*V+5.878 (40)

[0120] The relationship between the right thruster control voltage and thrust:

[0121] Forward: T2 = 6.7703*V-4.22 (41)

[0122] Backward: T2 = 7.0137*V + 7.4725 (42)

[0123] Where V is the control voltage, ranging from -5V to 5V.

[0124] In order to identify the model of horizontal motion in this experiment, a large amount of data on the AUV's straight-line speed and heading angle is required. The AUV's straight-line speed ρ can be obtained by the Doppler velocimeter, and the AUV's heading angle ψ can be obtained by the digital compass. According to the straight-line speed ρ, heading angle ψ, left thruster thrust T1, and right thruster thrust T2 at each moment, the state space equation of the AUV horizontal plane model can be obtained:

[0125]

[0126] make

[0127]

[0128] Then, the state space equation (43) can be rewritten as:

[0129] x(k+1)=Ax(k)+Bu(k) (45)

[0130] Next, we need to use the data obtained from the tank experiment to identify the parameter matrices A and B in the state space equation (45). We will use 200 beats of experimental data, including the straight-line speed ρ, the heading angle ψ, and the thrusters T1 and T2. Based on the identification analysis of these data, we get the parameter matrices A and B:

[0131]

[0132] In order to make the identification system closer to the actual operating system, the state space equation (45) can be rewritten as follows:

[0133] x(k+1)=Ax(k)+Bu(k)+D ω ω(k) (47)

[0134] x(k+1)=Ax(k)+Bu(k)+D ω ω(k)where To identify the interference vector generated by the error between the system and the actual system, D ω is a known constant matrix.

[0135] Since the Doppler speed meter can measure the straight-line speed and the digital compass can measure the heading angle, the state quantities of the system can all be measured by the sensors. Therefore, the measurement output equation of the system can be given as:

[0136] y(k)=Cx(k)+D υ υ(k) (48)

[0137] in, The measurement noise vectors, C and D, are generated by the sensor’s own accuracy. υ is a known constant matrix.

[0138] Sensor failure will affect the AUV’s correct perception of the surrounding environment. Sensor failure information can be extracted from the measurement output equation. Specifically, the actual output value of the AUV system is obtained by the sensor with the fault, and the sensor failure value is added to finally get the measured output value of the system. The fault vector is expressed as By importing the sensor failure model established above into the AUV horizontal plane model identified above, we can obtain the horizontal plane model of the AUV experimental platform under sensor failure:

[0139]

[0140] Where E is a known constant matrix.

[0141] After the AUV runs to a stable state, the error of the straight-line speed between the identification system and the actual system can be controlled within the range of 0 to 0.06 m / s after removing some large values. After the AUV runs to a stable state, the error of the heading angle between the identification system and the actual system can be controlled within the range of 0 to 4°. Then, the error boundary of the straight-line speed can be determined as 0.06 m / s, and the error boundary of the heading angle can be determined as 4°.

[0142] According to the above description of the error bound, in this experiment, the interference ω(k) bound is in the form of:

[0143]

[0144] The measurement noise υ(k) in this experiment is caused by the measurement accuracy of the sensor itself, that is, the error generated by the sensor during the data collection process. The straight-line speed is measured by a Doppler velocimeter. The measurement accuracy of the Doppler velocimeter equipped on the AUV experimental platform used in this paper is 0.01m / s, so the measurement noise boundary of the straight-line speed in this experiment is 0.01m / s; the heading angle is measured by a digital compass. The measurement accuracy of the digital compass equipped on the AUV experimental platform used in this paper is 1°, so the measurement noise boundary of the heading angle in this experiment is 1°.

[0145] According to the above description of the measurement noise boundary, in this experiment, the measurement noise υ(k) boundary is in the form of:

[0146]

[0147] When the Doppler velocimeter equipped on the AUV experimental platform has a sudden failure, the fault model is:

[0148]

[0149] The Doppler velocimeter sudden fault was detected by using the intersection check method. The detection results are as follows: Figure 4 As shown, the red geometric figure is the predicted state set The blue geometric shapes are the measurement status sets In the first 50 moments, the predicted state set With measurement status set There is an intersection between them, which can prove that when k < 50, the Doppler velocimeter failure is not detected; at 50-100, the predicted state set With the measurement state set There is no intersection between them, which proves that the Doppler velocimeter fault is detected when k≥50. At the same time, in the first 50 moments, by constructing the half-space intersection of the predicted state set and the measured state set and solving the corresponding linear programming equation, we found that the equation has a solution, which indicates that the system did not detect the Doppler velocimeter fault during these moments. However, in the 50-100 moments, we found that the linear programming equation has no solution, which indicates that the system detected the Doppler velocimeter fault when k≥50. In summary, the method based on intersection test can detect the sudden change fault of the Doppler velocimeter.

[0150] In summary, the present invention designs a method based on intersection verification for the problem of autonomous underwater robot fault detection in complex environments. First, the state space model of the robot is obtained through the system identification method, and the range of uncertainty is represented by a central symmetric polyhedron. Then, the half-space intersection of the predicted state set and the measured state set is constructed, and the corresponding linear programming equation is solved. Finally, according to the solution of the equation, it can be judged whether the fault occurs, and the fault detection is realized.

[0151] In the description of this specification, the description with reference to the terms "one embodiment", "example", "specific example", etc. means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present invention. In this specification, the schematic representation of the above terms does not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described can be combined in any one or more embodiments or examples in a suitable manner.

[0152] The preferred embodiments of the present invention disclosed above are only used to help illustrate the present invention. The preferred embodiments do not describe all the details in detail, nor do they limit the invention to the specific implementation methods described. Obviously, many modifications and changes can be made according to the content of this specification. This specification selects and specifically describes these embodiments in order to better explain the principles and practical applications of the present invention, so that those skilled in the art can understand and use the present invention well. The present invention is limited only by the claims and their full scope and equivalents.

Claims

1. A fault detection method for an autonomous underwater robot based on intersection test, characterized in that The steps include: (1) Step 1: Based on the "Beaver-II" AUV experimental platform independently built by the laboratory, the horizontal plane linear state space model of the AUV experimental platform regarding the straight-line speed and heading angle is obtained through the water tank experimental data identification; (2) Step 2: Calculate the reachable set of AUV system states; (3) Step 3: Calculate the predicted state set of the AUV system; (4) Step 4: Calculate the measurement state set of the AUV system; (5) Step 5: Use the intersection test method to perform fault detection.

2. The autonomous underwater robot fault detection method based on intersection test according to claim 1 is characterized in that: In (1-1), based on the "Beaver-II" AUV experimental platform independently built by the laboratory, the horizontal plane linear state space model of the AUV experimental platform regarding the straight-ahead speed and heading angle was obtained through the identification of the pool experimental data.

3. The autonomous underwater robot fault detection method based on intersection test according to claim 2 is characterized in that: In (1-2) described above, the reachable set of the AUV system state is calculated.

4. The autonomous underwater robot fault detection method based on intersection test according to claim 3 is characterized in that: In (1-3) described above, the predicted state set of the AUV system is calculated.

5. The method for detecting faults of an autonomous underwater robot based on intersection check according to claim 4, characterized in that: In (1-4) described above, the measurement state set of the AUV system is calculated.

6. The method for detecting faults of an autonomous underwater robot based on intersection check according to claim 5, characterized in that: In the above (1-5), the intersection check method is used for fault detection.

Citation Information

Cited By

  • Centrosymmetric multi-cell Kalman filtering AUV speed estimation method based on T-N-L structure

    CN119782680A

  • AUV speed estimation method based on centrosymmetric multi-cell Kalman filter

    CN119782681A

  • A method for AUV velocity estimation based on centrosymmetric multicellular Kalman filter

    CN119782681B