A Doppler speedometer suitable for different navigation conditions

By combining transducer array elements in the Doppler meter to form multiple base arrays and switching the speed measurement mode according to the draft angle of the navigation carrier, the problem of data invalid when the Doppler meter moves at a large angle is solved, and the data is improved Data efficiency and speed measurement capability.

CN116299489BActive Publication Date: 2024-11-12CHINA SHIP SCIENTIFIC RESEARCH CENTER
View PDF 7 Cites 0 Cited by

Patent Information

Application Number
CN202211499781.4
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-11-28
Publication Date
2024-11-12
Estimated Expiration
2042-11-28

AI Technical Summary

Technical Problem

When the Doppler taximeter moves at a large angle, the ultrasonic beam cannot receive the reflected signal, resulting in invalid data and increased field values, and reduced data efficiency.

Method used

Design a Doppler meter that adapts to different navigation conditions, and form multiple transducer base arrays through the combination of multiple transducer array elements. Switch the speed measurement working mode according to the real-time trim angle of the navigation carrier, and use different positions The transducer matrix performs speed measurement and combines the data of the three-axis accelerometer under the Kalman filtering framework to improve data efficiency.

Benefits of technology

The field value data caused by the trim angle is reduced, the data efficiency of the Doppler taximeter is improved, the real-time measurement capability of the bottom tracking speed is enhanced, and the speed measurement effectiveness under various navigation conditions is ensured.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN116299489B_ABST
    Figure CN116299489B_ABST
Patent Text Reader

Abstract

The present application discloses a Doppler speed meter adapted to different navigation conditions, and relates to the field of ship technology. A plurality of transducer array elements are arranged on the surface of the spherical arc structure of the main shell of the Doppler speed meter to form a plurality of transducer arrays in combination. When the navigation vehicle works under different navigation conditions and has different longitudinal inclination angles, the Doppler speed meter enters different speed measurement working modes and uses transducer arrays at different positions to measure speed, thereby reducing wild value data caused by the longitudinal inclination angle of the navigation vehicle, improving the data efficiency of the Doppler speed meter, enhancing the speed measurement capability of the existing four-beam Doppler speed meter to a certain extent, ensuring the real-time measurement of the bottom tracking speed of the navigation vehicle under the condition of large inclination angle by the Doppler speed meter, and ensuring the effectiveness of speed measurement under various navigation conditions.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of ship technology, and in particular to a Doppler speed log adapted to different sailing conditions. Background Art

[0002] The Doppler speed meter is a new type of marine speed measuring instrument on modern ships or underwater vehicles. The Doppler speed meter is generally fixedly installed on the bottom of the marine vehicle and mainly uses the Doppler effect to measure the bottom tracking speed of the marine vehicle in real time.

[0003] In order to eliminate the speed measurement error caused by the vertical speed of the navigation vehicle, the existing Doppler speed meter generally adopts a multi-beam system, which currently includes three main types: dual-beam system, quad-beam system and six-beam system. (1) The dual-beam system is also called a one-element Doppler speed meter. It simultaneously transmits two ultrasonic beams symmetrically to the bow and stern of the ship at the same transmission angle, which can measure the longitudinal speed of the navigation vehicle in real time. (2) The quad-beam system is also called a two-element Doppler speed meter. It can measure the longitudinal speed and transverse speed of the navigation vehicle in real time. The four ultrasonic beams emitted by the four-beam system mainly have two configuration methods: cross configuration and X-shaped configuration. (3) The six-beam system is also called a three-element Doppler speed meter. On the basis of the four-beam transducer configured at the bow, a pair of transducers with left and right transmission beams are added at the stern. The six-beam system can measure the longitudinal speed of the navigation vehicle in real time, as well as the transverse speed of the bow and stern.

[0004] However, the posture of the navigation vehicle changes during use. When the navigation vehicle is moving at a large angle, such as diving or surfacing, part of the ultrasonic beam emitted by the Doppler speed meter will not receive the reflected signal, which may cause the Doppler speed meter to have invalid data, increase the wild value data, and reduce the data efficiency during use. Summary of the invention

[0005] In view of the above problems and technical requirements, the applicant has proposed a Doppler speedometer suitable for different navigation conditions. The technical solution of this application is as follows:

[0006] A Doppler speed log adapted to different navigation conditions, the Doppler speed log comprising a main body shell, a signal processing module and a plurality of transducer array elements, the main body shell being fixed to the bottom of a navigation vehicle, the side of the main body shell facing the seabed being a spherical arc surface structure, all transducer array elements being arranged on the surface of the spherical arc surface structure of the main body shell, and the signal processing module being arranged inside the main body shell and connecting the various transducer array elements;

[0007] The central axis of each transducer array element passes through the center of the spherical arc surface structure, and the layout positions of all transducer array elements are combined to form a plurality of different transducer base arrays, and the plurality of transducer base arrays formed by the combination are arranged in sequence along the length direction of the navigation vehicle;

[0008] During the navigation of the marine vehicle, the Doppler speedometer switches the speed measurement working mode according to the real-time longitudinal inclination angle of the marine vehicle. In each speed measurement working mode, the signal processing module uses the transducer array corresponding to the speed measurement working mode to measure the speed. The greater the real-time longitudinal inclination angle of the marine vehicle when the bow is raised, the closer the transducer array corresponding to the speed measurement working mode adopted by the Doppler speedometer is to the stern direction; the greater the real-time longitudinal inclination angle of the marine vehicle when the bow is buried, the closer the transducer array corresponding to the speed measurement working mode adopted by the Doppler speedometer is to the bow direction.

[0009] The beneficial technical effects of this application are:

[0010] The present application discloses a Doppler speed meter that is adaptable to different navigation conditions. The Doppler speed meter forms multiple transducer arrays by arranging a plurality of transducer array elements. When a navigation vehicle operates under different navigation conditions and has different longitudinal inclination angles, the Doppler speed meter enters different speed measurement working modes and uses transducer arrays at different positions to measure speed, thereby reducing wild value data caused by the longitudinal inclination angle of the navigation vehicle, improving the data efficiency of the Doppler speed meter, and enhancing the speed measurement capability of the existing four-beam Doppler speed meter to a certain extent, ensuring the real-time measurement of the bottom tracking speed of the navigation vehicle under the condition of large inclination angle, and ensuring the effectiveness of speed measurement under various navigation conditions.

[0011] In the framework of Kalman filtering, when the speed measurement value has wild values, especially when the measured speed has continuous wild values, the speed state estimation value can be calculated according to the acceleration measurement value of the three-axis accelerometer, so as to improve the robustness of the Kalman filter, realize the robust estimation of the state variables, and finally improve the data efficiency of the Doppler speed meter.

[0012] The structural design of the Doppler speed meter is compact, and different transducer arrays reuse transducer array elements, thereby improving the use efficiency of the transducer array elements and improving the integration of the Doppler speed meter. BRIEF DESCRIPTION OF THE DRAWINGS

[0013] Figure 1 It is a schematic diagram of the three-dimensional structure of a Doppler speed meter in one embodiment of the present application.

[0014] Figure 2 It is a schematic diagram of a spherical arc structure in which the centers of all transducer array elements pass through the center of the spherical arc surface structure in one embodiment of the present application.

[0015] Figure 3It is a schematic diagram of a Doppler speed meter installed on the bottom of a marine vehicle in one embodiment of the present application.

[0016] Figure 4 FIG. 1 is a side view of a Doppler speed meter according to an embodiment of the present application.

[0017] Figure 5 In one embodiment of the present application Figure 4 Schematic diagram of the cross-sectional structure of the AA' section.

[0018] Figure 6 Schematic diagram of the array coordinate system of the first transducer array.

[0019] Figure 7 Schematic diagram of the array coordinate system of the second transducer array. DETAILED DESCRIPTION

[0020] The specific implementation of the present application is further described below in conjunction with the accompanying drawings.

[0021] This application discloses a Doppler speedometer suitable for different navigation conditions. Figure 1-Figure 5 The Doppler speed meter includes a main housing 10, a signal processing module 20 and a plurality of transducer array elements 30. The main housing 10 is fixed to the bottom of a navigation vehicle 40. Please refer to Figure 3 The front view toward the bottom of the marine vehicle 40 is shown. In order to correspond to the hull coordinate system and avoid subsequent conversion operations such as rotation transformation and compensation of speed measurement errors, the Doppler speed meter is generally installed at the center of the marine vehicle 40, that is, symmetrical with respect to the center line in the direction of the ship's length and also symmetrical with respect to the center line in the direction of the ship's width.

[0022] The side of the main housing 10 facing the seabed is a spherical arc surface structure 11, and all transducer array elements are arranged on the surface of the spherical arc surface structure 11 of the main housing 10. The signal processing module 20 is arranged inside the main housing 10 and connects each transducer array element.

[0023] In one embodiment, please refer to Figure 1 , Figure 4 and Figure 5The main housing 10 of the Doppler speed meter includes an electronic compartment 12, a mounting flange 13, a spherical arc surface structure 11 and a watertight connector 14. The opening of the spherical arc surface structure 11 is watertightly fixedly connected to the bottom of the electronic compartment 12, and the top of the electronic compartment 12 is watertightly fixedly connected to the mounting flange 13. The mounting flange 13 serves as both a hatch of the electronic compartment 12 and a mounting base of the Doppler speed meter to be fixedly installed on the bottom of the navigation vehicle 40. The interior of the electronic compartment 12 is used to place the signal processing module 20 and other electronic components included in the Doppler speed meter. The watertight connector 14 is watertightly fixedly connected to the electronic compartment 12 and electrically connected to the electronic components inside the electronic compartment 12. The electronic components inside the electronic compartment 12 realize signal connection with the external structure through the watertight connector 14.

[0024] The central axis of each transducer array element passes through the center O of the spherical arc surface structure 11, and the layout positions of all transducer array elements are combined to form a plurality of different transducer arrays. The combined plurality of transducer arrays are arranged in sequence along the length direction of the navigation vehicle 40.

[0025] During the navigation of the navigation vehicle 40, when the navigation vehicle 40 works under different navigation conditions, the real-time trim angle of the navigation vehicle 40 is different. For example, when the navigation vehicle 40 works under the floating condition, the trim angle of the navigation vehicle 40 with the bow raised is larger, and when the navigation vehicle 40 works under the diving condition, the trim angle of the navigation vehicle 40 with the bow buried is larger. The Doppler speed meter switches the speed measurement working mode according to the real-time trim angle of the navigation vehicle 40 to match different navigation conditions. The Doppler speed meter uses a transducer array composed of different transducer array elements to measure speed when working in different speed measurement working modes. When the Doppler speed meter works in each speed measurement working mode, the signal processing module 20 uses the transducer array corresponding to the current speed measurement working mode to measure speed.

[0026] The greater the real-time longitudinal inclination angle of the navigation vehicle 40 when the bow is raised, the closer the transducer array corresponding to the speed measurement working mode adopted by the Doppler speed meter is to the stern direction, that is, in the floating condition of the navigation vehicle 40, the transducer array formed by the transducer array elements close to the stern is used as much as possible, so as to avoid the situation that the ultrasonic beam emitted by the transducer array element at the bow position cannot receive the reflected signal due to the raising of the bow of the navigation vehicle 40. The greater the real-time longitudinal inclination angle of the navigation vehicle 40 when the bow is buried, the closer the transducer array corresponding to the speed measurement working mode adopted by the Doppler speed meter is to the bow direction, that is, in the diving condition of the navigation vehicle 40, the transducer array formed by the transducer array elements close to the bow is used as much as possible, so as to avoid the situation that the ultrasonic beam emitted by the transducer array element at the stern position cannot receive the reflected signal due to the burying of the bow of the navigation vehicle 40. The wild value data caused by the change of the longitudinal inclination angle caused by the navigation condition of the navigation vehicle 40 is reduced, and the data validity of the Doppler speed meter is improved.

[0027] The number of transducer arrays composed of transducer array elements included in the Doppler speed meter is the same as the speed measurement working mode of the Doppler speed meter, and the specific number can be customized. The more transducer arrays are formed and the more speed measurement working modes of the Doppler speed meter are, the better the matching with various real-time longitudinal inclination angles of the navigation vehicle 40, but it will also lead to the problem of complex working modes and more transducer array elements used. In order to balance data efficiency and usage complexity, in one embodiment, the Doppler speed meter is combined to form three transducer arrays, so that the Doppler speed meter has three different speed measurement working modes.

[0028] In one embodiment, each transducer array adopts a four-beam array structure, and each transducer array can be composed of independent transducer array elements, so a total of 12 transducer array elements are required. However, in order to improve the multiplexing rate of the transducer array elements, in one embodiment, the Doppler odometer includes a total of 7 transducer array elements to form three different transducer arrays.

[0029] Please refer to Figure 1-Figure 3 As shown in the schematic diagram, the transducer array elements used in this embodiment are all cylindrical structures, and the central axis of each transducer array element passes through the circle of the transducer array element and is perpendicular to the surface of the transducer array element and passes through the center O of the spherical arc surface structure 11. Please refer to Figure 2 ,OO 31 That is, the central axis of the first transducer array element 31, OO 32 That is, the central axis of the second transducer array element 32, and the same applies to the other transducer array elements. The central axes of all transducer array elements pass through the center O of the spherical arc surface structure 11. 31 ~O 37 They respectively represent the centers of the first transducer array element 31 to the seventh transducer array element 37 .

[0030] Please refer to Figure 3 When the Doppler log is installed on the navigation vehicle 40, the fifth transducer array element 35, the sixth transducer array element 36 and the seventh transducer array element 37 are arranged in sequence on the center line of the navigation vehicle 40 in the direction of the length of the navigation vehicle 40 from the bow to the stern, please refer to Figure 3 The longitudinal speed v of the marine vehicle 40 along the length of the vessel is shown by an arrow. y The dotted line along the length direction represents the center line of the marine vehicle 40 in the length direction.

[0031] The first transducer array element 31 and the second transducer array element 32 are symmetrically arranged on both sides of the midline, the fourth transducer array element 34 and the third transducer array element 33 are symmetrically arranged on both sides of the midline, the fourth transducer array element 34 and the first transducer array element 31 are located on the same side of the midline, and the third transducer array element 33 and the second transducer array element 32 are located on the same side of the midline.

[0032] The central axis OO of the sixth transducer array element 36 36 The first transducer array element 31, the second transducer array element 32, the third transducer array element 33 and the fourth transducer array element 34 are symmetrically distributed around the device center axis and the angles between them and the device center axis are all equal to θ1, that is, Figure 2 In the middle, ∠O 31 OO 36 =∠O 32 OO 36 =∠O 33 OO 36 =∠O 34 OO 36 =θ1. The first transducer array element 31, the second transducer array element 32, the third transducer array element 33 and the fourth transducer array element 34 are combined to form a square-structured first transducer array A. In the present application, four transducer array elements are combined to form a square structure, which means that the centers of the four transducer array elements form a square structure.

[0033] The first transducer array element 31, the second transducer array element 32, the fifth transducer array element 35 and the sixth transducer array element 36 form a symmetrical structure to form a second transducer array B in a square structure. The third transducer array element 33, the fourth transducer array element 34, the sixth transducer array element 36 and the seventh transducer array element 37 form a symmetrical structure to form a third transducer array C in a square structure.

[0034] The first transducer array A and the second transducer array B share the first transducer array element 31 and the second transducer array element 32, the first transducer array A and the third transducer array C share the third transducer array element 33 and the fourth transducer array element 34, and the positions of the second transducer array B, the first transducer array A and the third transducer array C are arranged in sequence from the bow to the stern.

[0035] In order to realize the above structure, the focus is on the position design of the fifth transducer array element 35 and the seventh transducer array element 37. It is not difficult to find that the fifth transducer array element 35 and the seventh transducer array element 37 are both located on the symmetry plane of the structure composed of the first transducer array element 31 and the second transducer array element 32. Therefore, the position design problem of the fifth transducer array element 35 and the seventh transducer array element 37 is transformed into the central axis of the fifth transducer array element 35 and the central axis of the seventh transducer array element 37 and the device central axis OO of the Doppler speed meter. 36 The design problem of the angle between them.

[0036] Define the center of the square structure formed by the four transducer array elements in the first transducer array A as E1, then the line OE1 connecting the spherical center O of the spherical arc surface structure 11 and E1 is the array center axis of the first transducer array A, and the array center axis OE1 of the first transducer array A and the center axis OO of the sixth transducer array element 36 are 36 Therefore, for the first transducer array A, the included angles between the array center axis OE1 of the first transducer array A and the four transducer array elements in the first transducer array A are θ1.

[0037] Similarly, for the second transducer array B, the center of the square structure formed by the four transducer array elements in the second transducer array B is defined as E2, and the line OE2 connecting the spherical center O of the spherical arc surface structure 11 and E2 is the array center axis of the second transducer array B. Assuming that the angles between the array center axis OE2 of the second transducer array B and the four transducer array elements in the second transducer array B are θ2, then ∠O 31 OE2=∠O 32 OE2=∠O 35 OE2=∠O 36 OE2=θ2. In this case, the central axis OO of the fifth transducer array element 35 35 The axis OO of the Doppler speed meter 36 The angle between them is ∠O 35 OO 36 =2θ2. And in order to ensure the symmetry of the four transducer array elements in the second transducer array B, it is necessary to ensure that OO 36 O 31 With OO 36 O 32 Perpendicular, according to the definition of elementary geometry, we can get

[0038] Similarly, for the third transducer array C, the center of the square structure formed by the four transducer array elements in the third transducer array C is defined as E3, and the line OE3 connecting the spherical center O of the spherical arc surface structure 11 and E3 is the array center axis of the third transducer array C. Assuming that the angles between the array center axis OE3 of the third transducer array C and the four transducer array elements in the third transducer array C are θ3, then ∠O 33 OE3=∠O 34 OE3=∠O 36 OE3=∠O 37 OE3=θ3. In this case, the central axis OO of the seventh transducer array element 37 is 37 The axis OO of the Doppler speed meter 36 The angle between them is ∠O 37 OO 36=2θ3. In order to ensure the symmetry of the four transducer array elements in the third transducer array C, it is necessary to ensure that OO 36 O 34 With OO 36 O 33 Vertically, according to the principles of elementary geometry, we can get

[0039] When the Doppler speed meter includes the first transducer array A, the second transducer array B and the third transducer array C, the Doppler speed meter includes three speed measurement working modes. In this embodiment, the method for switching the speed measurement working mode of the Doppler speed meter according to the real-time pitch angle of the navigation vehicle 40 includes:

[0040] (1) When the real-time longitudinal inclination angle of the navigation vehicle 40 is within the inclination angle threshold range, the Doppler speed meter operates in the first speed measurement working mode and uses the first transducer array to measure the speed.

[0041] (2) When the real-time longitudinal inclination angle of the navigation vehicle 40 exceeds the inclination threshold range, the Doppler speed meter operates in the second speed measurement working mode and uses the second transducer array to measure the speed.

[0042] (3) When the real-time longitudinal tilt angle of the marine vehicle 40 exceeds the tilt angle threshold range, the Doppler speed meter operates in the third speed measurement working mode and uses the third transducer array to measure the speed.

[0043] The Doppler speed meter can switch the speed measurement working mode by the following two possible mechanisms: (1) The signal processing module 20 obtains the switching instruction and switches to the speed measurement working mode that matches the real-time longitudinal inclination angle of the navigation vehicle 40 according to the switching instruction. That is, the speed measurement working mode to be used is manually determined and the instruction is issued. (2) The Doppler speed meter also includes a tilt sensor 60 arranged inside the main body shell 10, and the signal processing module 20 is connected to the tilt sensor 60. The sensor coordinate system of the tilt sensor 60 is aligned with the device coordinate system of the Doppler speed meter. Please refer to Figure 5 The inclination sensor 60 is generally arranged in the electronic compartment 12. The signal processing module 20 detects the real-time pitch angle of the navigation vehicle 40 through the inclination sensor 60, and automatically switches the speed measurement working mode according to the real-time pitch angle of the navigation vehicle 40. That is, the Doppler speed meter automatically determines the speed measurement working mode to be used and switches it.

[0044] Regardless of the switching mechanism used, when the Doppler speed meter works in the above three different speed measurement working modes, the speed measurement solution methods are also different, which are introduced as follows:

[0045] 1. When the Doppler odometer works in the first speed measurement working mode, the Doppler odometer uses the first transducer array A to measure speed.

[0046] For the first transducer array A, please refer to Figure 6 , taking the center E1 of the four transducer array elements in the first transducer array A as the origin of the coordinate system, the direction from the origin E1 of the coordinate system to the midpoint P of the virtual line between the second transducer array element 32 and the third transducer array element 33 as the x1-axis direction, the direction from the origin E1 of the coordinate system to the midpoint Q of the virtual line between the first transducer array element 31 and the second transducer array element 32 as the y1-axis direction, and the direction from the origin E1 of the coordinate system to the center of the spherical arc surface structure 11 as the z1-axis direction, the array coordinate system E1x1y1z1 of the first transducer array A is established.

[0047] The array coordinate system E1x1y1z1 of the first transducer array A is also the device coordinate system of the Doppler log, and the y1 axis of the array coordinate system E1x1y1z1 is along the length direction of the navigation vehicle 40, the x1 axis is along the width direction of the navigation vehicle 40, and the z1 axis is along the vertical direction of the navigation vehicle 40. Therefore, the velocity component v in the y1 axis direction is obtained by solving y1 is the longitudinal velocity v of the navigation vehicle 40 along the length direction of the ship y , the velocity component v in the x1-axis direction is obtained x1 is the lateral velocity v of the navigation vehicle 40 along the width direction of the ship x , the calculated velocity component v in the z1 direction z1 It is the vertical velocity v of the navigation vehicle 40 perpendicular to the horizontal reference plane of the hull z .

[0048] Please combine Figure 6 According to the speed measurement principle of the four-beam Doppler odometer, the speed of the navigation vehicle 40 calculated by the first transducer array A includes:

[0049]

[0050] Among them, f d1 is the Doppler frequency shift measured by the first transducer element 31, f d2 is the Doppler frequency shift measured by the second transducer element 32, f d3 is the Doppler frequency shift measured by the third transducer array element 33, λ0 is the wavelength of the sound wave emitted by each transducer array element, and θ1 is the angle between each transducer array element in the first transducer array and the array center axis of the first transducer array.

[0051] 2. When the Doppler speed meter operates in the second speed measurement working mode, the Doppler speed meter uses the second transducer array B to measure speed.

[0052] For the second transducer array B, please refer to Figure 7, taking the center E2 of the four transducer array elements in the second transducer array B as the origin of the coordinate system, the direction from the origin E2 of the coordinate system to the second transducer array element 32 as the x2-axis direction, the direction from the origin E2 of the coordinate system to the fifth transducer array element 35 as the y2-axis direction, and the direction from the origin E2 of the coordinate system to the center O of the spherical arc surface structure 11 as the z2-axis direction, the array coordinate system E2x2y2z2 of the second transducer array B is established.

[0053] Obviously, the array coordinate system E2x2y2z2 of the second transducer array B differs from the array coordinate system E1x1y1z1 of the first transducer array A by a rotation angle θ2, and the rotation axis is in the x2-axis direction.

[0054] According to the speed measurement principle of the four-beam Doppler odometer, the components of the navigation vehicle 40 on the three axes of the array coordinate system E2x2y2z2 calculated by the second transducer array B are:

[0055]

[0056] Among them, f d1 is the Doppler frequency shift measured by the first transducer element 31, f d2 is the Doppler frequency shift measured by the second transducer element 32, f d5 is the Doppler frequency shift measured by the fifth transducer element 35, f d6 is the Doppler frequency shift measured by the sixth transducer array element 36. θ2 is the angle between each transducer array element in the second transducer array and the array centerline of the second transducer array.

[0057] By transforming the coordinates of the three axes of the array coordinate system E2x2y2z2 into the three axes of the Doppler log device coordinate system, that is, the array coordinate system E1x1y1z1, the speed of the navigation vehicle 40 can be obtained as:

[0058]

[0059] 3. When the Doppler odometer operates in the third speed measurement working mode, the Doppler odometer uses the third transducer array C to measure speed.

[0060] For the third transducer array C, considering the symmetry between the third transducer array C and the second transducer array B, based on the same method, the speed of the navigation vehicle 40 obtained after conversion to the device coordinate system of the Doppler log can be directly obtained as:

[0061]

[0062] Among them, f d3 is the Doppler frequency shift measured by the third transducer element 33, fd4 is the Doppler frequency shift measured by the fourth transducer element 34, f d6 is the Doppler frequency shift measured by the sixth transducer element 36, f d7 is the Doppler frequency shift measured by the seventh transducer array element 37. θ3 is the angle between each transducer array element in the third transducer array and the array centerline of the third transducer array.

[0063] Regardless of the speed measurement working mode in which the Doppler speed meter works, the lateral speed v of the navigation vehicle 40 is obtained by measuring the speed using a corresponding transducer array. x , longitudinal speed v y and vertical velocity v z After that, the data obtained by direct solution is filtered to further improve the data efficiency of the Doppler log. Figure 5 As shown, the Doppler odometer further includes a triaxial accelerometer 50 disposed inside the main housing 10, and the signal processing module 20 is connected to the triaxial accelerometer 50. The sensor coordinate system of the triaxial accelerometer 50 is aligned with the device coordinate system of the Doppler odometer. Figure 5 As shown, the three-axis accelerometer 50 is generally disposed within the electronics compartment 12 .

[0064] When the signal processing module 20 uses a corresponding transducer array to measure speed in each speed measurement working mode, it first uses the corresponding transducer array to measure speed to obtain the lateral speed v of the navigation vehicle 40 along the ship width direction. x , longitudinal velocity v along the length of the ship y , vertical velocity v perpendicular to the horizontal reference plane of the hull z The disbanding methods under different speed measurement working modes are as introduced in the above embodiments.

[0065] Then, the carrier velocity is processed based on the Kalman filter combined with the acceleration of the navigation carrier 40 measured by the three-axis accelerometer 50. In one embodiment, in order to simplify the model, from the perspective of practicality, the velocities of the three axes are decoupled, then: Based on the Kalman filter combined with the lateral acceleration a of the navigation carrier 40 along the ship width direction measured by the three-axis accelerometer 50, x For the lateral velocity v x Robust filtering estimation is performed. Based on the Kalman filter combined with the longitudinal acceleration a of the navigation vehicle 40 along the length direction measured by the three-axis accelerometer 50 y For longitudinal velocity v y Robust filtering estimation is performed. Based on Kalman filtering combined with the vertical acceleration a of the navigation vehicle 40 perpendicular to the horizontal reference plane of the hull measured by the triaxial accelerometer 50 z For vertical velocity v z Perform robust filter estimation.

[0066] For the axial direction corresponding to any one of the directions of the ship width direction, the ship length direction and the direction perpendicular to the horizontal reference plane of the hull, the method of robust filtering estimation of the velocity based on Kalman filtering combined with acceleration is the same, including the following process:

[0067] The state space model is established as X k =[V k ,A k ] T represents the system state at time k, V k represents the speed state at time k, A k represents the acceleration state at time k, X k-1 represents the system state at time k-1, Φ k,k-1 is the state transfer matrix and v k represents the speed measured by the transducer array at time k, H k represents the observation matrix at time k and H k =[1,0],w k represents the system noise at time k, ζ k represents the measurement noise at time k;

[0068] Then, the Kalman filter cycle is executed based on the state space model. At any k time, in the Kalman filter cycle:

[0069] (1) Calculate the estimation error at time k is the estimated value of the system state at time k-1 The predicted results and

[0070] (2) When e k When within the threshold range, the Kalman filter gain K based on time k k Determine the estimated value of the system state at time k

[0071] Among them, the Kalman filter gain at time k is R k represents the measurement noise variance matrix at time k. k,k-1 Represents the variance matrix P of the state estimate using time k-1 k-1 The predicted results, and Q k-1 Represents the system noise variance matrix at time k-1.

[0072] (3) When e kWhen the threshold value is exceeded, it indicates that the calculated velocity has an outlier value. At this time, the velocity state is estimated using the acceleration measured by the triaxial accelerometer 50. The estimated value of the system state at time k is determined. is the estimated value of the velocity state at time k and in, is the estimated value of the system state at time k-1 The estimated value of the velocity state at time k-1 is contained in k is the acceleration measured by the triaxial accelerometer 50 at time k, ΔT is the time difference between time k and time k-1, and is the Kalman filter cycle length.

[0073] Then update the variance matrix P of the state estimate at time k k =(IK k H k ) k,k-1 And enter the Kalman filter cycle of the next moment, I is the unit matrix.

[0074] The above is only a preferred embodiment of the present application, and the present application is not limited to the above embodiments. It is understood that other improvements and changes directly derived or associated by those skilled in the art without departing from the spirit and concept of the present application should be considered to be included in the protection scope of the present application.

Claims

1. A Doppler speedometer suitable for different navigation conditions. It is characterized in that The Doppler speed meter comprises a main body shell, a signal processing module and a plurality of transducer array elements, wherein the main body shell is fixed to the bottom of the navigation vehicle, the side of the main body shell facing the seabed is a spherical arc surface structure, all transducer array elements are arranged on the surface of the spherical arc surface structure of the main body shell, and the signal processing module is arranged inside the main body shell and connected to each transducer array element; The central axis of each transducer array element passes through the center of the spherical arc surface structure, and the layout positions of all transducer array elements are combined to form a plurality of different transducer base arrays, and the plurality of transducer base arrays formed by the combination are arranged in sequence along the length direction of the navigation vehicle; During the navigation of the navigation vehicle, the Doppler speed log switches the speed measurement working mode according to the real-time trim angle of the navigation vehicle. In each speed measurement working mode, the signal processing module uses the transducer array corresponding to the speed measurement working mode to measure the speed; the larger the real-time trim angle of the navigation vehicle when the bow is raised, the closer the transducer array corresponding to the speed measurement working mode adopted by the Doppler speed log is to the stern direction; the larger the real-time trim angle of the navigation vehicle when the bow is buried, the closer the transducer array corresponding to the speed measurement working mode adopted by the Doppler speed log is to the bow direction; The Doppler odometer comprises 7 transducer array elements in total. When the Doppler odometer is installed on the navigation vehicle, the fifth transducer array element, the sixth transducer array element and the seventh transducer array element are arranged in sequence from the bow to the stern on the center line of the navigation vehicle in the length direction. The first transducer array element and the second transducer array element are symmetrically arranged on both sides of the center line. The fourth transducer array element and the third transducer array element are symmetrically arranged on both sides of the center line. The fourth transducer array element and the first transducer array element are located on the same side of the center line. The central axis of the sixth transducer array element coincides with the device central axis of the Doppler odometer and is perpendicular to the horizontal reference plane of the hull. The first transducer array element, the second transducer array element, the third transducer array element and the fourth transducer array element are arranged on the same side of the center line. The elements are symmetrically distributed around the central axis of the device and the angles between them and the central axis of the device are all equal; the first transducer array element, the second transducer array element, the third transducer array element and the fourth transducer array element are combined to form a first transducer array with a square structure; the first transducer array element, the second transducer array element, the fifth transducer array element and the sixth transducer array element form a symmetrical structure to form a second transducer array with a square structure; the third transducer array element, the fourth transducer array element, the sixth transducer array element and the seventh transducer array element form a symmetrical structure to form a third transducer array with a square structure; the second transducer array, the first transducer array and the third transducer array are arranged in sequence from the bow to the stern; The Doppler speed meter includes three speed measurement working modes, and the method for the Doppler speed meter to switch the speed measurement working mode according to the real-time longitudinal inclination angle of the navigation vehicle includes: when the real-time longitudinal inclination angle of the navigation vehicle is within the inclination angle threshold range, the Doppler speed meter works in the first speed measurement working mode and uses the first transducer array to measure the speed; when the real-time longitudinal inclination angle of the navigation vehicle exceeds the inclination angle threshold range, the Doppler speed meter works in the second speed measurement working mode and uses the second transducer array to measure the speed; when the real-time longitudinal inclination angle of the navigation vehicle exceeds the inclination angle threshold range, the Doppler speed meter works in the third speed measurement working mode and uses the third transducer array to measure the speed.

2. The Doppler speed meter according to claim 1, It is characterized in that The speed of the navigation vehicle obtained by the Doppler log using the first transducer array to measure the speed includes: Among them, v x is the transverse velocity of the sea-going vehicle along the width direction, v y is the longitudinal velocity of the sea-going vehicle along the length of the vessel, v z is the vertical velocity of the navigation vehicle perpendicular to the horizontal reference plane of the hull; d1 is the Doppler frequency shift measured by the first transducer element, f d2 is the Doppler frequency shift measured by the second transducer element, f d3 is the Doppler frequency shift measured by the third transducer element, λ 0 is the wavelength of the sound wave emitted by each transducer array element, θ 1 is the angle between each transducer array element in the first transducer array and the array center axis of the first transducer array, and the array center axis of the first transducer array is the center E of the four transducer array elements in the first transducer array. 1 and the line connecting the center of the spherical arc surface structure.

3. The Doppler speed meter according to claim 1, It is characterized in that The speed of the navigation vehicle obtained by the Doppler log using the second transducer array to measure the speed includes: Among them, v x is the transverse velocity of the sea-going vehicle along the width direction, v y is the longitudinal velocity of the sea-going vehicle along the length of the vessel, v z is the vertical velocity of the navigation vehicle perpendicular to the horizontal reference plane of the hull; d1 is the Doppler frequency shift measured by the first transducer element, f d2 is the Doppler frequency shift measured by the second transducer element, f d5 is the Doppler frequency shift measured by the fifth transducer element, f d6 is the Doppler frequency shift measured by the sixth transducer element, λ 0 is the wavelength of the sound wave emitted by each transducer array element, θ 2 is the angle between each transducer array element in the second transducer array and the array center axis of the second transducer array, and the array center axis of the second transducer array is the center E of the four transducer array elements in the second transducer array. 2 and the line connecting the center of the spherical arc surface structure, and θ 1 is the angle between each transducer array element in the first transducer array and the array center axis of the first transducer array, and the array center axis of the first transducer array is the center E of the four transducer array elements in the first transducer array. 1 and the line connecting the center of the spherical arc surface structure.

4. The Doppler speed meter according to claim 1, It is characterized in that The speed of the navigation vehicle obtained by the Doppler speed meter using the third transducer array to measure the speed includes: Among them, v x is the transverse velocity of the sea-going vehicle along the width direction, v y is the longitudinal velocity of the sea-going vehicle along the length of the vessel, v z is the vertical velocity of the navigation vehicle perpendicular to the horizontal reference plane of the hull; d3 is the Doppler frequency shift measured by the third transducer element, f d4 is the Doppler frequency shift measured by the fourth transducer element, f d6 is the Doppler frequency shift measured by the sixth transducer array element, f d7 is the Doppler frequency shift measured by the seventh transducer element, λ 0 is the wavelength of the sound wave emitted by each transducer array element, θ 3 is the angle between each transducer array element in the third transducer array and the array center axis of the third transducer array, and the array center axis of the third transducer array is the center E of the four transducer array elements in the third transducer array. 3 and the line connecting the center of the spherical arc surface structure, and θ 1 is the angle between each transducer array element in the first transducer array and the array center axis of the first transducer array, and the array center axis of the first transducer array is the center E of the four transducer array elements in the first transducer array. 1 and the line connecting the center of the spherical arc surface structure.

5. The Doppler speed meter according to claim 1, It is characterized in that The Doppler odometer further comprises a three-axis accelerometer arranged inside the main body housing, and the signal processing module is connected to the three-axis accelerometer; The method for the signal processing module to measure speed using a corresponding transducer array in each speed measurement working mode includes: The signal processing module uses the corresponding transducer array to measure the speed and obtain the lateral speed v of the navigation vehicle along the width direction of the ship. x , longitudinal velocity v along the length of the ship y , vertical velocity v perpendicular to the horizontal reference plane of the hull z ; Based on Kalman filtering combined with the lateral acceleration a of the navigation vehicle along the width direction measured by the triaxial accelerometer x For the lateral velocity v x Perform robust filtering estimation; Based on Kalman filtering combined with the longitudinal acceleration a of the navigation vehicle along the length direction measured by the three-axis accelerometer y For the longitudinal velocity v y Perform robust filtering estimation; Based on Kalman filtering combined with the vertical acceleration a of the navigation vehicle perpendicular to the horizontal reference plane of the hull measured by the three-axis accelerometer z For the vertical velocity v z Perform robust filter estimation.

6. The Doppler speed meter according to claim 5, It is characterized in that For any direction in the ship width direction, the ship length direction and the direction perpendicular to the horizontal reference plane of the hull, the method of robust filtering estimation of velocity based on Kalman filtering combined with acceleration includes: The state space model is established as X k =[V k ,A k ] T represents the system state at time k, V k represents the speed state at time k, A k represents the acceleration state at time k, X k-1 represents the system state at time k-1, Φ k,k-1 is the state transfer matrix and v k represents the speed measured by the transducer array at time k, H k represents the observation matrix at time k and H k =[1,0],w k represents the system noise at time k, ζ k represents the measurement noise at time k; Based on the state space model, a Kalman filter cycle is executed. At any k time, in the Kalman filter cycle: Calculate the estimation error at time k is the estimated value of the system state at time k-1 The predicted results and When e k When within the threshold range, the Kalman filter gain K based on time k k Determine the estimated value of the system state at time k When e k When the threshold is exceeded, the estimated value of the system state at time k is determined is the estimated value of the velocity state at time k and in, is the estimated value of the system state at time k-1 The estimated value of the velocity state at time k-1 is contained in k is the acceleration measured by the triaxial accelerometer at time k, ΔT is the time difference between time k and time k-1, and is the Kalman filter cycle length.

7. The Doppler speed meter according to claim 1, It is characterized in that The method for switching the speed measurement working mode of the Doppler odometer comprises: The signal processing module obtains a switching instruction and switches to a speed measurement working mode matching the real-time pitch angle of the navigation vehicle according to the switching instruction; Alternatively, the Doppler odometer also includes an inclination sensor arranged inside the main body shell, and the signal processing module is connected to the inclination sensor. The signal processing module detects the real-time longitudinal inclination angle of the navigation vehicle through the inclination sensor, and automatically switches the speed measurement working mode according to the real-time longitudinal inclination angle of the navigation vehicle.

8. The Doppler speed meter according to claim 1, It is characterized in that The main shell of the Doppler speed meter includes an electronic compartment, a mounting flange, a spherical arc surface structure and a watertight connector. The opening of the spherical arc surface structure is watertightly fixed to the bottom of the electronic compartment, and the top of the electronic compartment is watertightly fixed to the mounting flange. The mounting flange serves as a hatch of the electronic compartment. The mounting flange also serves as a mounting base of the Doppler speed meter to be fixedly installed on the bottom of the navigation vehicle. The interior of the electronic compartment is used to place the signal processing module and other electronic components included in the Doppler speed meter. The watertight connector is watertightly fixed to the electronic compartment and electrically connected to the electronic components inside the electronic compartment. The electronic components inside the electronic compartment achieve signal connection with the external structure through the watertight connector.

Citation Information

Patent Citations

  • Acoustic interfacing apparatus for testing phased array doppler log

    CN101509971A

  • Small-depth Doppler log

    CN102073049A

  • Ultrasonic transducer

    CN102416225A

  • Doppler radar speed resolving method based on antenna near-field test

    CN112881990A

  • Doppler transducer array with asymmetric structure

    CN112964897A