AUV sensor fault diagnosis performance evaluation method based on minimum detectable fault set

Through the concept of the minimum detectable fault set and the properties of the central symmetric multicellular body, the accuracy of AUV sensor fault detection in complex environments is solved, and the fault detection accuracy and system stability of AUV are improved. It is suitable for a variety of configurations and motions. Autonomous underwater robot in state.

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

Patent Information

Application Number
CN202410950989.6
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-16
Publication Date
2024-11-15

AI Technical Summary

Technical Problem

Traditional AUV sensor fault detection methods are difficult to ensure the accuracy and effectiveness of detection in complex environments, and are prone to missed or missed detection, which affects the safety and stability of AUV.

Method used

A method for evaluating the fault diagnosis performance of AUV sensors based on the minimum detectable fault set is proposed. The state space model is obtained through system identification, and the central symmetric multicellular bodies corresponding to the residual at each moment is recursively obtained. The system is judged. Whether a fault occurs, and calculate the minimum detectable fault set of the fault detection method to ensure that no other faults are missed except for the faults in the set.

Benefits of technology

It significantly improves the accuracy of AUV fault detection and system reliability, can detect and respond to faults in a timely manner in complex environments, reduce false alarms, improve fault identification and diagnostic accuracy, and is suitable for autonomous water in various configurations and motion states. Down the robot.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118960814A_ABST
    Figure CN118960814A_ABST
Patent Text Reader

Abstract

The invention provides an AUV sensor fault diagnosis performance evaluation method based on a minimum detectable fault set by taking a Beaver II AUV as a research object aiming at the AUV sensor fault detection problem in a complex environment, and introduces a new fault detection performance index, namely the minimum detectable fault set. Firstly, a state space model of the underwater robot is obtained through a system identification method, then the centrosymmetric polytope corresponding to each moment residual can be obtained through recursion on the basis of a known observer in combination with the properties of the centrosymmetric polytope, and whether the system breaks down or not is judged by checking whether the centrosymmetric polytope contains zero points or not. And finally, calculating a minimum detectable fault set of the fault detection method. And the AUV system can timely find and deal with the fault at a critical moment, so that the reliability and the stability of the AUV are remarkably improved.
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 an AUV sensor fault diagnosis performance evaluation method based on a minimum detectable fault set, and introduces a new fault detection performance indicator, namely, the minimum detectable fault set. The method is applicable to AUVs of various configurations and motion conditions, and the effectiveness of the fault detection method is evaluated by the minimum detectable fault set, aiming to improve the accuracy of the fault detection method and the reliability of the system. Background Art

[0002] The rapid development of contemporary society has led to an increasing demand for resources. As non-renewable resources on land are gradually depleted, it has become an urgent task to develop the natural resources in the ocean to ensure sustainable development. The development of marine resources must rely on advanced equipment and technology. As equipment that can currently operate in deep-sea environments, underwater robots 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 play an indispensable role in submarine cable pipeline inspection, marine resource exploration and development, marine biological surveys and other fields with their wide working range and excellent maneuverability. AUV can operate autonomously in complex marine environments. To ensure the successful completion of the mission, it is crucial to ensure its own safety. Among them, fault detection is one of the key technologies 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 feeding back the data to the control system to achieve precise motion control. Therefore, the reliability of the sensor is an important prerequisite for the AUV to successfully complete the underwater operation task. However, once the sensor fails, it may seriously affect the safety of the AUV itself. Therefore, studying the fault detection technology of AUV sensors has important theoretical research significance for improving the safety and stability of AUV.

[0004] Traditional sensor fault detection methods often fail to ensure the accuracy and effectiveness of detection in complex environments, and are prone to missed detection or false detection. In order to solve this problem, this paper proposes an AUV sensor fault diagnosis performance evaluation method based on the minimum detectable fault set, and introduces a new fault detection performance indicator, namely the minimum detectable fault set, which is defined as: under a given fault detection method and a certain time k, if the set F k Any fault other than k is called the minimum detectable fault set. By using this performance indicator, we can ensure that k This concept highlights the effectiveness and accuracy of the fault detection method, ensuring that the AUV system can detect and respond to faults in a timely manner at critical moments, thereby improving the reliability and stability of the AUV system.

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

[0006] Definition 1: For any two sets A and B, their Minkowski sum operation result is defined as:

[0007]

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

[0009] Definition 2: Hypercube By performing an affine transformation, we can obtain an m-order central symmetric polyhedron: given a vector and generate vector i=1,2,...,m, the central symmetric polyhedron is defined

[0010] Meaning:

[0011]

[0012] Where c is The center of G is called The generator matrix of

[0013] Property 1 (Minkowski sum operation of centrosymmetric polytopes): Given two centrosymmetric polytopes and Then the following equation holds:

[0014]

[0015] Property 2 (linear mapping operation of centrosymmetric polytopes): For a given centrosymmetric polytope The result after linear mapping is:

[0016] Γ<c,G> = <Γc,ΓG> (4)

[0017] Property 3: Given a centrally symmetric polyhedron and an integer q (n<q<m), and the column vectors of the generated matrix G are first sorted in descending order according to the Euclidean norm, and then reordered to obtain the new matrix definition Among them G a Depend on The first qn columns of G b is a diagonal matrix of the form:

[0018]

[0019] Then we can get Summary of the invention

[0020] The present invention aims to solve the problem of accuracy and effectiveness of AUV fault detection in complex environments, and proposes an AUV fault detection method based on a minimum detectable fault set. Traditional fault detection methods often fail to ensure the accuracy and effectiveness of detection in complex environments, and are prone to missed detection or false detection. In order to solve this problem, the present invention introduces a new fault detection performance indicator, namely the minimum detectable fault set.

[0021] The technical solution adopted by the present invention to solve the above technical problems is: first, the state space model of the AUV is obtained through a system identification method. Then, based on the known observer and combined with the properties of the centrosymmetric polyhedron, the centrosymmetric polyhedron corresponding to the residual at each moment is recursively obtained, and the following fault detection logic is established: by observing whether the centrosymmetric polyhedron corresponding to the residual can contain zero points, it is determined whether the system has a fault. Finally, the minimum detectable fault set of the fault detection method is calculated to realize the detection of faults and the performance evaluation of the fault detection method. The flowchart of the invention is as follows Figure 1 As shown, the specific steps are as follows:

[0022] Step 1: Using the self-built "BeaverⅡ" AUV experimental platform and based on the pool experimental data, the linear state space model describing the changes of the straight-line speed and heading angle of the AUV when it moves on the horizontal plane was obtained through identification:

[0023]

[0024] 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. Through system identification, we get the parameter matrices A and B, D ω , C, D ∈ and E are both known constant matrices.

[0025] During the operation of the AUV, by analyzing the disturbance ω(k) caused by the error between the identification system and the actual system and the historical data ∈(k) of the sensor measurement noise, and removing a few abnormal values ​​with large amplitudes, the boundary of the disturbance and measurement noise can be determined. These values ​​change within this boundary at every moment. During the operation of the AUV, its motion state changes within the specified range. Therefore, the state quantity of the AUV system is also within a bounded range during the operation, that is, the system satisfies

[0026]

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

[0028]

[0029] in

[0030]

[0031] Step 2: Based on the known observer and the properties of the centrosymmetric polytope, the centrosymmetric polytope corresponding to the residual at each moment is recursively obtained.

[0032] Since the observer design is not the main content of the present invention, we draw on the existing observer method. For the AUV horizontal plane system model (6) under the above sensor failure, we adopt the following fault detection observer structure:

[0033]

[0034] in, is the state estimate vector, is the residual vector, is the gain matrix of the fault detection observer. In the present invention, the optimal gain matrix of the fault detection observer is known, and this parameter will be applied in the subsequent calculation steps.

[0035] The state estimation error vector is defined as:

[0036]

[0037] Combining the AUV horizontal plane model (6) and the observer structure (10), the dynamic error system can be obtained as:

[0038]

[0039] By setting the initial estimate of the system state to According to (8), we can get consider According to the dynamic error system (12) and the observer optimal gain matrix, the central symmetric polyhedral form of e(k+1) is:

[0040]

[0041] Then, according to (3) and (4), the centrosymmetric polyhedron Center of e (k+1) and the generator matrix G e (k+1) can be expressed as:

[0042]

[0043] in

[0044]

[0045] Here, q is a fixed integer and m is the generator matrix G. e The number of columns. Because each iteration step G e The dimension of G will increase, so in order to reduce the complexity of calculation, we will e Replace with

[0046] Similarly, the centrosymmetric polytopic form of the residual δ(k) is:

[0047]

[0048] Then, the centrosymmetric polyhedron Center of δ (k) and the generator matrix G δ (k) can be expressed as:

[0049]

[0050] Step 3: Establish fault detection logic: Determine whether a fault occurs by observing whether the central symmetric polyhedron corresponding to the residual can contain a zero point.

[0051] According to (17), if the AUV operates normally, then the centrosymmetric polyhedron of the residual Contains zero at all times, i.e. But if the AUV's sensor fails, the centrosymmetric polytope of the residual The center of will be offset, and The relationship cannot be guaranteed. Therefore, to determine whether the AUV sensor is faulty, we can check whether the central symmetric polyhedron corresponding to the residual contains a zero point. Based on this, the following fault detection logic can be established:

[0052]

[0053] Step 4: Calculate the minimum detectable fault set of the fault detection method.

[0054] The minimum detectable fault set is defined as the set of By using this performance indicator, we can ensure that except for the set The minimum detectable fault set is shown in the figure below. Figure 2 shown.

[0055] According to the fault detection logic (18), we can know that if the residual is a centrosymmetric polyhedron Out of zero, that is When a fault is detected, note So This means:

[0056]

[0057] Substituting formula (17) into the above formula, we can get:

[0058]

[0059] Then, after transformation, equation (20) can be obtained as follows:

[0060]

[0061] It can be further rewritten as:

[0062]

[0063] in Represents the generalized inverse of the matrix E.

[0064] According to (3) and (4), we can get:

[0065]

[0066] Then the minimum detectable fault set of the fault detection method based on observer (10) is in the form of:

[0067]

[0068] Among them, the minimum detectable fault set The center of f (k) and the generator matrix H f (k) The specific form is:

[0069]

[0070] Minimum detectable fault set for observer-based fault detection method (10) It can be obtained from (24), which shows that if there is a moment Make Then the fault f(k) will be detected by the fault detection method.

[0071] Beneficial effects:

[0072] 1. The present invention proposes a method for evaluating the fault diagnosis performance of AUV sensors based on a minimum detectable fault set. The method is applicable to autonomous underwater robots of various configurations and motion states, has wide applicability and versatility, and significantly expands the application field. By utilizing the concept of a minimum detectable fault set, the present invention can effectively evaluate and diagnose different sensor faults, thereby improving the system's fault recognition capability and diagnostic accuracy.

[0073] 2. The AUV sensor fault diagnosis performance evaluation method based on the minimum detectable fault set proposed in the present invention can effectively cope with various environmental noises and uncertainty factors and has high robustness; whether in a still water environment or in a dynamic and complex marine environment, the method can maintain excellent fault diagnosis performance and ensure the stable operation of the AUV sensor; at the same time, through the optimization algorithm, the minimum detectable fault set can be calculated quickly and accurately, which improves the real-time performance of fault detection and reduces the possibility of false alarms.

[0074] 3. 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 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. It has high practicality and promotion value. BRIEF DESCRIPTION OF THE DRAWINGS

[0075] Figure 1It is a flow chart of the AUV sensor fault diagnosis performance evaluation method based on the minimum detectable fault set;

[0076] Figure 2 A graphical explanation of the minimum detectable fault set;

[0077] Figure 3 This is the overall structure diagram of the "BeaverⅡ" AUV;

[0078] Figure 4 This is the propulsion arrangement of the "BeaverⅡ" AUV;

[0079] Figure 5 The present invention is a specific implementation method of the minimum detectable fault set obtained by jointly calculating the results of the Doppler speed meter and depth meter of the "BeaverⅡ" AUV. DETAILED DESCRIPTION

[0080] 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.

[0081] 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.

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

[0083] like Figure 2 As shown, the "BeaverⅡ" AUV adopts an open-frame design with a compact overall structure. Its length, width and height are 0.8 meters, 0.5 meters and 0.4 meters respectively, and its mass in the air is 50 kilograms. The depth, attitude and speed information of the "BeaverⅡ" AUV can be obtained through sensors such as the digital compass, Doppler speed meter and depth gauge installed on the hull. The control system adjusts the thrust of the thruster according to the data collected by these sensors, thereby achieving control of position, speed and attitude. The "BeaverⅡ" AUV is equipped with two main thrusters, two side thrusters and two vertical thrusters, which are installed symmetrically, as shown in the figure. Figure 3 shown.

[0084] The power cabin and the electronic cabin are symmetrically installed on the top of the AUV, 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.

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

[0086] First, the experiment was conducted in a pool environment without water flow and without faults. The main purpose was to obtain the state quantity of the AUV in order 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. The sampling work started at the moment the AUV started, and was carried out at a frequency of 5Hz, 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:

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

[0088] Forward: T1=6.78*V-4.08 (26)

[0089] Backward: T1=7.55*V+5.88 (27)

[0090] Relationship between right thruster thrust and control voltage:

[0091] Forward: T2 = 6.77*V-4.22 (28)

[0092] Backward: T2 = 7.01*V + 7.47 (29) Wherein, the range of the control voltage V is -5V to 5V.

[0093] In order to identify the model of horizontal motion, this experiment requires a large amount of data on the AUV's straight-line speed and heading angle as support. 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:

[0094]

[0095] make

[0096]

[0097] Then, the state space equation (30) can be rewritten as:

[0098] x(k+1)=Ax(k)+Bu(k) (32)

[0099] 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 (32). We will use 200 beats of experimental data, including the straight-line speed ρ, the heading angle ψ, and the thruster thrusts T1 and T2. Based on the identification analysis of these data, we get the parameter matrices A and B:

[0100]

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

[0102] The following form:

[0103] x(k+1)=Ax(k)+Bu(k)+D ω ω(k) (34)

[0104] in To identify the interference vector generated by the error between the system and the actual system, D ω is a known constant matrix.

[0105] Since the AUV's straight-line speed ρ can be obtained by the Doppler speed meter, and the AUV's heading angle ψ can be obtained by the digital compass, the state quantities of the system can be measured by the sensors, so the system's measurement can be given.

[0106] The output equation is:

[0107] y(k)=Cx(k)+D ∈ ∈(k) (35)

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

[0109] Sensor failure will affect the AUV’s correct perception of the surrounding environment. Sensor failure information can be extracted from the measurement output equation. 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:

[0110]

[0111] Where E is a known constant matrix.

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

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

[0114]

[0115] The measurement noise ∈(k) in this experiment comes from the sensor's own measurement accuracy, that is, the error generated by the sensor during data collection. The straight-line speed is measured by a Doppler speed meter. The measurement accuracy of the Doppler speed meter equipped on this experimental platform is 0.01m / s, so the measurement noise boundary of the straight-line speed is 0.01m / s; the heading angle is measured by a digital compass. The measurement accuracy of the digital compass equipped on the experimental platform is 1°. It can be seen that the measurement noise boundary of the heading angle in this experiment is 1°.

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

[0117]

[0118] When the Doppler speed meter and digital compass equipped on the AUV experimental platform have sudden faults, the experimental results of using the method proposed in this chapter to detect the sudden faults of the sensors are given below. When the Doppler speed meter measuring the straight-line speed and the digital compass measuring the heading angle have sudden faults, the fault model is:

[0119]

[0120]

[0121] The optimal observer gain matrix for the given observer (10) is

[0122]

[0123] Combining the properties of the centrosymmetric polytope, the centrosymmetric polytope corresponding to the residual at each moment is recursively obtained. In the first 50 moments, the centrosymmetric polytope of the residual Including zero points, according to the fault detection logic (18), it can be proved that when k < 50, the faults of the Doppler velocimeter and the digital compass are not detected; at 50-100, the centrosymmetric polytope of the residual The zero point is no longer included, which proves that the failure of the Doppler velocimeter and the digital compass is detected when k ≥ 50.

[0124] Next, draw the minimum detectable fault set, such as Figure 5 As shown in the figure, the shape of the minimum detectable fault set is a centrally symmetric polyhedron, the boundary of the Doppler speedometer measuring the straight-line speed in the fault direction is between 0.07 and 0.08, and the boundary of the digital compass measuring the heading angle in the fault direction is between 4 and 5. If there is a moment Make Then the fault f(k) will be detected.

[0125] In summary, the present invention aims at the problem of AUV sensor fault detection in complex environments, proposes a method for evaluating the fault diagnosis performance of AUV sensors based on the minimum detectable fault set, and introduces a new fault detection performance indicator, namely the minimum detectable fault set. First, the state space model of the underwater robot is obtained through the system identification method. Then, based on the known observer and combined with the properties of the centrosymmetric polyhedron, the centrosymmetric polyhedron corresponding to the residual at each moment is recursively obtained, and the fault detection logic is established. Finally, the minimum detectable fault set of the fault detection method is calculated to realize the detection of faults and the performance evaluation of the fault detection method.

[0126] 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.

[0127] 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 method for evaluating the fault diagnosis performance of AUV sensors based on a minimum detectable fault set, 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: Based on the known observer, the centrosymmetric polyhedron is recursively obtained by combining the properties of the centrosymmetric polyhedron to obtain the centrosymmetric polyhedron corresponding to the residual at each moment; 3) Step 3: Establish fault detection logic: By observing whether the central symmetric polyhedron corresponding to the residual can contain a zero point, it is determined whether a fault occurs; 4) Step 4: Calculate the minimum detectable fault set of the fault detection method.

2. The method for evaluating the fault diagnosis performance of an AUV sensor based on a minimum detectable fault set according to claim 1, 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 method for evaluating the fault diagnosis performance of an AUV sensor based on a minimum detectable fault set according to claim 2, characterized in that: In (1-2) described above, based on the known observer and combined with the properties of the centrosymmetric polytope, the centrosymmetric polytope corresponding to the residual at each moment is recursively obtained.

4. The method for evaluating the fault diagnosis performance of an AUV sensor based on a minimum detectable fault set according to claim 3 is characterized in that: In the above (1-3), a fault detection logic is established: by observing whether the central symmetric polyhedron corresponding to the residual can contain a zero point, it is determined whether a fault occurs.

5. The method for evaluating the fault diagnosis performance of an AUV sensor based on a minimum detectable fault set according to claim 4, characterized in that: In (1-4) described above, the minimum detectable fault set of the fault detection method is calculated.

Citation Information

Cited By

  • Evaluation method and device for assembly fault detection, and application

    CN119272094A

  • An evaluation method, device and application of collective fault detection

    CN119272094B

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

    CN119782680A