Navigation method, system, equipment and product for unmanned platform gravity measurement vehicle

By processing GNSS and gravimeter data in real time and using the amplitude coherence function to calculate speed adjustment, the problem of speed deviation and fluctuation in gravity measurement of unmanned platforms has been solved, and efficient and accurate gravity measurement has been achieved.

CN118706113BActive Publication Date: 2024-11-15CHINA STATE SHIPBUILDING CORP NO 707 RES INST
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411197231.6
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-08-29
Publication Date
2024-11-15
Estimated Expiration
2044-08-29

AI Technical Summary

Technical Problem

In gravity measurement of unmanned platforms, deviations and fluctuations in speed from the set value lead to inconsistent spatial resolution, data distortion, and systematic biases, resulting in low operational efficiency.

Method used

By collecting GNSS satellite navigation information and gravimeter output information in real time, the speed is adjusted using the amplitude coherence function, and the data is processed using an FIR low-pass filter to dynamically adjust the speed to adapt to the dynamic environment.

Benefits of technology

It achieves high efficiency and consistent data quality in gravity measurement on unmanned platforms, and improves adaptability to dynamic environments and measurement accuracy.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118706113B_ABST
    Figure CN118706113B_ABST
Patent Text Reader

Abstract

The present invention relates to the field of inertial navigation technology, and specifically discloses a navigation method, system, equipment and product of an unmanned platform gravity measurement vehicle, the method comprising: during the operation of the unmanned platform gravity measurement vehicle, real-time collection of GNSS satellite navigation information and gravimeter output information; calculating gravity anomaly information; calculating motion acceleration information of the current cycle; calculating the coherence function value at each frequency point according to the motion acceleration information and the gravity anomaly information at the corresponding time, and then calculating the maximum value of the absolute value of the mean of the coherence function value at each frequency point; combining the current operating speed, calculating the operating speed of the next cycle. The present invention can support the automatic monitoring and measurement conditions of the unmanned platform small gravimeter, reasonably set the working speed, improve the dynamic environmental adaptability and measurement accuracy of the unmanned platform gravity measurement, and realize efficient and high data quality unmanned platform gravity measurement operations.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of inertial navigation technology, and in particular to a navigation method, system, equipment and product of an unmanned platform gravity measurement vehicle. Background Art

[0002] The platform-type relative gravimeter is one of the main instruments for obtaining information about the earth's gravity field. It is mainly composed of a gravity sensor and an inertial stabilization platform. The gravity sensor is the core sensitive element of the relative gravimeter. It has the characteristics of high precision and high resolution and can be sensitive to changes in the earth's weak gravity field. The inertial stabilization platform provides physical support for the gravity sensor and provides a real-time reference benchmark for dynamic gravity measurement. The main measurement part of the unmanned platform small gravimeter includes an inertial measurement unit and an inertial stabilization platform. The inertial measurement unit includes three single-axis fiber optic gyroscopes, two horizontal accelerometers and a vertical gravity sensor. Among them, the gravity sensor is also used as a vertical accelerometer. In order to adapt to the stringent requirements of small carriers such as unmanned boats, AUVs, and drones on the size and weight of instruments, the gravimeter adopts a compact azimuth strapdown inertial platform solution. In terms of structural configuration, the gravimeter platform is composed of two horizontal universal ring frames. There is no universal ring frame structure in azimuth. The inertial measurement unit is built into the two horizontal universal ring frames, thus forming an azimuth strapdown inertial platform. The mechanical part of the platform consists of a base, an outer frame and an inner frame. The outer frame is a pitch ring, and the inner frame is a roll ring. Three gyroscopes Gx, Gy, Gz and three accelerometers Ax, Ay, Az (gravity sensors) are orthogonally installed on the inner frame. The gyroscopes and accelerometers are installed as an inertial measurement unit in the form of an integral body in the inner frame of the platform. Functionally, the horizontal ring stabilization loop of the platform uses the stabilization loop technology based on the fiber optic gyroscope to achieve the stability of the inertial system with two degrees of freedom in the horizontal direction and isolate the horizontal angular motion of the carrier. The correction loop uses the results of the navigation solution to control the azimuth strapdown platform to track the local geographic level, so that the input axis of the gravity sensor is strictly parallel to the direction of the geographic vertical line, and the direct measurement of the vertical acceleration, that is, the measurement of the original gravity information, is completed. In the later stage of gravity data processing, the original gravity measurement values ​​are processed by Ertfos correction, normal gravity correction, zero drift correction, data filtering, etc. with the help of satellite navigation information such as GNSS to obtain real-time gravity anomaly values ​​on the survey line.

[0003] The carriers of traditional marine gravity measurement are survey ships of several thousand tons, and the carriers of aerial gravity measurement are fixed-wing aircraft or helicopters with a fuselage length of tens of meters. The carriers have strong resistance to interference from wind, waves, currents, etc., and the measured speed is easy to maintain. For example, in marine gravity measurement, the survey ship can usually operate normally in sea conditions below level 5, and there is no need to adjust the speed according to the sea conditions. However, due to the small size, light weight, and weak anti-disturbance ability of unmanned platforms such as unmanned boats, AUVs, and drones, when the measurement environment is poor, they are easily affected by environmental interference such as wind, waves, and airflow. The measured speed is very likely to deviate from the set value and fluctuate greatly. On the one hand, speed fluctuations cause inconsistent measurement spatial resolution, affecting the subsequent application effect of gravity data. On the other hand, gravity data is easily disturbed by motion disturbances caused by speed fluctuations, resulting in data distortion and systematic deviations. Therefore, the reasonable setting and maintenance technology of measuring speed is the key to obtaining high-quality data for gravity measurement of unmanned platforms. At present, the setting of the speed of gravity measurement on unmanned platforms mainly relies on the experience of operators. Usually, the speed is set to a fixed value before sailing, and the speed maintenance mainly depends on the control performance of the operating platform itself, which leads to the data quality of the measurement operation being directly related to the working conditions during the operation. And because the gravity measurement data are currently processed offline after the operation, when the quality of the gravity data is found to be unsatisfactory, the speed can only be adjusted to re-measure the measurement area, which leads to low operating efficiency and uneven data quality between different voyages. Therefore, for gravity measurement on unmanned platforms, it is urgent to solve the problems of inconsistent spatial resolution, data distortion and systematic deviation, and low operating efficiency caused by the deviation of the speed from the set value and fluctuation during operation, so as to realize efficient and high-data-quality gravity measurement operations on unmanned platforms. Summary of the invention

[0004] The present invention aims to solve the problems of inconsistent spatial resolution, data distortion, systematic deviation, and low operating efficiency caused by the deviation of the speed from the set value and fluctuation during operation. To this end, the present invention provides a navigation method, system, equipment, and product for an unmanned platform gravity measurement vehicle, which can support the automatic monitoring and measurement conditions of the unmanned platform small gravimeter, reasonably set the working speed, improve the dynamic environmental adaptability and measurement accuracy of the unmanned platform gravity measurement, and realize efficient and high data quality unmanned platform gravity measurement operations.

[0005] The present invention provides a navigation method for an unmanned platform gravity measurement vehicle, and the technical solution adopted is as follows:

[0006] During the operation of the unmanned platform gravity measurement vehicle, GNSS satellite navigation information and gravimeter output information are collected in real time;

[0007] Calculating gravity anomaly value information based on the GNSS satellite navigation information and the gravimeter output information;

[0008] According to the GNSS satellite navigation information of the current period, the motion acceleration information is calculated;

[0009] According to the motion acceleration information and the gravity anomaly value information at the corresponding time, the coherence function value at each frequency point is calculated using the amplitude coherence function, and then the maximum absolute value of the mean coherence function value at each frequency point is calculated;

[0010] The operating speed of the unmanned platform gravity measurement vehicle in the next cycle is calculated based on the maximum value and the current operating speed of the unmanned platform gravity measurement vehicle.

[0011] Furthermore, the process of calculating the gravity anomaly value information according to the GNSS satellite navigation information and the gravimeter output information is as follows:

[0012] Based on the position information, eastward velocity, northward velocity and celestial velocity in the GNSS satellite navigation information, the Ertfos correction value, normal gravity correction value, horizontal acceleration correction value and vertical acceleration correction value at each sampling time are calculated; then the cutoff frequency is used respectively The FIR low-pass filter is used for filtering to obtain the filtered value of the Eertfus correction value, the filtered value of the normal gravity correction value, the filtered value of the horizontal acceleration correction value and the filtered value of the vertical acceleration correction value;

[0013] Cutoff frequency The calculation formula is:

[0014]

[0015] in, represents the cut-off frequency; Indicates the current operating speed; Indicates spatial resolution;

[0016] The eastward original specific force, northward original specific force and skyward original specific force in the output information of the gravimeter are filtered by using an anti-aliasing FIR low-pass filter, and then extracted respectively, and their sampling rates are adjusted to be the same as the sampling rate of the GNSS satellite navigation information; and then the cutoff frequencies are respectively used. The FIR low-pass filter is used to filter, and the filtered values ​​of the east-direction specific force, the north-direction specific force and the sky-direction specific force are obtained;

[0017] According to the filtered values ​​of the east specific force, the north specific force and the celestial specific force, as well as the filtered values ​​of the Eertfoss correction value, the filtered values ​​of the normal gravity correction value, the filtered values ​​of the horizontal acceleration correction value and the filtered values ​​of the vertical acceleration correction value, the gravity anomaly information at each sampling time is calculated.

[0018] Furthermore, the sampling rate of GNSS satellite navigation information is 1 Hz; the sampling rate of gravimeter output information is 100 Hz.

[0019] Furthermore, according to the GNSS satellite navigation information of the current period, the process of calculating the motion acceleration information is as follows:

[0020] The eastward velocity, northward velocity and celestial velocity in the GNSS satellite navigation information are differentially processed, and then the cutoff frequency is used respectively. The FIR low-pass filter is used to filter the acceleration information to obtain motion acceleration information, wherein the motion acceleration information includes a filtered value of eastward acceleration, a filtered value of northward acceleration, and a filtered value of celestial acceleration;

[0021] Cutoff frequency The calculation formula is:

[0022]

[0023] in, represents the cut-off frequency; Indicates the current operating speed; Indicates the spatial resolution.

[0024] Further, the cycle is half an hour.

[0025] Further, according to the motion acceleration information and the gravity anomaly value information at the corresponding time, the amplitude coherence function is used to calculate the coherence function value at each frequency point, and then the maximum value of the absolute value of the mean coherence function value at each frequency point is calculated as follows:

[0026] The amplitude coherence function values ​​between the gravity anomaly information at the corresponding time in the frequency band of 0.001Hz to 1Hz and the filtered values ​​of the eastward acceleration, the northward acceleration and the celestial acceleration are calculated respectively, and the obtained , , ,in, Represents the amplitude coherence function value between the gravity anomaly information and the filtered value of the eastward acceleration at each frequency point, Represents the amplitude coherence function value between the gravity anomaly information and the filtered value of the north acceleration at each frequency point, Represents the amplitude coherence function value between the gravity anomaly information and the filtered value of the celestial acceleration at each frequency point;

[0027] according to , , , respectively calculated , , ,in, express The absolute value of the mean; express The absolute value of the mean; express The absolute value of the mean;

[0028] Calculate the maximum absolute value of the mean value of the coherence function value at each frequency point. The calculation formula is:

[0029]

[0030] in, Indicates the maximum value, Indicates finding the maximum value.

[0031] Furthermore, the calculation formula for the operating speed of the next cycle is:

[0032]

[0033] in, Indicates the operating speed of the next cycle.

[0034] The present invention also provides a navigation system for an unmanned platform gravity measurement vehicle, and the technical scheme adopted is as follows: comprising: a data acquisition module, a gravity anomaly value information calculation module, a motion acceleration information calculation module, a coherence function calculation module and an operation speed calculation module, wherein the data acquisition module is respectively connected to the gravity anomaly value information calculation module and the motion acceleration information calculation module, and the coherence function calculation module is respectively connected to the gravity anomaly value information calculation module, the motion acceleration information calculation module and the operation speed calculation module,

[0035] The data acquisition module is used to collect GNSS satellite navigation information and gravimeter output information in real time during the operation of the unmanned platform gravity measurement vehicle;

[0036] The gravity anomaly value information calculation module is used to calculate the gravity anomaly value information according to the GNSS satellite navigation information and the gravimeter output information;

[0037] The motion acceleration information calculation module is used to calculate the motion acceleration information according to the GNSS satellite navigation information of the current period;

[0038] The coherence function calculation module is used to calculate the coherence function value at each frequency point using the amplitude coherence function according to the motion acceleration information and the gravity anomaly value information at the corresponding time, and then calculate the maximum value of the absolute value of the mean of the coherence function value at each frequency point;

[0039] The operating speed calculation module is used to calculate the operating speed of the unmanned platform gravity measurement vehicle in the next cycle according to the maximum value and the current operating speed of the unmanned platform gravity measurement vehicle.

[0040] The present invention also provides a computer device, including a memory and a processor, wherein the memory stores a computer program, and the processor implements the above-mentioned navigation method of an unmanned platform gravity measurement vehicle when executing the computer program.

[0041] The present invention also provides a computer program product, including a computer program, which implements the above-mentioned navigation method of the unmanned platform gravity measurement vehicle when executed by a processor.

[0042] The above one or more technical solutions in the embodiments of the present invention have at least one of the following technical effects:

[0043] The present invention dynamically adjusts and controls the operating speed of the unmanned platform gravity measurement vehicle according to the correlation between the gravity anomaly value information obtained by real-time data processing and the three-dimensional motion acceleration information obtained by periodic processing, so as to realize real-time monitoring and adaptation to dynamic measurement conditions, solve the problems of inconsistent spatial resolution, distortion of gravity information, systematic deviation and low operating efficiency caused by the deviation of the carrier speed from the set value and fluctuation, and ensure the high efficiency of the unmanned platform gravity measurement and the consistency of data quality.

[0044] Additional aspects and advantages of the present invention will be given in part in the following description and in part will be obvious from the following description, or will be learned through practice of the present invention. BRIEF DESCRIPTION OF THE DRAWINGS

[0045] In order to more clearly illustrate the technical solutions in the present invention or the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0046] Figure 1 It is a flow chart of the method provided by the present invention.

[0047] Figure 2 It is a comparison diagram of gravity anomalies of the survey lines provided by the present invention.

[0048] Figure 3 It is a structural block diagram of the system provided by the present invention.

[0049] Reference numerals:

[0050] 1. Data acquisition module; 2. Gravity anomaly information calculation module; 3. Motion acceleration information calculation module; 4. Coherence function calculation module; 5. Operation speed calculation module. DETAILED DESCRIPTION

[0051] In order to make the purpose, technical scheme and advantages of the present invention clearer, the technical scheme of the present invention will be clearly and completely described below in conjunction with the drawings in the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, rather than all the embodiments. Based on the embodiments in the present invention, all other embodiments obtained by ordinary technicians in the field without creative work are within the scope of protection of the present invention. The following embodiments are used to illustrate the present invention, but cannot be used to limit the scope of the present invention.

[0052] In the description of this specification, the description with reference to the terms "one embodiment", "some embodiments", "example", "specific example", or "some examples" etc. means that the specific features, structures or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the embodiment of the present invention. In this specification, the schematic representations of the above terms do not necessarily refer to the same embodiment or example. Moreover, the specific features, structures or characteristics described may be combined in any one or more embodiments or examples in a suitable manner. In addition, those skilled in the art may combine and combine the different embodiments or examples described in this specification and the features of the different embodiments or examples, without contradiction.

[0053] Combine the following Figures 1 to 3 The present invention is further described in detail, and a navigation method, system, device and product of an unmanned platform gravity measurement vehicle of the present invention are described:

[0054] In this embodiment, Figure 1 As shown, a navigation method for an unmanned platform gravity measurement vehicle is provided, comprising the following steps:

[0055] Step 1: During the operation of the unmanned platform gravity measurement vehicle, GNSS satellite navigation information and gravimeter output information are collected in real time.

[0056] Before the unmanned platform gravity measurement vehicle is operated, the initial speed of the operation is set according to the spatial resolution requirements and on-site working conditions. The initial speed is the current operating speed of the first cycle of the unmanned platform gravity measurement vehicle operation process. For the unmanned platform gravity measurement vehicle, a large number of gravity measurement tests have shown that a speed of 5 knots has strong adaptability to working conditions and high operating efficiency, and is suitable as the setting value of the initial speed.

[0057] During the operation, the gravimeter display and control computer collects GNSS satellite navigation information in real time at a sampling rate of 1Hz, and collects gravimeter output information in real time at a sampling rate of 100Hz, and stores it in the gravimeter display and control computer data file. GNSS satellite navigation information includes position information, eastward speed, northward speed and celestial speed; gravimeter output information includes eastward original relative force, northward original relative force and celestial original relative force.

[0058] Step 2: Calculate the gravity anomaly value information based on the GNSS satellite navigation information and the gravimeter output information.

[0059] The GNSS satellite navigation information is processed, and the specific process is as follows:

[0060] Based on the position information, eastward velocity, northward velocity and celestial velocity, the Ertfos correction value, normal gravity correction value, horizontal acceleration correction value and vertical acceleration correction value are calculated at each sampling time; then the four correction values ​​are respectively subjected to the cutoff frequency The FIR low-pass filter is used for filtering to obtain the filtered value of the Eertfoss correction value, the filtered value of the normal gravity correction value, the filtered value of the horizontal acceleration correction value and the filtered value of the vertical acceleration correction value.

[0061] The gravimeter output information is processed, and the specific process is as follows:

[0062] The eastward original specific force, the northward original specific force and the celestial original specific force are filtered using an anti-aliasing FIR low-pass filter with a cutoff frequency of 0.3 Hz, and then the filtered data are extracted respectively, and their sampling rates are adjusted to the same as the sampling rate of the GNSS satellite navigation information, that is, the sampling rates are reduced to 1 Hz; and then the cutoff frequencies are used respectively. The FIR low-pass filter is used for filtering to obtain the filtered values ​​of the eastward specific force, the northward specific force and the celestial specific force.

[0063] Different from the IIR low-pass filter usually used for offline processing, the present invention uses a FIR low-pass filter for real-time processing. The FIR filter has a linear phase characteristic, which ensures that the waveforms of the correction values ​​and specific force information are not distorted after filtering, and the delay time is consistent, which plays a key role in the real-time and high-precision processing of gravity data.

[0064] The calculation process of gravity anomaly information is:

[0065] According to the filtered values ​​of the east specific force, the north specific force and the celestial specific force, as well as the filtered values ​​of the Eertvus correction value, the normal gravity correction value, the horizontal acceleration correction value and the vertical acceleration correction value, the gravity anomaly information at each sampling time is calculated. The specific calculation process of the gravity anomaly information is prior art and will not be repeated here.

[0066] This step processes the real-time collected GNSS satellite navigation information and gravimeter output information in real time, and is performed in real time during the entire operation of the unmanned platform gravity measurement vehicle.

[0067] FIR low pass filter cutoff frequency It is related to the current operating speed and spatial resolution, and the calculation formula is:

[0068]

[0069] in, Indicates the cutoff frequency, in Hz; Indicates the current operating speed, in m / s; Indicates the spatial resolution, in meters.

[0070] Step 3: Calculate the motion acceleration information based on the GNSS satellite navigation information of the current period.

[0071] The specific process is: the eastward velocity, northward velocity and celestial velocity in the GNSS satellite navigation information are differentially processed to obtain the eastward acceleration, northward acceleration and celestial acceleration, and then the cutoff frequency is used respectively. The motion acceleration information is filtered by a FIR low-pass filter to obtain the motion acceleration information, which includes the filtered value of the eastward acceleration, the filtered value of the northward acceleration and the filtered value of the celestial acceleration.

[0072] This step periodically calculates the motion acceleration information, schematically, with a half-hour period. For example, after the unmanned platform gravity measurement vehicle starts operating and collects half an hour of GNSS satellite navigation information, the motion acceleration information of the first period is calculated based on the collected half-hour eastward speed, northward speed, and celestial speed. The unmanned platform gravity measurement vehicle continues to operate for 1 hour, and the motion acceleration information of the second period is calculated based on the eastward speed, northward speed, and celestial speed from half an hour to one hour (the second half hour).

[0073] Step 4: According to the motion acceleration information and the gravity anomaly value information at the corresponding time, the coherence function value is calculated using the amplitude coherence function, and then the maximum absolute value of the mean coherence function value at each frequency point is calculated.

[0074] The specific process is: calculate the amplitude coherence function value between the gravity anomaly information in the frequency band of 0.001Hz to 1Hz and the filtered value of the eastward acceleration, the filtered value of the northward acceleration and the filtered value of the celestial acceleration, and obtain , , ,in, Represents the amplitude coherence function value between the gravity anomaly information and the filtered value of the eastward acceleration at each frequency point, Represents the amplitude coherence function value between the gravity anomaly information and the filtered value of the north acceleration at each frequency point, It represents the amplitude coherence function value between the gravity anomaly information and the filtered value of the celestial acceleration at each frequency point.

[0075] The target frequency range is set to 0.001Hz~1Hz, which is obtained through the analysis of a large number of unmanned platform gravity measurement test data. In this frequency range, the signal-to-noise ratio of the gravity anomaly signal and noise is high, and it is the main frequency band for the distribution of effective gravity anomaly information.

[0076] Amplitude coherence function The calculation formula is:

[0077]

[0078] in, Indicates signal Autopower spectrum, units ; Indicates signal Autopower spectrum, units ; Indicates signal and The cross power spectrum, in units ; Indicates the signal frequency, unit Hz, The frequency points in this step are related to the signal frequency The corresponding values ​​of .

[0079] according to , , , respectively calculated , , ,in, express The absolute value of the mean; express The absolute value of the mean; express The absolute value of the mean.

[0080] The maximum absolute value of the mean of the three coherence function values ​​at each frequency point is calculated according to the following formula:

[0081]

[0082] in, Indicates the maximum value, Indicates finding the maximum value.

[0083] Step 5: Calculate the operating speed of the unmanned platform gravity measurement vehicle for the next cycle based on the maximum value and the current operating speed of the unmanned platform gravity measurement vehicle.

[0084] The calculation formula for the operating speed of the next cycle is:

[0085]

[0086] in, Indicates the operating speed of the next cycle, in m / s; Indicates the current operating speed in m / s.

[0087] It should be noted that the cutoff frequency of the FIR low-pass filter is This step calculates the operating speed of the next cycle. When filtering the GNSS satellite navigation information and gravimeter output information collected in real time in the next cycle, the cutoff frequency It will be adjusted according to the operating speed.

[0088] Step 3 periodically calculates the motion acceleration information, and the corresponding steps 4 and 5 must also be calculated periodically. That is, steps 1 and 2 are executed in real time during the operation of the unmanned platform gravity measurement vehicle, and steps 3 to 5 are executed repeatedly in a half-hour cycle. Each time steps 3 to 5 are executed, the operating speed of the next cycle will be calculated, thereby adjusting the operating speed of the unmanned platform gravity measurement vehicle, and affecting the cutoff frequency of the FIR low-pass filter used in the filtering of GNSS satellite navigation information and gravimeter output information, and then affecting the calculated gravity anomaly information, improving the dynamic environment adaptability and measurement accuracy of the unmanned platform gravity measurement, and realizing efficient and high-data-quality unmanned platform gravity measurement operations.

[0089] Taking a gravity measurement operation carried out by an unmanned boat as an example, the gravity anomaly comparison diagram of the survey line obtained by the traditional method and the method of this patent is shown in the figure below. Figure 2 As shown, the gravity anomaly curve obtained according to the method of this patent is smoother as a whole, the distortion of gravity information is significantly improved, and the consistency of data quality is higher.

[0090] In this embodiment, Figure 3As shown, a navigation system for an unmanned platform gravity measurement vehicle is also provided, and the technical scheme adopted is as follows: comprising: a data acquisition module 1, a gravity anomaly value information calculation module 2, a motion acceleration information calculation module 3, a coherence function calculation module 4 and an operating speed calculation module 5, wherein the data acquisition module 1 is respectively connected to the gravity anomaly value information calculation module 2 and the motion acceleration information calculation module 3, and the coherence function calculation module 4 is respectively connected to the gravity anomaly value information calculation module 2, the motion acceleration information calculation module 3 and the operating speed calculation module 5.

[0091] The data acquisition module 1 is used to collect GNSS satellite navigation information and gravimeter output information in real time during the operation of the unmanned platform gravity measurement vehicle; the GNSS satellite navigation information includes position information, eastward speed, northward speed and celestial speed; the gravimeter output information includes eastward original specific force, northward original specific force and celestial original specific force.

[0092] The gravity anomaly value information calculation module 2 is used to calculate the gravity anomaly value information according to the GNSS satellite navigation information and the gravimeter output information. The gravity anomaly value information calculation module 2 reads the position information, eastward velocity, northward velocity and celestial velocity, as well as the eastward original specific force, the northward original specific force and the celestial original specific force from the data acquisition module 1.

[0093] The GNSS satellite navigation information is processed, and the specific process is as follows:

[0094] Based on the position information, eastward velocity, northward velocity and celestial velocity, the Ertfos correction value, normal gravity correction value, horizontal acceleration correction value and vertical acceleration correction value are calculated at each sampling time; then the four correction values ​​are respectively subjected to the cutoff frequency The FIR low-pass filter is used for filtering to obtain the filtered value of the Eertfoss correction value, the filtered value of the normal gravity correction value, the filtered value of the horizontal acceleration correction value and the filtered value of the vertical acceleration correction value.

[0095] The gravimeter output information is processed, and the specific process is as follows:

[0096] The eastward original specific force, the northward original specific force and the celestial original specific force are filtered using an anti-aliasing FIR low-pass filter with a cutoff frequency of 0.3 Hz, and then the filtered data are extracted respectively, and their sampling rates are adjusted to the same as the sampling rate of the GNSS satellite navigation information, that is, the sampling rates are reduced to 1 Hz; and then the cutoff frequencies are used respectively. The FIR low-pass filter is used for filtering to obtain the filtered values ​​of the eastward specific force, the northward specific force and the celestial specific force.

[0097] The calculation process of gravity anomaly information is:

[0098] According to the filtered values ​​of the east specific force, the north specific force and the celestial specific force, as well as the filtered values ​​of the Eertfoss correction value, the filtered values ​​of the normal gravity correction value, the filtered values ​​of the horizontal acceleration correction value and the filtered values ​​of the vertical acceleration correction value, the gravity anomaly information at each sampling time is calculated.

[0099] The motion acceleration information calculation module 3 is used to calculate the motion acceleration information according to the GNSS satellite navigation information of the current period.

[0100] After the operation starts, the motion acceleration information calculation module 3 starts timing. At the end of each cycle, the eastward velocity, northward velocity and celestial velocity of the current cycle are read from the data acquisition module 1, and differential processing is performed to obtain the eastward acceleration, northward acceleration and celestial acceleration, and then the cutoff frequency is used to calculate the eastward acceleration, northward acceleration and celestial acceleration. The FIR low-pass filter is used to filter the motion acceleration information, and the motion acceleration information includes the filtering value of the eastward acceleration, the filtering value of the northward acceleration, and the filtering value of the celestial acceleration. The motion acceleration information is sent to the coherence function calculation module 4.

[0101] The coherence function calculation module 4 is used to calculate the coherence function value at each frequency point using the amplitude coherence function according to the motion acceleration information and the gravity anomaly value information at the corresponding time, and then calculate the maximum absolute value of the mean coherence function value at each frequency point.

[0102] After receiving the motion acceleration information, the coherence function calculation module 4 obtains the gravity anomaly information of the corresponding time from the gravity anomaly information calculation module 2, and then respectively calculates the amplitude coherence function values ​​between the gravity anomaly information and the filtered values ​​of the eastward acceleration, the northward acceleration, and the celestial acceleration in the 0.001Hz to 1Hz frequency band, and then respectively calculates the absolute values ​​of the means corresponding to the three amplitude coherence function values, and finally calculates the maximum value of the absolute values ​​of the means of the three coherence function values ​​at each frequency point. The maximum value is sent to the operation speed calculation module 5.

[0103] The operating speed calculation module 5 is used to calculate the operating speed of the unmanned platform gravity measurement vehicle for the next cycle according to the maximum value and the current operating speed of the unmanned platform gravity measurement vehicle. After receiving the maximum value, the operating speed calculation module 5 calculates the operating speed of the next cycle in combination with the current operating speed of the unmanned platform gravity measurement vehicle, and sends it to the unmanned platform gravity measurement vehicle control system to adjust its operating speed.

[0104] In this embodiment, a computer device is also provided, including a memory and a processor, wherein the memory stores a computer program, and the processor implements the above-mentioned navigation method of an unmanned platform gravity measurement vehicle when executing the computer program.

[0105] In this embodiment, a computer program product is also provided, including a computer program, and when the computer program is executed by a processor, the navigation method of the unmanned platform gravity measurement vehicle described above is implemented.

[0106] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or make equivalent replacements for some of the technical features therein. However, these modifications or replacements do not deviate the essence of the corresponding technical solutions from the spirit and scope of the technical solutions of the embodiments of the present invention.

Claims

1. A navigation method for an unmanned platform gravity measurement vehicle, characterized in that: include: During the operation of the unmanned platform gravity measurement vehicle, GNSS satellite navigation information and gravimeter output information are collected in real time; Calculating gravity anomaly value information based on the GNSS satellite navigation information and the gravimeter output information; According to the GNSS satellite navigation information of the current period, the motion acceleration information is calculated; According to the GNSS satellite navigation information of the current period, the process of calculating the motion acceleration information is as follows: The eastward velocity, northward velocity and celestial velocity in the GNSS satellite navigation information are differentially processed, and then the cutoff frequency is used respectively. The FIR low-pass filter is used to filter the acceleration information to obtain motion acceleration information, wherein the motion acceleration information includes a filtered value of eastward acceleration, a filtered value of northward acceleration, and a filtered value of celestial acceleration; Cutoff frequency The calculation formula is: in, represents the cut-off frequency; Indicates the current operating speed; Indicates spatial resolution; According to the motion acceleration information and the gravity anomaly value information at the corresponding time, the coherence function value at each frequency point is calculated using the amplitude coherence function, and then the maximum absolute value of the mean coherence function value at each frequency point is calculated; According to the motion acceleration information and the gravity anomaly value information at the corresponding time, the amplitude coherence function is used to calculate the coherence function value at each frequency point, and then the maximum value of the absolute value of the mean coherence function value at each frequency point is calculated as follows: The amplitude coherence function values ​​between the gravity anomaly information at the corresponding time in the frequency band of 0.001Hz to 1Hz and the filtered values ​​of the eastward acceleration, the northward acceleration and the celestial acceleration are calculated respectively, and the obtained , , ,in, Represents the amplitude coherence function value between the gravity anomaly information and the filtered value of the eastward acceleration at each frequency point, Represents the amplitude coherence function value between the gravity anomaly information and the filtered value of the north acceleration at each frequency point, Represents the amplitude coherence function value between the gravity anomaly information and the filtered value of the celestial acceleration at each frequency point; according to , , , respectively calculated , , ,in, express The absolute value of the mean; express The absolute value of the mean; express The absolute value of the mean; Calculate the maximum absolute value of the mean value of the coherence function value at each frequency point. The calculation formula is: in, Indicates the maximum value, It means to find the maximum value; Calculate the operating speed of the unmanned platform gravity measurement vehicle for the next cycle according to the maximum value and the current operating speed of the unmanned platform gravity measurement vehicle; The calculation formula for the operating speed of the next cycle is: in, Indicates the operating speed of the next cycle.

2. The navigation method of an unmanned platform gravity measurement vehicle according to claim 1, characterized in that: According to the GNSS satellite navigation information and the gravimeter output information, the process of calculating the gravity anomaly value information is as follows: Based on the position information, eastward velocity, northward velocity and celestial velocity in the GNSS satellite navigation information, the Ertfos correction value, normal gravity correction value, horizontal acceleration correction value and vertical acceleration correction value at each sampling time are calculated; then the cutoff frequency is used respectively The FIR low-pass filter is used for filtering to obtain the filtered value of the Eertfus correction value, the filtered value of the normal gravity correction value, the filtered value of the horizontal acceleration correction value and the filtered value of the vertical acceleration correction value; The eastward original specific force, northward original specific force and celestial original specific force in the output information of the gravimeter are filtered by using an anti-aliasing FIR low-pass filter, and then extracted respectively, and their sampling rates are adjusted to be the same as the sampling rate of the GNSS satellite navigation information; and then the cutoff frequencies are respectively used. The FIR low-pass filter is used to filter, and the filtered values ​​of the east-direction specific force, the north-direction specific force and the sky-direction specific force are obtained; According to the filtered values ​​of the east specific force, the north specific force and the celestial specific force, as well as the filtered values ​​of the Eertfoss correction value, the filtered values ​​of the normal gravity correction value, the filtered values ​​of the horizontal acceleration correction value and the filtered values ​​of the vertical acceleration correction value, the gravity anomaly information at each sampling time is calculated.

3. The navigation method of an unmanned platform gravity measurement vehicle according to claim 2, characterized in that: The sampling rate of GNSS satellite navigation information is 1Hz; the sampling rate of gravimeter output information is 100Hz.

4. The navigation method of an unmanned platform gravity measurement vehicle according to claim 1, characterized in that: The cycle is half an hour.

5. A navigation system for an unmanned platform gravity measurement vehicle, characterized in that: A navigation method for an unmanned platform gravity measurement vehicle for executing any one of claims 1 to 4, comprising: a data acquisition module, a gravity anomaly information calculation module, a motion acceleration information calculation module, a coherence function calculation module and an operation speed calculation module, wherein the data acquisition module is respectively connected to the gravity anomaly information calculation module and the motion acceleration information calculation module, and the coherence function calculation module is respectively connected to the gravity anomaly information calculation module, the motion acceleration information calculation module and the operation speed calculation module. The data acquisition module is used to collect GNSS satellite navigation information and gravimeter output information in real time during the operation of the unmanned platform gravity measurement vehicle; The gravity anomaly value information calculation module is used to calculate the gravity anomaly value information according to the GNSS satellite navigation information and the gravimeter output information; The motion acceleration information calculation module is used to calculate the motion acceleration information according to the GNSS satellite navigation information of the current period; According to the GNSS satellite navigation information of the current period, the process of calculating the motion acceleration information is as follows: The eastward velocity, northward velocity and celestial velocity in the GNSS satellite navigation information are differentially processed, and then the cutoff frequency is used respectively. The FIR low-pass filter is used to filter the acceleration information to obtain motion acceleration information, wherein the motion acceleration information includes a filtered value of eastward acceleration, a filtered value of northward acceleration, and a filtered value of celestial acceleration; Cutoff frequency The calculation formula is: in, represents the cut-off frequency; Indicates the current operating speed; Indicates spatial resolution; The coherence function calculation module is used to calculate the coherence function value at each frequency point using the amplitude coherence function according to the motion acceleration information and the gravity anomaly value information at the corresponding time, and then calculate the maximum value of the absolute value of the mean of the coherence function value at each frequency point; According to the motion acceleration information and the gravity anomaly value information at the corresponding time, the amplitude coherence function is used to calculate the coherence function value at each frequency point, and then the maximum value of the absolute value of the mean coherence function value at each frequency point is calculated as follows: The amplitude coherence function values ​​between the gravity anomaly information at the corresponding time in the frequency band of 0.001Hz to 1Hz and the filtered values ​​of the eastward acceleration, the northward acceleration and the celestial acceleration are calculated respectively, and the obtained , , ,in, Represents the amplitude coherence function value between the gravity anomaly information and the filtered value of the eastward acceleration at each frequency point, Represents the amplitude coherence function value between the gravity anomaly information and the filtered value of the north acceleration at each frequency point, Represents the amplitude coherence function value between the gravity anomaly information and the filtered value of the celestial acceleration at each frequency point; according to , , , respectively calculated , , ,in, express The absolute value of the mean; express The absolute value of the mean; express The absolute value of the mean; Calculate the maximum absolute value of the mean value of the coherence function value at each frequency point. The calculation formula is: in, Indicates the maximum value, It means to find the maximum value; The operating speed calculation module is used to calculate the operating speed of the unmanned platform gravity measurement vehicle in the next cycle according to the maximum value and the current operating speed of the unmanned platform gravity measurement vehicle; The calculation formula for the operating speed of the next cycle is: in, Indicates the operating speed of the next cycle.

6. A computer device comprising a memory and a processor, wherein the memory stores a computer program, characterized in that: When the processor executes the computer program, the navigation method of the unmanned platform gravity measurement vehicle described in any one of claims 1 to 4 is implemented.

7. A computer program product, comprising a computer program, characterized in that When the computer program is executed by a processor, a navigation method for an unmanned platform gravity measurement vehicle according to any one of claims 1 to 4 is implemented.