CN112484721A - Underwater mobile platform navigation method and underwater mobile platform navigation device - Google Patents

Underwater mobile platform navigation method and underwater mobile platform navigation device Download PDF

Info

Publication number
CN112484721A
CN112484721A CN202011295214.8A CN202011295214A CN112484721A CN 112484721 A CN112484721 A CN 112484721A CN 202011295214 A CN202011295214 A CN 202011295214A CN 112484721 A CN112484721 A CN 112484721A
Authority
CN
China
Prior art keywords
navigation
information
navigation information
mobile platform
underwater mobile
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN202011295214.8A
Other languages
Chinese (zh)
Inventor
魏志强
殷波
丁明权
纪筱鹏
杜泽华
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Ocean University of China
Original Assignee
Ocean University of China
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Ocean University of China filed Critical Ocean University of China
Priority to CN202011295214.8A priority Critical patent/CN112484721A/en
Publication of CN112484721A publication Critical patent/CN112484721A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Manufacturing & Machinery (AREA)
  • Automation & Control Theory (AREA)
  • Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)

Abstract

本申请提供了一种水下移动平台导航方法。所述水下移动平台导航方法包括:获取捷联式惯性导航系统生成的第一导航信息;获取多普勒速度声呐系统生成的第二导航信息;获取北斗卫星导航系统或者磁罗盘系统生成的修正导航信息;根据第一导航信息以及第二导航信息生成第一融合导航信息;根据第一融合导航信息以及修正导航信息生成第二融合导航信息;根据第二融合导航信息生成导航控制信息;根据导航控制信息控制水下移动平台运动。本申请的水下移动平台导航方法通过组合导航技术进行修正误差的辅助导航技术,旨在采用高精度的导航技术对SINS随时间累积的误差进行校正,同时保证AUV的自主性和隐蔽性。

Figure 202011295214

The present application provides a navigation method for an underwater mobile platform. The underwater mobile platform navigation method includes: acquiring first navigation information generated by a strapdown inertial navigation system; acquiring second navigation information generated by a Doppler velocity sonar system; acquiring corrections generated by a Beidou satellite navigation system or a magnetic compass system navigation information; generating first fusion navigation information according to the first navigation information and the second navigation information; generating second fusion navigation information according to the first fusion navigation information and the revised navigation information; generating navigation control information according to the second fusion navigation information; The control information controls the movement of the underwater mobile platform. The underwater mobile platform navigation method of the present application uses the integrated navigation technology to correct the error-assisted navigation technology, and aims to use high-precision navigation technology to correct the errors accumulated by the SINS over time, while ensuring the autonomy and concealment of the AUV.

Figure 202011295214

Description

Underwater mobile platform navigation method and underwater mobile platform navigation device
Technical Field
The application belongs to the technical field of underwater wireless platforms, and particularly relates to an underwater mobile platform navigation method and an underwater mobile platform navigation device.
Background
The accuracy of the underwater navigation technology of the Autonomous Underwater Vehicle (AUV) is a powerful guarantee for carrying out tasks such as searching, detecting and anti-diving under water. Most of the existing AUV navigation methods mainly use a Strapdown Inertial Navigation System (SINS).
The current position of the strapdown inertial navigation system is calculated on the basis of the position of the previous moment, errors are accumulated along with the increase of iteration times, and the positioning accuracy of the strapdown inertial navigation system is greatly reduced by the factors of the errors and the inherent errors in the processes of equipment installation, measurement and the like.
Accordingly, a technical solution is desired to overcome or at least alleviate at least one of the above-mentioned drawbacks of the prior art.
Disclosure of Invention
The present application is directed to an underwater mobile platform navigation method to solve at least one of the above problems.
In a first aspect of the present application, an underwater mobile platform navigation method includes:
acquiring first navigation information generated by a strapdown inertial navigation system;
acquiring second navigation information generated by the Doppler velocity sonar system;
acquiring corrected navigation information generated by a Beidou satellite navigation system or a magnetic compass system;
generating first fusion navigation information according to the first navigation information and the second navigation information;
generating second fused navigation information according to the first fused navigation information and the corrected navigation information;
generating navigation control information according to the second fusion navigation information;
and controlling the underwater mobile platform to move according to the navigation control information.
Optionally, the acquiring the first position information generated by the strapdown inertial navigation system includes:
acquiring acceleration information of an underwater mobile platform;
acquiring triaxial acceleration information of an underwater mobile platform;
and generating the first position information according to the acceleration information and the triaxial acceleration information.
Optionally, the acquiring the second navigation information generated by the doppler velocity sonar system includes:
acquiring speed information acquired by a Doppler log;
and generating second navigation information according to the speed information.
Optionally, the acquiring of the modified navigation information generated by the beidou satellite navigation system or the magnetic compass system includes:
judging whether a satellite navigation signal exists or not, and if so, generating the corrected navigation information through the Beidou satellite navigation system;
and if not, generating the corrected navigation information through the magnetic compass system.
Optionally, the generating the modified navigation information by the beidou satellite navigation system includes:
sending position request information to a Beidou satellite;
acquiring position information sent by a Beidou satellite;
and generating the corrected navigation information according to the position information.
Optionally, the generating the modified navigation information by the magnetic compass system comprises:
acquiring an initial matching position;
judging whether the initial matching position is larger than a preset error value, if so,
processing by adopting a T algorithm to generate position deviation information;
generating matching position information according to the position deviation information;
and generating corrected navigation information according to the deviation information and the position matching information.
Optionally, the generating the modified navigation information by the magnetic compass system further comprises:
judging whether the initial matching position is larger than a preset error value, if not,
the modified navigation information is generated using the S algorithm.
The present application further provides an electronic device comprising a memory, a processor and a computer program stored in the memory and capable of running on the processor, wherein the processor implements the underwater mobile platform navigation method as described above when executing the computer program.
The present application also provides a computer-readable storage medium having a computer program stored thereon, wherein the computer program, when executed by a processor, is capable of implementing an underwater mobile platform navigation method as described above.
The application has at least the following beneficial technical effects:
the underwater mobile platform navigation method mainly comprises the steps of carrying out error correction on an auxiliary navigation technology by taking a Strapdown Inertial Navigation System (SINS) as a main part and using a Doppler velocity sonar (DVL), a Beidou satellite navigation system (BDS) and a magnetic compass navigation (MCP) through a combined navigation technology, and aims to correct errors accumulated by the SINS along with time by adopting a high-precision navigation technology and ensure the autonomy and the concealment of an AUV (autonomous underwater vehicle).
Drawings
Fig. 1 is a schematic flow chart of a method for navigating an underwater mobile platform according to an embodiment of the present application.
Detailed Description
In order to make the implementation objects, technical solutions and advantages of the present application clearer, the technical solutions in the embodiments of the present application will be described in more detail below with reference to the drawings in the embodiments of the present application. In the drawings, the same or similar reference numerals denote the same or similar elements or elements having the same or similar functions throughout. The described embodiments are a subset of the embodiments in the present application and not all embodiments in the present application. The embodiments described below with reference to the drawings are exemplary and intended to be used for explaining the present application and should not be construed as limiting the present application. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present application. Embodiments of the present application will be described in detail below with reference to the accompanying drawings.
It should be noted that the terms "first" and "second" in the description of the present invention are used for descriptive purposes only and are not to be construed as indicating or implying relative importance.
The underwater mobile platform navigation method shown in fig. 1 comprises the following steps:
step 1: acquiring first navigation information generated by a strapdown inertial navigation system;
step 2: acquiring second navigation information generated by the Doppler velocity sonar system;
and step 3: acquiring corrected navigation information generated by a Beidou satellite navigation system or a magnetic compass system;
and 4, step 4: generating first fusion navigation information according to the first navigation information and the second navigation information;
and 5: generating second fusion navigation information according to the first fusion navigation information and the corrected navigation information;
step 6: generating navigation control information according to the second fusion navigation information;
and 7: and controlling the underwater mobile platform to move according to the navigation control information.
Compared with the prior art, the underwater mobile platform navigation method has the following advantages:
1. in order to improve the overall performance of the navigation system, the system needs to combine various navigation systems for use, has complementary advantages, overcomes the defect that one navigation device works independently, and adopts a Kalman filtering algorithm to combine the navigation systems to form a combined navigation system.
2. After the navigation depth and speed of the AUV are stable, the BDS signal receiving antenna floats to the water surface to receive BDS signals, active calibration is carried out on the SINS, and the BDS signal receiving antenna is recovered after the calibration is finished. The mode ensures the concealment of the AUV in the navigation process and reduces the energy consumption in the ascending process of the AUV.
3. In the process of correcting SINS navigation deviation by using geomagnetic navigation, a combined mode of T + S + Kalman is adopted, respective advantages of a T algorithm and an S algorithm are fully utilized, and the advantages of the T algorithm and the S algorithm are made good use of, so that the characteristic that a T system can still work well when the initial matching error is large is utilized, the reliability of the S algorithm is increased, the limitation that the S algorithm causes mismatching when the initial error is large is relaxed, the characteristic that the S algorithm has high precision when the initial error is not large is utilized, the optimal matching position is obtained, the optimal estimated position is obtained through a Kalman filter, and the optimal estimated position is output to an inertial navigation system to compensate the accumulation of the error.
In this embodiment, the obtaining the first position information generated by the strapdown inertial navigation system includes:
acquiring triaxial acceleration information of an underwater mobile platform, wherein the triaxial acceleration information comprises acceleration information of an x axis, a y axis and a z axis of a motion coordinate system of the underwater mobile platform;
and generating first position information according to the triaxial acceleration information.
In this embodiment, the acquiring of the second navigation information generated by the doppler velocity sonar system includes:
acquiring speed information acquired by a Doppler log;
and generating second navigation information according to the speed information.
In this embodiment, acquiring the modified navigation information generated by the beidou satellite navigation system or the magnetic compass system includes:
judging whether a satellite navigation signal exists or not, and if so, generating the corrected navigation information through a Beidou satellite navigation system;
and if not, generating the corrected navigation information through a magnetic compass system.
In this embodiment, generating the modified navigation information through the beidou satellite navigation system includes:
sending position request information to a Beidou satellite;
acquiring position information sent by a Beidou satellite;
and generating the corrected navigation information according to the position information.
In this embodiment, the generating of the modified navigation information by the magnetic compass system includes:
acquiring an initial matching position;
judging whether the initial matching position is larger than a preset error value, if so,
processing by adopting a T algorithm to generate position deviation information;
generating matching position information according to the position deviation information;
and generating corrected navigation information according to the deviation information and the position matching information.
In this embodiment, the generating of the modified navigation information by the magnetic compass system further includes:
judging whether the initial matching position is larger than a preset error value, if not,
the modified navigation information is generated using the S algorithm.
The application also provides an underwater mobile platform navigation device, which comprises a first navigation information acquisition module, a second navigation information acquisition module, a corrected navigation information acquisition module, a first fusion navigation information generation module, a second fusion navigation information generation module, a navigation control information generation module and a power system, wherein,
the first navigation information acquisition module is used for acquiring first navigation information generated by the strapdown inertial navigation system;
the second navigation information acquisition module is used for acquiring second navigation information generated by the Doppler velocity sonar system;
the corrected navigation information acquisition module is used for acquiring corrected navigation information generated by a Beidou satellite navigation system or a magnetic compass system;
the first fusion navigation information generation module is used for generating first fusion navigation information according to the first navigation information and the second navigation information;
the second fusion navigation information generation module is used for generating second fusion navigation information according to the first fusion navigation information and the correction navigation information;
the navigation control information generating module is used for generating navigation control information according to the second fusion navigation information;
and the power system is used for controlling the underwater mobile platform to move according to the navigation control information.
It should be noted that the foregoing explanations of the method embodiments also apply to the apparatus of this embodiment, and are not repeated herein.
In this embodiment, the strapdown inertial navigation system is an autonomous dead reckoning navigation system in which inertial measurement units (a gyroscope and an accelerometer) are directly mounted on a main body, and the attitude, the azimuth, the velocity, and the position of a vehicle are determined using the reference direction of the inertial measurement unit and initial position information. The laser inertial measurement unit establishes a coordinate conversion matrix from a gyro sensitive carrier coordinate system to a navigation coordinate system through a quaternion integral algorithm by using the angular velocity in the direction of the gyro sensitive carrier coordinate system and the specific force in the direction of the accelerometer sensitive carrier coordinate system, and converts specific force increment to the navigation coordinate system, thereby establishing a mathematical platform. And integrating the specific force increment to obtain speed and position parameters, and calculating the course and attitude parameters of the carrier to complete the calculation of pure inertial navigation. And receiving data of the Doppler log by serial communication, finishing a Kalman filtering algorithm to obtain corrected speed, position, course and attitude parameters, and then sending the parameters to a central control unit through a serial communication port.
An underwater Doppler log generally adopts a four-wave speed system with a fixed wave speed direction. Namely, the direction of the transmitted sound wave speed is fixed relative to the angle position of the instrument coordinate system of the Doppler velocimeter, when the Doppler velocimeter is installed on an AUV, the instrument coordinate system of the Doppler velocimeter is parallel to all axes of an AUV carrier coordinate system, and the direction of the Doppler velocimeter is kept consistent, and the speed reflected in the instrument coordinate system of the Doppler velocimeter is also the speed of the AUV carrier coordinate system. The Doppler log is mainly used for correcting the speed error of the laser inertial measurement unit. The speed measurement error of the acoustic wave log is converted into a flight distance error through one-time integration, some random quantities in the speed measurement error can be offset through long-time integration, and some drift quantities are finally reflected as the flight distance error. According to the error characteristic of the current Doppler log, when the speed measurement error is not more than 0.5%, the integrated navigation precision can be ensured.
When a magnetic compass system is adopted for navigation, the algorithm matching implementation scheme is as follows: t-computing (as an external environment) is introduced. The T algorithm has the characteristics that the positioning accuracy is not influenced by a detection blind area, but under an ideal condition, the positioning accuracy is not high compared with that of the S algorithm. Therefore, T algorithm is used for pre-matching, and initial matching error is reduced, so that the problem that S algorithm is easy to diverge when the initial matching error is large is solved.
Specifically, when the AUV starts to perform auxiliary navigation, if the initial matching position error delta X _ SINS > psix _ SINS of the inertial navigation system, a large-range search is performed by using a T algorithm, and a track which is closer to a real track is found to reduce the position deviation of the inertial navigation system; on the basis, further matching is carried out by utilizing an S algorithm, so that the optimal matching position can be obtained; and taking the difference between the two positions as the observed quantity of a Kalman filter to obtain the optimal estimation, thereby correcting the navigation error of the inertial navigation system. The Ψ XSINS is a preset threshold, and needs to be set manually according to the technical requirements of actual navigation and the accuracy of a digital map. If the initial matching error is not large (within the S algorithm precision tolerance range), the large-range search of the T method is omitted, the S algorithm is directly used for matching, and then the optimal estimation is carried out through a Kalman filter. Then, whether the blind area is reached is judged according to the indicated position of the inertial navigation system, the geomagnetic map, the preset path and the precision of the depth measuring sensor. If the blind area is not reached, continuously correcting the error of the inertial navigation system by using the S algorithm to carry out auxiliary navigation; otherwise, after the AUV exits the detection blind area, the position indicated by the inertial navigation system finally is continuously used for judging whether the initial matching position error delta XSINS is larger than the preset threshold psi XSINS, and then the steps are repeated.
The application also provides an electronic device, which comprises a memory, a processor and a computer program stored in the memory and capable of running on the processor, wherein the processor executes the computer program to realize the underwater wireless information communication method.
For example, an electronic device includes an input device, an input interface, a central processing unit, a memory, an output interface, and an output device. The input interface, the central processing unit, the memory and the output interface are mutually connected through a bus, and the input equipment and the output equipment are respectively connected with the bus through the input interface and the output interface and further connected with other components of the computing equipment. Specifically, the input device receives input information from the outside and transmits the input information to the central processing unit through the input interface; the central processing unit processes the input information based on the computer executable instructions stored in the memory to generate output information, temporarily or permanently stores the output information in the memory, and then transmits the output information to the output device through the output interface; the output device outputs the output information to an exterior of the computing device for use by a user.
The present application also provides a computer-readable storage medium storing a computer program which, when executed by a processor, is capable of implementing the above underwater wireless information communication method.
Although the present application has been described with reference to the preferred embodiments, it is not intended to limit the present application, and those skilled in the art can make variations and modifications without departing from the spirit and scope of the present application.
In a typical configuration, a computing device includes one or more processors (CPUs), input/output interfaces, network interfaces, and memory.
The memory may include forms of volatile memory in a computer readable medium, Random Access Memory (RAM) and/or non-volatile memory, such as Read Only Memory (ROM) or flash memory (flash RAM). Memory is an example of a computer-readable medium.
Computer-readable media include both non-transitory and non-transitory, removable and non-removable media that implement information storage by any method or technology. The information may be computer readable instructions, data structures, modules of a program, or other data. Examples of computer storage media include, but are not limited to, phase change memory (PRAM), Static Random Access Memory (SRAM), Dynamic Random Access Memory (DRAM), other types of Random Access Memory (RAM), Read Only Memory (ROM), Electrically Erasable Programmable Read Only Memory (EEPROM), flash memory or other memory technology, compact disc read only memory (CD-ROM), Digital Versatile Discs (DVD) or other optical storage, magnetic cassettes, magnetic tape, magnetic disk storage or other magnetic storage devices, or any other non-transmission medium that can be used to store information that can be accessed by a computing device.
As will be appreciated by one skilled in the art, embodiments of the present application may be provided as a method, system, or computer program product. Accordingly, the present application may take the form of an entirely hardware embodiment, an entirely software embodiment or an embodiment combining software and hardware aspects. Furthermore, the present application may take the form of a computer program product embodied on one or more computer-usable storage media (including, but not limited to, disk storage, CD-ROM, optical storage, and the like) having computer-usable program code embodied therein.
Furthermore, it will be obvious that the term "comprising" does not exclude other elements or steps. A plurality of units, modules or devices recited in the device claims may also be implemented by one unit or overall device by software or hardware. The terms first, second, etc. are used to identify names, but not any particular order.
The flowchart and block diagrams in the figures illustrate the architecture, functionality, and operation of possible implementations of systems, methods and computer program products according to various embodiments of the present application. In this regard, each block in the flowchart or block diagrams may represent a module, segment, or portion of code, which comprises one or more executable instructions for implementing the specified logical function(s). It should also be noted that, in some alternative implementations, the functions noted in the block may occur out of the order noted in the figures. For example, two blocks identified in succession may, in fact, be executed substantially concurrently, or the blocks may sometimes be executed in the reverse order, depending upon the functionality involved. It will also be noted that each block of the block diagrams and/or flowchart illustration, and combinations of blocks in the block diagrams and/or flowchart illustration, can be implemented by special purpose hardware-based systems which perform the specified functions or acts, or combinations of special purpose hardware and computer instructions.
The Processor in this embodiment may be a Central Processing Unit (CPU), other general purpose Processor, a Digital Signal Processor (DSP), an Application Specific Integrated Circuit (ASIC), an off-the-shelf Programmable Gate Array (FPGA) or other Programmable logic device, a discrete Gate or transistor logic device, a discrete hardware component, and so on. A general purpose processor may be a microprocessor or the processor may be any conventional processor or the like.
The memory may be used to store computer programs and/or modules, and the processor may implement various functions of the apparatus/terminal device by running or executing the computer programs and/or modules stored in the memory, as well as by invoking data stored in the memory. The memory may mainly include a storage program area and a storage data area, wherein the storage program area may store an operating system, an application program required by at least one function (such as a sound playing function, an image playing function, etc.), and the like; the storage data area may store data (such as audio data, a phonebook, etc.) created according to the use of the cellular phone, and the like. In addition, the memory may include high speed random access memory, and may also include non-volatile memory, such as a hard disk, a memory, a plug-in hard disk, a Smart Media Card (SMC), a Secure Digital (SD) Card, a Flash memory Card (Flash Card), at least one magnetic disk storage device, a Flash memory device, or other volatile solid state storage device.
In this embodiment, the module/unit integrated with the apparatus/terminal device may be stored in a computer-readable storage medium if it is implemented in the form of a software functional unit and sold or used as a separate product. Based on such understanding, all or part of the flow in the method according to the embodiments of the present invention may also be implemented by a computer program to instruct related hardware, where the computer program may be stored in a computer readable storage medium, and when the computer program is executed by a processor, the computer program may implement the steps of the embodiments of the method. Wherein the computer program comprises computer program code, which may be in the form of source code, object code, an executable file or some intermediate form, etc. The computer readable medium may include: any entity or device capable of carrying computer program code, recording medium, U.S. disk, removable hard disk, magnetic disk, optical disk, computer Memory, Read-Only Memory (ROM), Random Access Memory (RAM), electrical carrier wave signals, telecommunications signals, software distribution media, and the like. It should be noted that the computer readable medium may contain content that is appropriately increased or decreased as required by legislation and patent practice in the jurisdiction.
Finally, it should be pointed out that: the above examples are only for illustrating the technical solutions of the present invention, and are not limited thereto. Although the present invention has been described in detail with reference to the foregoing embodiments, it will be understood by those of ordinary skill in the art that: the technical solutions described in the foregoing embodiments may still be modified, or some technical features may be equivalently replaced; and such modifications or substitutions do not depart from the spirit and scope of the corresponding technical solutions of the embodiments of the present invention.

Claims (10)

1.一种水下移动平台导航方法,其特征在于,所述水下移动平台导航方法包括:1. an underwater mobile platform navigation method, is characterized in that, described underwater mobile platform navigation method comprises: 获取捷联式惯性导航系统生成的第一导航信息;obtaining the first navigation information generated by the strapdown inertial navigation system; 获取多普勒速度声呐系统生成的第二导航信息;obtaining the second navigation information generated by the Doppler velocity sonar system; 获取北斗卫星导航系统或者磁罗盘系统生成的修正导航信息;Obtain the corrected navigation information generated by the Beidou satellite navigation system or the magnetic compass system; 根据所述第一导航信息以及第二导航信息生成第一融合导航信息;generating first fusion navigation information according to the first navigation information and the second navigation information; 根据所述第一融合导航信息以及所述修正导航信息生成第二融合导航信息;generating second fused navigation information according to the first fused navigation information and the modified navigation information; 根据所述第二融合导航信息生成导航控制信息;generating navigation control information according to the second fusion navigation information; 根据所述导航控制信息控制水下移动平台运动。The movement of the underwater mobile platform is controlled according to the navigation control information. 2.如权利要求1所述的水下移动平台导航方法,其特征在于,所述获取捷联式惯性导航系统生成的第一位置信息包括:2. The underwater mobile platform navigation method according to claim 1, wherein the acquiring the first position information generated by the strapdown inertial navigation system comprises: 获取水下移动平台的三轴加速度信息;Obtain the three-axis acceleration information of the underwater mobile platform; 根据所述三轴加速度信息生成所述第一位置信息。The first position information is generated according to the three-axis acceleration information. 3.如权利要求1所述的水下移动平台导航方法,其特征在于,所述获取多普勒速度声呐系统生成的第二导航信息包括:3. underwater mobile platform navigation method as claimed in claim 1, is characterized in that, described obtaining the second navigation information that Doppler velocity sonar system generates comprises: 获取多普勒计程仪所获取的速度信息;Obtain the speed information obtained by the Doppler log; 根据所述速度信息生成第二导航信息。Second navigation information is generated according to the speed information. 4.如权利要求1所述的水下移动平台导航方法,其特征在于,所述获取通过北斗卫星导航系统或者磁罗盘系统生成的修正导航信息包括:4. The method for navigating an underwater mobile platform according to claim 1, wherein the obtaining the corrected navigation information generated by the Beidou satellite navigation system or the magnetic compass system comprises: 判断是否具有卫星导航信号,若有,则通过所述北斗卫星导航系统生成所述修正导航信息;Determine whether there is a satellite navigation signal, and if so, generate the corrected navigation information through the Beidou satellite navigation system; 若否,则通过所述磁罗盘系统生成所述修正导航信息。If not, the modified navigation information is generated by the magnetic compass system. 5.如权利要求4所述的水下移动平台导航方法,其特征在于,所述通过所述北斗卫星导航系统生成所述修正导航信息包括:5. The method for navigating an underwater mobile platform according to claim 4, wherein the generating the corrected navigation information by the Beidou satellite navigation system comprises: 向北斗卫星发送位置请求信息;Send location request information to Beidou satellites; 获取北斗卫星发送的位置信息;Obtain location information sent by Beidou satellites; 根据所述位置信息生成所述修正导航信息。The revised navigation information is generated based on the location information. 6.如权利要求4所述的水下移动平台导航方法,其特征在于,所述通过所述磁罗盘系统生成所述修正导航信息包括:6. The method for navigating an underwater mobile platform according to claim 4, wherein the generating the corrected navigation information by the magnetic compass system comprises: 获取初始匹配位置;Get the initial matching position; 判断初始匹配位置是否大于预设误差值,若是,Determine whether the initial matching position is greater than the preset error value, if so, 则采用T算法进行处理,生成位置偏差信息;Then use the T algorithm for processing to generate position deviation information; 根据位置偏差信息生成匹配位置信息;Generate matching position information according to the position deviation information; 根据所述偏差信息以及位置匹配信息生成修正导航信息。Correction navigation information is generated based on the deviation information and the position matching information. 7.如权利要求6所述的水下移动平台导航方法,其特征在于,所述通过所述磁罗盘系统生成所述修正导航信息包括进一步包括:7. The method for navigating an underwater mobile platform according to claim 6, wherein the generating the corrected navigation information by the magnetic compass system further comprises: 判断初始匹配位置是否大于预设误差值,若否,Determine whether the initial matching position is greater than the preset error value, if not, 则采用S算法生成修正导航信息。Then the S algorithm is used to generate the revised navigation information. 8.一种水下移动平台导航装置,其特征在于,所述水下移动平台导航装置包括:8. An underwater mobile platform navigation device, wherein the underwater mobile platform navigation device comprises: 第一导航信息获取模块,所述第一导航信息获取模块用于获取捷联式惯性导航系统生成的第一导航信息;a first navigation information acquisition module, the first navigation information acquisition module is used to acquire the first navigation information generated by the strapdown inertial navigation system; 第二导航信息获取模块,所述第二导航信息获取模块用于获取多普勒速度声呐系统生成的第二导航信息;a second navigation information acquisition module, the second navigation information acquisition module is used to acquire the second navigation information generated by the Doppler velocity sonar system; 修正导航信息获取模块,所述修正导航信息获取模块用于获取北斗卫星导航系统或者磁罗盘系统生成的修正导航信息;a modified navigation information acquisition module, the modified navigation information acquisition module is used to acquire the modified navigation information generated by the Beidou satellite navigation system or the magnetic compass system; 第一融合导航信息生成模块,所述第一融合导航信息生成模块用于根据所述第一导航信息以及第二导航信息生成第一融合导航信息;a first integrated navigation information generation module, the first integrated navigation information generation module is configured to generate first integrated navigation information according to the first navigation information and the second navigation information; 第二融合导航信息生成模块,所述第二融合导航信息生成模块用于根据所述第一融合导航信息以及所述修正导航信息生成第二融合导航信息;a second integrated navigation information generation module, the second integrated navigation information generation module is configured to generate second integrated navigation information according to the first integrated navigation information and the modified navigation information; 导航控制信息生成模块,所述导航控制信息生成模块用于根据所述第二融合导航信息生成导航控制信息;a navigation control information generation module, the navigation control information generation module is configured to generate navigation control information according to the second fusion navigation information; 动力系统,所述动力系统用于根据所述导航控制信息控制水下移动平台运动。The power system is used for controlling the movement of the underwater mobile platform according to the navigation control information. 9.一种电子设备,包括存储器、处理器以及存储在所述存储器中并能够在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1至7中任一项所述的水下移动平台导航方法。9. An electronic device, comprising a memory, a processor, and a computer program stored in the memory and capable of running on the processor, characterized in that, when the processor executes the computer program, the implementation as claimed in the claims The underwater mobile platform navigation method described in any one of 1 to 7. 10.一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,其特征在于,所述计算机程序被处理器执行时能够实现如权利要求1至7中任一项所述的水下移动平台导航方法。10. A computer-readable storage medium, wherein the computer-readable storage medium stores a computer program, wherein when the computer program is executed by a processor, the computer program according to any one of claims 1 to 7 can be implemented Navigation method of underwater mobile platform.
CN202011295214.8A 2020-11-18 2020-11-18 Underwater mobile platform navigation method and underwater mobile platform navigation device Pending CN112484721A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011295214.8A CN112484721A (en) 2020-11-18 2020-11-18 Underwater mobile platform navigation method and underwater mobile platform navigation device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011295214.8A CN112484721A (en) 2020-11-18 2020-11-18 Underwater mobile platform navigation method and underwater mobile platform navigation device

Publications (1)

Publication Number Publication Date
CN112484721A true CN112484721A (en) 2021-03-12

Family

ID=74931411

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011295214.8A Pending CN112484721A (en) 2020-11-18 2020-11-18 Underwater mobile platform navigation method and underwater mobile platform navigation device

Country Status (1)

Country Link
CN (1) CN112484721A (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113566809A (en) * 2021-06-29 2021-10-29 陕西省引汉济渭工程建设有限公司 A navigation and positioning device and implementation method of a water conveyance tunnel detection robot assisted by artificial road signs
CN113776514A (en) * 2021-08-10 2021-12-10 深之蓝海洋科技股份有限公司 Relative navigation method and device for detecting vertical surface under liquid by robot

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103744098A (en) * 2014-01-23 2014-04-23 东南大学 Ship's inertial navigation system (SINS)/Doppler velocity log (DVL)/global positioning system (GPS)-based autonomous underwater vehicle (AUV) combined navigation system
CN110044378A (en) * 2019-04-17 2019-07-23 河海大学 A kind of fiber strapdown inertial navigation high-accuracy position system and method for underwater bathyscaph
CN110715660A (en) * 2019-11-21 2020-01-21 中国人民解放军63961部队 Beidou/inertia combined anti-deception jamming method based on Kalman filtering estimation
CN110940340A (en) * 2019-12-23 2020-03-31 中科探海(苏州)海洋科技有限责任公司 Multi-sensor information fusion method based on small UUV platform
CN110954097A (en) * 2019-12-13 2020-04-03 陕西瑞特测控技术有限公司 Navigation positioning method for robot combination

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103744098A (en) * 2014-01-23 2014-04-23 东南大学 Ship's inertial navigation system (SINS)/Doppler velocity log (DVL)/global positioning system (GPS)-based autonomous underwater vehicle (AUV) combined navigation system
CN110044378A (en) * 2019-04-17 2019-07-23 河海大学 A kind of fiber strapdown inertial navigation high-accuracy position system and method for underwater bathyscaph
CN110715660A (en) * 2019-11-21 2020-01-21 中国人民解放军63961部队 Beidou/inertia combined anti-deception jamming method based on Kalman filtering estimation
CN110954097A (en) * 2019-12-13 2020-04-03 陕西瑞特测控技术有限公司 Navigation positioning method for robot combination
CN110940340A (en) * 2019-12-23 2020-03-31 中科探海(苏州)海洋科技有限责任公司 Multi-sensor information fusion method based on small UUV platform

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
黄新松等: "《基于TRIZ分析的海军直升机导航方法研究》", 《直升机技术》 *

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113566809A (en) * 2021-06-29 2021-10-29 陕西省引汉济渭工程建设有限公司 A navigation and positioning device and implementation method of a water conveyance tunnel detection robot assisted by artificial road signs
CN113566809B (en) * 2021-06-29 2024-12-24 陕西省引汉济渭工程建设有限公司 A navigation and positioning device for a water tunnel inspection robot assisted by artificial road signs and its implementation method
CN113776514A (en) * 2021-08-10 2021-12-10 深之蓝海洋科技股份有限公司 Relative navigation method and device for detecting vertical surface under liquid by robot

Similar Documents

Publication Publication Date Title
CN109443379B (en) A SINS/DVL underwater anti-sway alignment method for deep-sea submersibles
CN103744098B (en) AUV integrated navigation systems based on SINS/DVL/GPS
US7839329B2 (en) Positioning system and method thereof
JP5270184B2 (en) Satellite navigation / dead reckoning integrated positioning system
Ishibashi et al. Accuracy improvement of an inertial navigation system brought about by the rotational motion
CN113311436A (en) A method for correcting the motion and attitude of the laser wind measurement radar on a mobile platform
RU2380656C1 (en) Integrated strapdown inertial and satellite navigation system on coarse sensors
CN110057356B (en) Method and device for locating vehicle in tunnel
CN104697520B (en) Integrated gyro free strap down inertial navigation system and gps system Combinated navigation method
CN112484721A (en) Underwater mobile platform navigation method and underwater mobile platform navigation device
CN113252048A (en) Navigation positioning method, navigation positioning system and computer readable storage medium
EP2549230B1 (en) Method and navigation system for initialization with inertial data compensation
CN104061930B (en) A kind of air navigation aid based on strap-down inertial guidance and Doppler log
KR20230048324A (en) Extended dead reckoning accuracy
CN116337115A (en) A method and system for calibrating inertial sensors based on sonar
CN115326067A (en) PPP-INS integrated navigation positioning method and system based on low-orbit navigation enhancement
CN117232497A (en) Combined navigation and positioning system and method for dam underwater defect detection robot
CN113959433B (en) Combined navigation method and device
JP6531768B2 (en) Sensor error correction apparatus and method
CN103697887B (en) A kind of optimization air navigation aid based on SINS and Doppler log
CN112179356A (en) Weak network environment navigation method and system based on intelligent dead reckoning
CN115839718B (en) Fusion positioning method and device based on motion constraint
CN114397480B (en) Acoustic Doppler velocimeter error estimation method, device and system
CN112229401B (en) Measurement information synchronous extrapolation method and system suitable for INS-GPS pseudo range fusion
CN115343738A (en) Integrated navigation method and device based on GNSS-RTK and IMU

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20210312