Self-alignment method and equipment for strapdown inertial navigation
By identifying the vibration frequency and position information of the equipment, and using FFT transformation to determine the acquisition cycle, the self-alignment of the strap-inerature inertial navigation in high-intensity vibration environment is achieved, and the problem of the inability to self-align in conventional methods in high-vibration environments is solved, and the problem of the inability to self-align in high-vibration environments is improved. The navigation accuracy of the equipment in harsh environments.
Patent Information
- Application Number
- CN202411188213.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-28
- Publication Date
- 2024-11-26
AI Technical Summary
In high-intensity vibration environment, conventional short-distance inertial navigation self-alignment methods cannot effectively achieve initial alignment, especially in large-scale equipment such as underground mines and subsea operations, the vibration amplitude of the equipment is often between 2g and 5g, resulting in self-alignment. fail.
By identifying the basic main frequency of the device's triaxial angular velocity and acceleration information, the acquisition period is determined, and the fast Fourier transform (FFT) is used to obtain the constant terms of angular velocity and acceleration, and combining the jitter frequency of position information, the initial time and time node are determined. Length, gradually complete the self-alignment of the strap-inductive navigation.
It effectively reduces the impact of high-intensity vibration on self-alignment, enhances environmental adaptability, and realizes the initial alignment of the strap-independent inertial navigation in high-vibration environments, which has practical engineering value.
Smart Images

Figure CN119022964A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of inertial integrated navigation, and in particular to a strapdown inertial navigation self-alignment method and equipment. Background Art
[0002] In large-scale intelligent equipment such as integrated coal mining machines in underground mines, seabed trenchers for underwater operations, seabed mining machines, and seabed cable laying machines, it is necessary to use strapdown inertial navigation and odometers to achieve precise positioning of the working surface during operation.
[0003] The strapdown inertial navigation system must be initially aligned before entering the navigation state. The function of the initial alignment is to obtain the attitude angle (including pitch angle and roll angle), heading angle, speed and displacement in three mutually perpendicular directions in space at the beginning of the strapdown inertial navigation system's navigation. In the above operating scenario, the strapdown inertial navigation can only complete the initial alignment through self-alignment. In the public literature, the requirement for self-alignment is that the carrier must be stationary or slightly shaking to achieve it. When the vibration amplitude of the carrier is large, that is, in a high-intensity vibration environment (such as above 2g), the relevant self-alignment cannot output a valid initial alignment result.
[0004] Large equipment such as comprehensive coal mining machines are restricted by the operating environment and cannot be stopped. The vibration overload in operation is generally between 2g and 5g. Conventional strapdown inertial navigation self-alignment methods are basically ineffective, and other methods must be used to complete the initial alignment. Summary of the invention
[0005] The invention provides a strapdown inertial navigation self-alignment method and device, which are used to solve the defect that the conventional method in the prior art cannot realize strapdown self-alignment under a high-intensity vibration environment.
[0006] In a first aspect, the present invention provides a self-alignment method for a strapdown inertial navigation system, comprising: determining an initial moment and a time node length for self-alignment according to sensitive information of a target device; the sensitive information comprising: three-axis angular velocity information, three-axis acceleration information and position information in a moving direction of the device; collecting sensitive information with the initial moment as a data collection starting point and the time node length as a collection period, performing a fast Fourier transform on the three-axis angular velocity information and the three-axis acceleration information collected in each collection period, determining the modulus values of three angular velocity constant items corresponding to the three-axis angular velocity information and the modulus values of three linear vibration constant items corresponding to the three-axis acceleration information; when it is determined that the modulus values of the three angular velocity constant items and the modulus values of the three linear vibration constant items in the current collection period all meet preset accuracy requirements, solving an attitude matrix and three initial attitude angles based on the three angular velocity constant items and the three linear vibration constant items in the current collection period; and using the three angular velocity constant items and the three linear vibration constant items in all collection periods from the initial moment to the end of the current sampling period, correcting the attitude matrix and the three initial attitude angles to complete the self-alignment of the strapdown inertial navigation system.
[0007] According to a strapdown inertial navigation self-alignment method provided by the present invention, the initial moment of self-alignment is determined based on the sensitive information of the target device, including: performing a fast Fourier transform on the position information in the direction of movement of the device to obtain the corresponding basic main frequency and basic initial phase of the position jitter; and determining the initial moment of alignment based on the basic main frequency and basic initial phase of the position jitter corresponding to the position information.
[0008] According to a strapdown inertial navigation self-alignment method provided by the present invention, the time node length for self-alignment is determined based on sensitive information of a target device, including: performing a fast Fourier transform on three-axis angular velocity information to obtain a basic main frequency of angular vibration corresponding to the three-axis angular velocity information; performing a fast Fourier transform on three-axis acceleration information to obtain a basic main frequency of linear vibration corresponding to the three-axis acceleration information; performing a fast Fourier transform on position information in a direction of motion of the device to obtain a basic main frequency of position jitter; determining three corresponding basic periods based on the basic main frequency of angular vibration, the basic main frequency of linear vibration and the basic main frequency of position jitter; and determining the time node length for self-alignment based on the three basic periods.
[0009] According to a self-alignment method of a strapdown inertial navigation system provided by the present invention, the time node length for self-alignment is determined based on the three basic cycles, including: when the difference between the three basic cycles does not exceed a preset threshold, the basic cycle corresponding to the basic main frequency of the position jitter is used as the time node length; and when the difference between the three basic cycles exceeds a preset threshold, the least common multiple of the three basic main cycles is used as the time node length.
[0010] According to a strapdown inertial navigation self-alignment method provided by the present invention, the initial time for alignment is determined according to the basic main frequency of position jitter and the basic initial phase corresponding to the position information, specifically:
[0011]
[0012] Among them, t0 is the initial time, is the basic initial phase corresponding to the position information, f DL0 is the basic main frequency of position jitter, T DL0 is the basic period corresponding to the basic main frequency of position jitter.
[0013] According to a strapdown inertial navigation self-alignment method provided by the present invention, the modulus values of the three angular velocity constant terms meet the preset accuracy requirements specifically: the difference between the modulus values of the three angular velocity constant terms and the angular rate of rotation of the earth is within a first preset range;
[0014] The moduli of the three linear vibration constant terms all meet the preset accuracy requirement, specifically: the difference between the moduli of the three linear vibration constant terms and the gravitational acceleration at the current geographical location is within a second preset range.
[0015] According to a strapdown inertial navigation self-alignment method provided by the present invention, the three-axis angular velocity information is obtained by using the three-axis gyroscope of the strapdown inertial navigation of the target device, the three-axis acceleration information is obtained by using the three-axis accelerometer of the strapdown inertial navigation of the target device, and the position information in the direction of movement of the device and the three-axis angular velocity information are obtained by using the odometer set on the target device.
[0016] In a second aspect, the present invention provides an electronic device, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein when the processor executes the program, the steps of the self-alignment method of the strapdown inertial navigation system as described above are implemented.
[0017] In a third aspect, the present invention further provides a non-transitory computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements the steps of any of the strapdown inertial navigation self-alignment methods described above.
[0018] In a fourth aspect, the present invention further provides a non-transitory computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements the steps of any of the above-described strapdown inertial navigation self-alignment methods.
[0019] The strapdown inertial navigation self-alignment method and device provided by the present invention can reduce the influence of high-intensity vibration to a minimum by identifying and utilizing the basic main period caused by vibration, thereby achieving the purpose of strapdown inertial navigation to complete self-alignment; the self-alignment method in this way has greatly enhanced environmental adaptability and has practical engineering value. BRIEF DESCRIPTION OF THE DRAWINGS
[0020] In order to more clearly illustrate the technical solutions in the present invention or the prior art, the following briefly introduces the drawings required for use in the embodiments or the description of the prior art. 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.
[0021] Figure 1 It is one of the flow charts of the self-alignment method of the strapdown inertial navigation system provided by the present invention;
[0022] Figure 2 It is a schematic diagram of the hardware structure of the strapdown inertial navigation and odometer provided by the present invention;
[0023] Figure 3 This is the second flow chart of the self-alignment method of the strapdown inertial navigation system provided by the present invention;
[0024] Figure 4 It is a structural schematic diagram of the electronic device provided by the present invention. DETAILED DESCRIPTION
[0025] In order to make the purpose, technical solution and advantages of the present invention clearer, the technical solution of the present invention will be clearly and completely described below in conjunction with the drawings of the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0026] It should be noted that, in the description of the embodiments of the present invention, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also includes other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the sentence "include one..." do not exclude the existence of other identical elements in the process, method, article or device including the elements. For those of ordinary skill in the art, the specific meanings of the above terms in the present invention can be understood according to the specific circumstances.
[0027] The terms "first", "second", etc. in this application are used to distinguish similar objects, and are not used to describe a specific order or sequence. It should be understood that the terms used in this way can be interchangeable under appropriate circumstances, so that the embodiments of the present application can be implemented in an order other than those illustrated or described here, and the objects distinguished by "first", "second", etc. are generally of the same type, and the number of objects is not limited. For example, the first object can be one or more.
[0028] When large equipment such as comprehensive coal mining machines, seabed trenching machines, seabed mining machines, and seabed cable laying machines are performing automated operations, they can temporarily stop moving due to operating conditions, but they cannot stop to create a period of static time because their strapdown inertial navigation systems need to be self-aligned; this is because doing so will cause serious problems such as equipment jamming, locking, and deformation of the working surface that cannot be handled in time. On the other hand, the power output of the power equipment of this type of large equipment is very large, which brings about extremely large vibration and noise, generally between 2 and 3g, and even more than 5g in extreme environments; conventional inertial self-alignment methods cannot complete initial alignment in this environment.
[0029] The purpose of the present invention is to propose a technical solution for self-alignment of a strapdown inertial navigation system under a moving base under strong noise and vibration conditions. Firstly, according to the vibration source characteristics of these large-scale equipment, information of a three-axis gyroscope, a three-axis accelerometer and an odometer is collected, and the main frequency related to the vibration is identified through FFT transformation, and then the optimal data processing cycle is confirmed; then, based on one or more optimal data processing cycles, constant terms of the collected data are identified, and rough alignment calculation is performed after the requirements are met, and finally, fine alignment calculation is performed to realize and complete the initial alignment of the strapdown inertial navigation.
[0030] Combine the following Figure 1-Figure 4 The strapdown inertial navigation self-alignment method and device provided by the embodiments of the present invention are described.
[0031] Figure 1 It is one of the flow charts of the self-alignment method of the strapdown inertial navigation system provided by the present invention, such as Figure 1 As shown, including but not limited to the following steps:
[0032] Step 101: Determine the initial time and time node length for self-alignment according to sensitive information of the target device, wherein the sensitive information includes: three-axis angular velocity information, three-axis acceleration information, and position information in the direction of device movement.
[0033] The target device in the present invention, whether underground or underwater, needs to obtain the geographical location information of the strapdown inertial navigation system on the device, wherein the geographical location information includes latitude Lat, longitude Lon, altitude Alt, and gravity acceleration g, and input these geographical information into the navigation computer.
[0034] The subject of the strapdown inertial navigation self-alignment method in the present invention may be a navigation computer. Figure 2 Schematic diagram of the hardware structure of the strapdown inertial navigation and odometer provided by the present invention, such as Figure 2 As shown, the three sensitive axes of the three-axis gyroscope are perpendicular to each other in space, and the three sensitive axes of the three-axis accelerometer are perpendicular to each other in space and parallel to the corresponding sensitive axes of the gyroscope; the odometer is only sensitive to the movement distance in the walking direction of the device. According to the installation method of the strapdown inertial navigation, the displacement direction sensitive to the odometer can be parallel to one axis of the strapdown inertial navigation.
[0035] It can be understood that the three-axis angular velocity information in the present invention is obtained by using the three-axis gyroscope of the strapdown inertial navigation of the target device, the three-axis acceleration information is obtained by using the three-axis accelerometer of the strapdown inertial navigation of the target device, and the three-axis angular velocity information of the position information in the direction of movement of the device is obtained by using the odometer set on the target device.
[0036] As an optional embodiment, the present invention provides a method for determining the initial moment of self-alignment based on sensitive information of the target device, including: performing a fast Fourier transform on the position information in the direction of movement of the device to obtain the corresponding basic main frequency and basic initial phase of the position jitter; and determining the initial moment of alignment based on the basic main frequency and basic initial phase of the position jitter corresponding to the position information. Specifically, the formula for calculating the initial moment is:
[0037]
[0038] Among them, t0 is the initial time, is the basic initial phase corresponding to the position information, f DL0 is the basic main frequency of position jitter, T DL0 is the basic period corresponding to the basic main frequency of position jitter.
[0039] Based on the contents of the above embodiments, as an optional embodiment, the present invention determines the length of the time node for self-alignment according to the sensitive information of the target device, including: performing a fast Fourier transform on the three-axis angular velocity information to obtain the basic main frequency of angular vibration corresponding to the three-axis angular velocity information; performing a fast Fourier transform on the three-axis acceleration information to obtain the basic main frequency of linear vibration corresponding to the three-axis acceleration information; performing a fast Fourier transform on the position information in the direction of movement of the device to obtain the basic main frequency of position jitter; determining the corresponding three basic periods according to the basic main frequency of angular vibration, the basic main frequency of linear vibration and the basic main frequency of position jitter; and determining the length of the time node for self-alignment according to the three basic periods.
[0040] Optionally, the present invention uses the frequency corresponding to the maximum amplitude value as the basic main frequency.
[0041] Furthermore, the present invention provides a method for determining the time node length for self-alignment based on the three basic periods according to the sensitive information of the target device, including: when the difference between the three basic periods does not exceed a preset threshold, the basic period corresponding to the basic main frequency of the position jitter is used as the time node length; and when the difference between the three basic periods exceeds a preset threshold, the least common multiple of the three basic main periods is used as the time node length.
[0042] Optionally, the preset threshold value may be set in a percentage form, such as 1%.
[0043] Step 102: Collect sensitive information with the initial moment as the data collection starting point and the time node length as the collection period, perform fast Fourier transform on the three-axis angular velocity information and three-axis acceleration information collected in each collection period, and determine the modulus values of the three angular velocity constant terms corresponding to the three-axis angular velocity information and the modulus values of the three linear vibration constant terms corresponding to the three-axis acceleration information.
[0044] Step 103: When it is determined that the moduli of the three angular velocity constant terms and the moduli of the three linear vibration constant terms in the current acquisition cycle meet the preset accuracy requirements, the attitude matrix and the three initial attitude angles are calculated based on the three angular velocity constant terms and the three linear vibration constant terms in the current acquisition cycle.
[0045] Optionally, the moduli of the three angular velocity constant terms meet the preset accuracy requirements, specifically: the difference between the moduli of the three angular velocity constant terms and the angular rate of the earth's rotation is within a first preset range; the moduli of the three linear vibration constant terms all meet the preset accuracy requirements, specifically: the difference between the moduli of the three linear vibration constant terms and the gravitational acceleration at the current geographical location is within a second preset range.
[0046] The first preset range and the second preset range can be set according to actual needs.
[0047] Step 104: using the three angular velocity constant terms and the three linear vibration constant terms in all the acquisition cycles from the initial moment to the end of the current sampling cycle, the attitude array and the three initial attitude angles are corrected to complete the self-alignment of the strapdown inertial navigation.
[0048] The strapdown inertial navigation self-alignment method provided by the present invention reduces the influence of high-intensity vibration to a minimum by identifying and utilizing the basic main period caused by vibration, thereby achieving the purpose of strapdown inertial navigation being able to complete self-alignment; the self-alignment method in this manner has greatly enhanced environmental adaptability and has practical engineering value.
[0049] In order to more clearly illustrate the technical solution of the present invention, a specific embodiment is further described.
[0050] The strapdown inertial navigation body coordinate system O1X1Y1Z1 in the present invention adopts the front lower right form and complies with the right-hand rule, that is, the origin O1 is located at the center of the strapdown inertial navigation body, the O1X1 axis points to the front of the product, the O1Y1 axis points to the right side of the product, and the O1Z1 axis points to the bottom of the product; the gyroscope in the strapdown inertial navigation has an accuracy better than 0.01° / h, and the accelerometer has an accuracy better than 50μg;
[0051] When the strapdown inertial navigation system is installed on the equipment, the O1X1 axis is required to point to the direction of the equipment's forward movement; the odometer is installed on the equipment's track wheel or wheel, and is used to sense the position information of the equipment's movement direction (i.e., the O1X1 axis direction), and can identify and output the positive and negative directions of the equipment's movement;
[0052] The navigation coordinate system OXYZ used for initial alignment and navigation of the strapdown inertial navigation system is a local geographic coordinate system in the form of north-east-down; that is, the OX axis points to the local geographic north, the OY axis points to the local geographic east, and the OZ axis points vertically downward;
[0053] Figure 3 This is the second flow chart of the self-alignment method of the strapdown inertial navigation system provided by the present invention. Under the premise of the aforementioned hardware and requirements, as Figure 3 As shown in the figure, the self-alignment solution process in a high-intensity vibration environment is carried out in the following steps:
[0054] Step 1: First, the equipment is powered on, and the geographical location information of the strapdown inertial navigation system is input into the navigation computer; the geographical location information includes latitude Lat, longitude Lon, altitude Alt, and gravity acceleration g; in view of the difficulty in obtaining local geographical information in underground and underwater environments, the numerical accuracy of latitude Lat is required to be less than 0.1 arc minute, the numerical accuracy of longitude Lon is less than 1 arc minute, and the numerical accuracy of altitude Alt is less than 300m to meet the requirements; gravity acceleration g can be measured using a dedicated interest, so its numerical accuracy must be less than 20μg;
[0055] Step 2: After the strapdown inertial navigation output is stable, the navigation computer receives sensitive information output by the three-axis gyroscope (Gx, Gy, Gz), three-axis accelerometer (Ax, Ay, Az) and odometer (DL) at a collection rate of no less than 1000 groups / second;
[0056] Step 3: Receive data with a duration of not less than 5s, and use fast Fourier transform (FFT) to calculate and process the data of Gx, Gy, Gz, Ax, Ay, Az, and DL (a total of 7 channels) respectively to obtain the amplitude spectrum and phase spectrum of each of the 7 channels of data; the result of the FFT transformation is a complex number, in which the real part and the imaginary part correspond to the amplitude and phase information respectively; the present invention uses the frequency corresponding to the maximum amplitude value as the basic main frequency, and the phase corresponding to the maximum amplitude value as the basic initial phase, so as to identify the 3-channel angular vibration basic main frequency f corresponding to Gx, Gy, and Gz Gx0 、f Gy0 、f Gz0 and the basic initial phase The three-way vibration basic main frequency f corresponding to Ax, Ay, Az Ax0 、f Ay0 、f Az0 and the basic initial phase The basic main frequency f of the position jitter corresponding to DL DL0 and the basic initial phase
[0057] Step 4: Convert the three basic main frequencies identified in step 3 above into the corresponding three basic main periods, with a total of 7 parameters, namely
[0058] If the differences between the above three types of seven basic main cycle parameters do not exceed 1%, the time node length T for subsequent data processing is determined based on the main period of the odometer position jitter, that is, T = T DL0 ;
[0059] If the difference between the three basic main periods exceeds 1%, the time node length T for subsequent data processing shall be determined based on the least common multiple of the three basic main periods;
[0060] Based on the basic main frequency of the odometer position jitter, find the first moment t0 when the phase of the basic main frequency is zero. The calculation formula of t0 is:
[0061]
[0062] When the subsequent calculations are initially aligned, time t0 is taken as the initial time, that is, the data collected after time t0 are used for calculations;
[0063] Step 5: Continue to collect data until t0+T, and use the fast Fourier transform (FFT) to identify the angular velocity constant term C contained in the three angular velocity signals. Gx0 , C Gy0 , C Gz0 , identify the linear vibration constant term C contained in the acceleration signal Ax0 , CAy0 , C Az0 ;
[0064] Calculate the modulus of the angular velocity constant term:
[0065]
[0066] Calculate the modulus of the line vibration constant term:
[0067]
[0068] Step 6: If the modulus of the three angular velocity constant terms in step 5 differs greatly from the angular velocity of the earth's rotation, or the modulus of the three linear vibration constant terms differs greatly from the local gravity acceleration value, it is considered that the data of this section does not meet the accuracy requirements of the initial alignment, and the time is extended by one period T; until t0+nT (n is a natural number greater than 1), the modulus of the angular velocity constant term and the linear vibration constant term identified by the fast Fourier transform (FFT) of the data of the nT period meets the accuracy requirements;
[0069] Step 7: When the moduli of the three angular velocity constant terms in step 6 are close to the angular velocity of the earth's rotation, and the moduli of the three linear vibration constant terms are close to the local gravity acceleration value; for example, the moduli of the angular velocity constant term can be set between 15.0±0.1° / h, and the moduli of the linear vibration constant term can be set between 1.0±0.001g.
[0070] The basic method of this embodiment is as follows:
[0071] The present invention first uses three angular velocity constant terms and three linear vibration constant terms to calculate the attitude matrix and three initial attitude angles in a rough alignment manner:
[0072]
[0073] c 21 =-c 12 c 33 +c 13 c 32
[0074] c 22 =c 11 c 33 -c 31 c 13
[0075] c 23 =-c 11 c 32 +c 31 c 12
[0076] Attitude transformation matrix from body coordinates to navigation coordinates
[0077] according to According to the relationship between the parameters in the graph, the roll angle φ, pitch angle θ and heading angle ψ in the attitude angle are obtained.
[0078] Then use the precise alignment method to solve the data in the time period from t0 to t0+nT. The specific precise alignment algorithm can use the KALAMN filtering algorithm in the classic textbook or the recursive least squares algorithm. The precise alignment solution results in the ground misalignment angle δγ, the east misalignment angle δβ and the north misalignment angle δα. The attitude angle at t0+nT is corrected as follows:
[0079] φ=φ+δα, θ=θ+δβ, ψ=ψ+δγ;
[0080] The parameters before the equal sign are the corrected parameters.
[0081] Then, using the corrected parameters, make the following conversion correction to the attitude matrix at time t0+nT:
[0082]
[0083] Then set the initial speed to 0, the latitude, longitude, altitude and gravity acceleration to the initial input values, and then the strapdown inertial navigation state is changed to the navigation state, and the entire initial alignment is completed.
[0084] The strapdown inertial navigation self-alignment method and device provided by the present invention can reduce the influence of high-intensity vibration to a minimum by identifying and utilizing the basic main period caused by vibration, thereby achieving the purpose of strapdown inertial navigation to complete self-alignment; the self-alignment method in this way has greatly enhanced environmental adaptability and has practical engineering value.
[0085] Figure 4 is a schematic diagram of the structure of the electronic device provided by the present invention, such as Figure 4 As shown, the electronic device may include: a processor 410, a communication interface 420, a memory 430 and a communication bus 440, wherein the processor 410, the communication interface 420 and the memory 430 communicate with each other through the communication bus 440. The processor 410 may call the logic instructions in the memory 430 to execute the self-alignment method of the strapdown inertial navigation.
[0086] In addition, the logic instructions in the above-mentioned memory 430 can be implemented in the form of a software functional unit and can be stored in a computer-readable storage medium when it is sold or used as an independent product. Based on such an understanding, the technical solution of the present invention is essentially or the part that contributes to the prior art or the part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium, including a number of instructions to enable a computer device (which can be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the method described in each embodiment of the present invention. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), disk or optical disk and other media that can store program codes.
[0087] On the other hand, the present invention also provides a computer program product, which includes a computer program stored on a non-transitory computer-readable storage medium, and the computer program includes program instructions. When the program instructions are executed by a computer, the computer can execute the self-alignment method of the strapdown inertial navigation provided in the above-mentioned embodiments.
[0088] On the other hand, the present invention further provides a non-transitory computer-readable storage medium having a computer program stored thereon, which is implemented when the computer program is executed by a processor to perform the self-alignment method of the strapdown inertial navigation system provided in the above embodiments.
[0089] Through the description of the above implementation methods, those skilled in the art can clearly understand that each implementation method can be implemented by means of software plus a necessary general hardware platform, and of course, it can also be implemented by hardware. Based on this understanding, the above technical solution is essentially or the part that contributes to the prior art can be embodied in the form of a software product, and the computer software product can be stored in a computer-readable storage medium, such as ROM / RAM, a disk, an optical disk, etc., including a number of instructions for a computer device (which can be a personal computer, a server, or a network device, etc.) to execute the methods described in each embodiment or some parts of the embodiments.
[0090] 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 self-alignment method for strapdown inertial navigation, characterized in that: include: According to the sensitive information of the target device, determine the initial time and time node length for self-alignment; The sensitive information includes: three-axis angular velocity information, three-axis acceleration information and position information in the direction of device movement; Sensitive information is collected with the initial moment as the data collection starting point and the time node length as the collection period. The three-axis angular velocity information and three-axis acceleration information collected in each collection period are subjected to fast Fourier transform to determine the modulus values of the three angular velocity constant terms corresponding to the three-axis angular velocity information and the modulus values of the three linear vibration constant terms corresponding to the three-axis acceleration information. When it is determined that the moduli of the three angular velocity constant terms and the moduli of the three linear vibration constant terms in the current acquisition cycle meet the preset accuracy requirements, the attitude matrix and the three initial attitude angles are calculated based on the three angular velocity constant terms and the three linear vibration constant terms in the current acquisition cycle; By using three angular velocity constant terms and three linear vibration constant terms in all acquisition cycles from the initial moment to the end of the current sampling cycle, the attitude array and the three initial attitude angles are corrected to complete the self-alignment of the strapdown inertial navigation.
2. The self-alignment method of strapdown inertial navigation according to claim 1, characterized in that: The step of determining the initial time for self-alignment according to the sensitive information of the target device includes: Perform fast Fourier transform on the position information in the direction of motion of the device to obtain the corresponding basic main frequency and basic initial phase of the position jitter; The initial time for alignment is determined according to the basic main frequency of the position jitter and the basic initial phase corresponding to the position information.
3. The self-alignment method of strapdown inertial navigation according to claim 1, characterized in that: The step of determining the time node length for self-alignment according to the sensitive information of the target device includes: Perform fast Fourier transform on the three-axis angular velocity information to obtain the basic main frequency of angular vibration corresponding to the three-axis angular velocity information; perform fast Fourier transform on the three-axis acceleration information to obtain the basic main frequency of linear vibration corresponding to the three-axis acceleration information; perform fast Fourier transform on the position information in the direction of movement of the device to obtain the basic main frequency of position jitter; Determine three corresponding basic periods according to the angular vibration basic main frequency, the linear vibration basic main frequency and the position jitter basic main frequency; The length of the time node for self-alignment is determined according to the three basic cycles.
4. The self-alignment method of strapdown inertial navigation according to claim 3, characterized in that: Determining the time node length for self-alignment according to the three basic cycles includes: When the difference between the three basic periods does not exceed a preset threshold, the basic period corresponding to the basic main frequency of the position jitter is used as the time node length; and When the difference between the three basic periods exceeds a preset threshold, the least common multiple of the three basic main periods is used as the time node length.
5. The self-alignment method of strapdown inertial navigation according to claim 2, characterized in that: According to the basic main frequency of the position jitter and the basic initial phase corresponding to the position information, the initial time for alignment is determined, specifically: Among them, t0 is the initial time, is the basic initial phase corresponding to the position information, f DL0 is the basic main frequency of position jitter, T DL0 is the basic period corresponding to the basic main frequency of position jitter.
6. The self-alignment method of strapdown inertial navigation according to claim 1, characterized in that: The modulus values of the three angular velocity constant terms meet the preset accuracy requirement specifically: the difference between the modulus values of the three angular velocity constant terms and the angular rate of rotation of the earth is within a first preset range; The moduli of the three linear vibration constant terms all meet the preset accuracy requirement, specifically: the difference between the moduli of the three linear vibration constant terms and the gravitational acceleration at the current geographical location is within a second preset range.
7. The self-alignment method of strapdown inertial navigation according to claim 1, characterized in that: The three-axis angular velocity information is obtained by using the three-axis gyroscope of the target device's strapdown inertial navigation, the three-axis acceleration information is obtained by using the three-axis accelerometer of the target device's strapdown inertial navigation, and the three-axis angular velocity information of the device's position information in the direction of motion is obtained by using the odometer set on the target device.
8. An electronic device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein: When the processor executes the computer program, the steps of the self-alignment method of strapdown inertial navigation according to any one of claims 1 to 7 are implemented.
9. A non-transitory computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the steps of the strapdown inertial navigation self-alignment method as claimed in any one of claims 1 to 7 are implemented.
10. A computer program product, comprising a computer program, characterized in that When the computer program is executed by a processor, the steps of the strapdown inertial navigation self-alignment method as claimed in any one of claims 1 to 7 are implemented.
