CN112504269B - Shaft angular speed estimation method applied to semi-strapdown stable platform - Google Patents
Shaft angular speed estimation method applied to semi-strapdown stable platform Download PDFInfo
- Publication number
- CN112504269B CN112504269B CN202011081091.8A CN202011081091A CN112504269B CN 112504269 B CN112504269 B CN 112504269B CN 202011081091 A CN202011081091 A CN 202011081091A CN 112504269 B CN112504269 B CN 112504269B
- Authority
- CN
- China
- Prior art keywords
- speed
- shaft
- angular velocity
- value
- strapdown
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 44
- 230000006641 stabilisation Effects 0.000 claims abstract description 7
- 238000011105 stabilization Methods 0.000 claims abstract description 7
- 238000004364 calculation method Methods 0.000 claims description 14
- 238000001914 filtration Methods 0.000 claims description 10
- 230000010354 integration Effects 0.000 claims description 8
- 230000001360 synchronised effect Effects 0.000 claims description 5
- 230000000007 visual effect Effects 0.000 abstract description 9
- 238000005259 measurement Methods 0.000 abstract description 8
- 230000003287 optical effect Effects 0.000 abstract description 4
- 238000005070 sampling Methods 0.000 abstract description 3
- 230000005764 inhibitory process Effects 0.000 abstract description 2
- 230000004927 fusion Effects 0.000 abstract 1
- 230000000694 effects Effects 0.000 description 4
- 230000004044 response Effects 0.000 description 4
- 230000007423 decrease Effects 0.000 description 3
- 230000007547 defect Effects 0.000 description 2
- 230000004069 differentiation Effects 0.000 description 2
- 230000003321 amplification Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000003199 nucleic acid amplification method Methods 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; 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/16—Navigation; 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/165—Navigation; 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Gyroscopes (AREA)
Abstract
The invention relates to a shaft angular velocity estimation method applied to a semi-strapdown stable platform, which is used for obtaining the shaft angular velocity with high data update rate, independent channels and high algorithm convergence rate by parallel high-speed sampling of each frame angle of the stable platform on an FPGA and realizing a tracking differential algorithm by adopting hardware language for the small stable platform which is difficult to install an inertial measurement sensor on a universal joint load. The visual axis inertial angular velocity is obtained through fusion and reconstruction of the axis angular estimated velocity and the base inertial angular velocity, and the visual axis inertial angular velocity is used as feedback information to realize the inertial stabilization of the visual axis. The sampling interval, the convergence factor and the output noise of the shaft angle estimation algorithm are optimized, so that the shaft angle estimation speed matched with the frequency and the time delay of the output signal of the inertia measurement element is obtained, the inhibition capability of the stabilized platform to the disturbance of the base is enhanced, and the pointing accuracy of the optical axis is improved.
Description
Technical Field
The invention relates to a shaft angular velocity estimation method applied to a semi-strapdown stable platform, and belongs to the technical field of photoelectric detection.
Background
The main task of the airborne photoelectric stabilized platform is to isolate disturbance of a carrier base and ensure stable pointing of an optical axis in an inertial space. However, in a miniaturized photoelectric stabilization platform, the space is compact, the load on the universal joint is light, and it is difficult to install an inertial measurement element with higher accuracy to directly measure the angular velocity of the viewing axis. Because of the limitation of the size and weight of the load, the miniaturized stabilized platform is difficult to install an inertial measurement element with enough precision on a frame, and the measurement of the visual axis inertial angular velocity cannot be directly realized, so that the inertial measurement element needs to be installed on a base except a universal joint, and the semi-strapdown stabilized platform is formed by combining the base inertial angular velocity with the frame angular velocity information, performing coordinate conversion, and then reconstructing to obtain the visual axis inertial angular velocity. Therefore, the shaft angular velocity sensor cannot be mounted due to the size limitation of the universal joint, and only the angular velocity can be estimated from the shaft angular position. The level of shaft angular velocity estimation directly affects the stability performance of the stabilized platform's visual axis. The key to semi-strapdown stabilization is the frequency response and accuracy of the shaft angular velocity. The photoelectric stable platform is used for realizing the indication and tracking of the maneuvering target, the speed range is wide, and the shaft angular speed obtained through the traditional position difference is difficult to meet the requirements on both precision and frequency response. Therefore, the shaft angular velocity must be estimated effectively to meet the requirements of frequency response and precision of velocity information in a larger range, key information is provided for reconstructing the visual shaft angular velocity of the semi-strapdown stable platform, and the control performance of the stable platform is improved.
Disclosure of Invention
Technical problem to be solved
In order to solve the defect that the shaft angular speed obtained by the traditional position difference is difficult to meet the requirements on both precision and frequency response, the invention provides a shaft angular speed estimation method applied to a half strapdown stable platform. Based on the existing stabilized platform shaft angle sensor, the shaft angle speed is estimated by a tracking differential algorithm.
Technical proposal
The shaft angular speed estimation method applied to the semi-strapdown stable platform is characterized by comprising the following steps of:
step 1: determining the execution frequency, the data bit width and the integration step length;
step 2: determining parameters of a tracking differentiator: a speed factor r;
step 3: the nonlinear differential tracking method is executed as follows:
3-1: initializing nonlinear tracking differentiator parameters: tracking position x 1 (k) Estimated speed x 2 (k) Intermediate variables e (k), d 0 、y、a 0 All initialized to 0;
3-2: judging whether an execution starting signal is received, if yes, sending a synchronous clock signal, reading an encoder position value in a register, converting the encoder position value into a single-precision floating point type, and entering a step 3-3, and if not, continuing to execute the step 3-2;
3-3: sequentially calculating variables e (k), d in formula (1) 0 、y、a 0 Values and stored in registers;
wherein h is 0 Is a filtering factor;
3-4: calculating the value of variable a: judging whether |y| is greater than d 0 If yes, executing the calculation of the formula (2), otherwise, executing the calculation of the formula (3);
3-5: calculating the value of the variable fhan: judging whether the absolute value a is larger than d, if so, executing the calculation of the formula (4), otherwise, executing the calculation of the formula (5);
fhan=-r·sign(a) (4)
3-6: calculating tracking position x 1 (k+1), estimated speed x 2 (k+1) value:
3-7: the calculated tracking position signal x 1 (k+1) and the estimated speed signal x 2 (k+1) converting into integer data and storing the integer data into a corresponding register;
3-8: the cycle is performed 3-2 to 3-7.
The technical scheme of the invention is as follows: the determination method of the step 1 is as follows: the execution frequency is less than or equal to the data reading frequency of the encoder and less than or equal to the updating frequency of the encoder; the data bit width is more than or equal to the data bit width of the shaft encoder; the integration step h is initially set to the execution period.
The technical scheme of the invention is as follows: the initial value of the speed factor r in step 2 is chosen to be any value greater than 0 and less than 1/(2 h), wherein is the integration step size.
The technical scheme of the invention is as follows: filtering factor h in step 3-3 0 Set to the integral step value.
The technical scheme of the invention is as follows: the method described in step 3 operates in parallel in the FPGA.
A method for performance adjustment of shaft angular velocity is characterized in that: executing an axle angular speed estimation method, collecting an estimated speed signal, and comparing and checking with data collected by a standard speed estimation device; if the phase lag is found to be too large, the speed factor is increased; if the speed measuring noise is found to be too large, increasing a filtering factor; until the requirements are met.
The technical scheme of the invention is as follows: the standard speed estimation device is a gyroscope and a velocimeter.
Advantageous effects
The invention provides a shaft angular velocity estimation method applied to a semi-strapdown stable platform. The method introduces a tracking differentiator technology into the shaft angular speed estimation, replaces differentiation by an integral method, overcomes the defect of noise amplification caused by the traditional angular position differentiation, and can reasonably extract differential signals from discrete signals with random noise. An angular position signal is input to the tracking differentiator, an angular position tracking signal and an angular speed estimation signal are output, and an algorithm implementation mode is a key of whether the angular speed estimation effect is excellent. By means of flexible interfaces, powerful parallel operation and high-precision counting capability of the FPGA, the parallel high-speed sampling of each frame angle of the stable platform on the FPGA and the synchronous output of the shaft angle estimation speed by using a hardware description language, the shaft angle speed estimation method with high data update rate, independent channels and high algorithm convergence speed is obtained, high-quality feedback information is provided for the semi-strapdown stable platform, the accuracy of optical axis pointing is improved, and the method has wide application prospect.
Drawings
FIG. 1A flow chart of the invention
Detailed Description
The shaft angular velocity estimation method applied to the semi-strapdown stable platform is designed to realize high-speed parallel acquisition of shaft angular positions, realize tracking differential algorithm by hardware description language and synchronously output shaft angular velocity estimation rate by virtue of flexible interfaces, powerful parallel operation and timing functions of the FPGA, so that the shaft angular velocity with high data update rate, independent channels and high algorithm convergence rate is obtained. The shaft angular speed obtained by the method has higher precision in a wider range, provides high-quality feedback information for the semi-strapdown stable platform, enhances the anti-interference capability of the stable platform, and improves the accuracy of optical axis pointing. Mainly involves two aspects:
1. shaft angular velocity estimation algorithm. The method mainly comprises the following steps:
the first step, determining the execution frequency, the data width and the integral step length of an axle angle estimation algorithm, wherein the determining method comprises the following steps: the execution frequency of the shaft angle estimation algorithm is less than or equal to the data reading frequency of the encoder and less than or equal to the updating frequency of the encoder; the algorithm data bit width is more than or equal to the data bit width of the shaft encoder; the integration step h is initialized to be set as an algorithm execution period (in s).
Second, the parameters of the tracking differentiator are preliminarily determined: a speed factor r, the initial value of which is chosen to be any value greater than 0 and less than 1/(2 h), wherein the speed factor r is the integral step length and the filter factor h 0 Set to the integral step value.
Third, a nonlinear differential tracking algorithm is executed, see fig. 1, specifically as follows:
1) Initializing nonlinear tracking differentiator parameters. Tracking position x 1 (k) Estimated speed x 2 (k) Intermediate variables e (k), d 0 、y、a 0 All initialized to 0;
2) Judging whether an algorithm start executing signal is received, if yes, sending a synchronous clock signal, reading an encoder position value in a register, converting the encoder position value into a single-precision floating point type, and entering the step 3), and if not, continuing to execute the step 2);
3) Sequential calculation formula(1) And stores variables e (k), d in registers 0 、y、a 0 A value;
4) The value of variable a is calculated. Judging whether |y| is greater than d 0 If yes, executing the calculation of the formula (2), otherwise, executing the calculation of the formula (3);
5) The value of the variable fhan is calculated. Judging whether the absolute value a is larger than d, if so, executing the calculation of the formula (4), otherwise
Performing the calculation of equation (5);
fhan=-r·sign(a) (4)
6) Calculating tracking position x 1 (k+1), estimated speed x 2 (k+1) value.
7) The calculated tracking position signal x 1 (k+1) and the estimated speed signal x 2 (k+1) converting into integer data and storing the integer data into a corresponding register;
8) Periodically executing the steps 2) to 7).
2. A shaft angular velocity estimation method performance debugging method. The method for debugging the performance of the shaft angular velocity estimation method is also one of the contents of the invention. The periodic cycle execution of the shaft angular velocity estimation algorithm will be estimatedAngular velocity is measured. Changing the speed factor r and the filtering factor h in the second step 0 The initial value can change the estimation effect of the shaft angular speed estimation method, gradually adjust the speed factor and the filter factor, and realize the speed estimation performance with different effects. The speed factor and filtering factor parameter debugging method comprises the following steps: increasing the speed factor r increases the speed estimation bandwidth, increases the estimation noise, decreases the speed factor r, decreases the estimation noise, but decreases the speed estimation bandwidth. Increasing the filtering factor h 0 The speed estimation noise may be reduced but the estimation bandwidth may also be reduced.
In order to make the technical scheme and the advantages of the invention clearer, an axial angular velocity estimation method applied to a half strapdown stable platform is illustrated by an example aiming at an encoder with 2 paths of data, the maximum refresh frequency of which is 5 KHz and the data bit width of which is 16 bits. The detailed steps are as follows:
1. shaft angular velocity estimation algorithm. The method mainly comprises the following steps:
the method comprises the steps that firstly, the maximum data refresh rate of an encoder is 5k Hz, the data bit width is 16 bits, the data reading frequency of the encoder is smaller than or equal to the data updating frequency of the encoder according to the frequency smaller than or equal to the encoder updating frequency method executed by an axis angle estimation algorithm, the data reading frequency of the encoder is 4k Hz, and the frequency executed by the axis angle estimation algorithm is 2k Hz; according to the data bit width method that the algorithm data bit width is more than or equal to the shaft encoder, the data bit width in the FPGA estimation algorithm is selected to be 32 bits, and the integration step h is initialized and set to be 0.0005s of the algorithm execution period.
Step two, the initial value of the speed factor is selected to be 500, and the filtering factor h 0 Set to an integral step value of 0.0005.
And thirdly, executing a nonlinear differential tracking algorithm, which specifically comprises the following steps:
1) Initializing nonlinear tracking differentiator parameters. Tracking position x 1 (k) Estimated speed x 2 (k) Intermediate variables e (k), d 0 、y、a 0 All initialized to 0;
2) Judging whether an algorithm start executing signal is received, if yes, sending a synchronous clock signal, reading an encoder position value in a register, converting the encoder position value into a single-precision floating point type, and entering the step 3), and if not, continuing to execute the step 2);
3) The variables e (k), d and d are calculated in the sequential calculation formula (1) and stored in registers 0 、y、a 0 A value;
4) Calculating the value of the variable a, and judging whether the value of the absolute value y is larger than d 0 If yes, executing a formula (2), otherwise executing a formula (3);
5) Judging whether the absolute a is larger than d, if so, executing the formula (4), otherwise, executing the formula (5);
6) Calculating the tracking position x according to formula (6) 1 (k+1), estimated speed x 2 (k+1) value.
7) The calculated position signal x 1 (k+1) and the estimated speed signal x 2 (k+1) converting into integer data and storing the integer data into a corresponding register;
8) The steps 2) to 7) are cyclically executed.
2. And (5) debugging the performance of the shaft angular speed estimation method. The specific debugging steps are as follows:
1) Executing an axle angular speed estimation algorithm, acquiring an estimated speed signal, and comparing and checking with data acquired by a standard speed estimation device (such as a gyroscope, a velocimeter and the like);
2) If the phase lag is found to be too large, increasing the speed factor r in the second step to be 1000 according to the requirement;
3) Re-executing the step 1), collecting speed data, comparing the speed measurement noise with the standard speed estimation device to increase the filter factor to 0.0008;
4) Re-executing the step 1), collecting speed data, comparing the speed data with a standard speed estimation device, and finding that the speed data meets the requirement;
5) And (5) debugging the speed estimation algorithm.
The tracking differential algorithm is realized through FPGA parallel operation, the speed is high, the updating frequency is high, and the convergence speed and noise of the tracking differential algorithm can be flexibly adjusted. The estimated shaft angle speed realized by the FPGA is equivalent to the bandwidth and delay of the inertial measurement unit, and can be effectively information fused, so that the visual shaft angle speed of the stabilized platform is obtained by reconstruction, the disturbance inhibition capability of the photoelectric stabilized platform is enhanced, the visual shaft pointing accuracy is improved, and the method has wide application prospect.
Claims (7)
1. The shaft angular speed estimation method applied to the semi-strapdown stable platform is characterized by comprising the following steps of:
step 1: determining the execution frequency, the data bit width and the integration step length;
step 2: determining parameters of a tracking differentiator: a speed factor r;
step 3: the nonlinear differential tracking method is executed as follows:
3-1: initializing nonlinear tracking differentiator parameters: tracking position x 1 (k) Estimated speed x 2 (k) Intermediate variables e (k), d 0 、y、a 0 All initialized to 0;
3-2: judging whether an execution starting signal is received, if yes, sending a synchronous clock signal, reading an encoder position value in a register, converting the encoder position value into a single-precision floating point type, and entering a step 3-3, and if not, continuing to execute the step 3-2;
3-3: sequentially calculating variables e (k), d in formula (1) 0 、y、a 0 Values and stored in registers;
wherein h is 0 Is a filtering factor;
3-4: calculating the value of variable a: judging whether |y| is greater than d 0 If yes, executing the calculation of the formula (2), otherwise, executing the calculation of the formula (3);
3-5: calculating the value of the variable fhan: judging whether the absolute value a is larger than d, if so, executing the calculation of the formula (4), otherwise, executing the calculation of the formula (5);
fhan=-r·sign(a) (4)
3-6: calculating tracking position x 1 (k+1), estimated speed x 2 (k+1) value:
x 1 (k+1)=x 1 (k)+h·x 2 (k)
x 2 (k+1)=x 2 (k)+h·fhan(e(k),x 2 (k),r,h 0 ) (6)
3-7: the calculated tracking position signal x 1 (k+1) and the estimated speed signal x 2 (k+1) converting into integer data and storing the integer data into a corresponding register;
3-8: the cycle is performed 3-2 to 3-7.
2. The method for estimating the shaft angular velocity applied to the semi-strapdown stabilization platform according to claim 1, wherein the determining method in the step 1 is as follows: the execution frequency is less than or equal to the data reading frequency of the encoder and less than or equal to the updating frequency of the encoder; the data bit width is more than or equal to the data bit width of the shaft encoder; the integration step h is initially set to the execution period.
3. The method for estimating the angular velocity of the shaft applied to the semi-strapdown stabilization platform according to claim 1, wherein the initial value of the velocity factor r in the step 2 is selected to be any value greater than 0 and less than 1/(2 h), where h is an integration step size.
4. The method for estimating the axial angular velocity applied to the semi-strapdown stabilization platform according to claim 1, wherein the filtering factor h in the step 3-3 0 Set to the integral step value.
5. The method for estimating the angular velocity of the shaft applied to the semi-strapdown stabilization platform according to claim 1, wherein the method in the step 3 is operated in parallel in the FPGA.
6. A method of performance tuning of the angular shaft speed obtained in claim 1, characterized by: executing an axle angular speed estimation method, collecting an estimated speed signal, and comparing and checking with data collected by a standard speed estimation device; if the phase lag is found to be too large, the speed factor is increased; if the speed measuring noise is found to be too large, increasing a filtering factor; until the requirements are met.
7. The method for performing performance tuning of angular velocity of shaft of claim 6, wherein said standard velocity estimation device is a gyroscope or a velocimeter.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011081091.8A CN112504269B (en) | 2020-10-11 | 2020-10-11 | Shaft angular speed estimation method applied to semi-strapdown stable platform |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011081091.8A CN112504269B (en) | 2020-10-11 | 2020-10-11 | Shaft angular speed estimation method applied to semi-strapdown stable platform |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112504269A CN112504269A (en) | 2021-03-16 |
CN112504269B true CN112504269B (en) | 2023-12-22 |
Family
ID=74953996
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011081091.8A Active CN112504269B (en) | 2020-10-11 | 2020-10-11 | Shaft angular speed estimation method applied to semi-strapdown stable platform |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112504269B (en) |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102679979A (en) * | 2012-05-18 | 2012-09-19 | 北京航空航天大学 | Method for monitoring working mode of aerial remote sensing triaxial inertia stabilization platform |
CN110658839A (en) * | 2019-10-08 | 2020-01-07 | 西北工业大学 | Virtual optical axis-based strapdown seeker guidance information extraction method |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8825435B2 (en) * | 2010-02-19 | 2014-09-02 | Itrack, Llc | Intertial tracking system with provision for position correction |
CN109341679A (en) * | 2018-09-30 | 2019-02-15 | 华中科技大学 | A kind of smart machine air navigation aid and navigation system |
-
2020
- 2020-10-11 CN CN202011081091.8A patent/CN112504269B/en active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102679979A (en) * | 2012-05-18 | 2012-09-19 | 北京航空航天大学 | Method for monitoring working mode of aerial remote sensing triaxial inertia stabilization platform |
CN110658839A (en) * | 2019-10-08 | 2020-01-07 | 西北工业大学 | Virtual optical axis-based strapdown seeker guidance information extraction method |
Non-Patent Citations (1)
Title |
---|
跟踪微分算法在半捷联稳定平台中的应用研究;刘伟;朱斌;樊键;尹彦东;;弹箭与制导学报(第02期);41-44 * |
Also Published As
Publication number | Publication date |
---|---|
CN112504269A (en) | 2021-03-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110706279B (en) | Global position and pose estimation method based on information fusion of global map and multiple sensors | |
CN106679649B (en) | Hand motion tracking system and method | |
CN103674023B (en) | Method for dynamically measuring attitude of star sensor based on top accurate angle relevance | |
US9423272B2 (en) | Estimation of conventional inertial sensor errors with atomic inertial sensor | |
CN100368774C (en) | Engineering implementation method for quick starting inertial measurement unit of optical fiber gyroscope and guaranteeing precision | |
CN103714546B (en) | A kind of data processing method of imaging spectrometer | |
CN110017836B (en) | Accelerometer digital sampling sliding window filtering cross-clock domain synchronous data transmission method | |
CN113311411A (en) | Laser radar point cloud motion distortion correction method for mobile robot | |
CN106482747B (en) | A kind of zero bias temperature compensation method of high accuracy gyroscope instrument | |
CN101105126A (en) | Logging-while-drilling orientation measurement error compensation method based on micro-quartz angular rate sensor | |
CN105737793B (en) | Rolling angle measurement unit and measuring method | |
CN104142624B (en) | Time synchronization method and system based on waveform matching | |
CN112504269B (en) | Shaft angular speed estimation method applied to semi-strapdown stable platform | |
WO2012122713A1 (en) | Sagnac phase shift tracing method for fiber optic gyroscopes | |
CN111578939B (en) | Robot tight combination navigation method and system considering random variation of sampling period | |
JP2014160027A (en) | Synthetic opening radar device | |
WO2019205847A1 (en) | Displacement measuring system for sensor device and displacement measuring method | |
CN116929335A (en) | Radiation field map construction method based on multisource information perception | |
CN103591960A (en) | Rotating modulation based coarse alignment method of static base inertial navigation system | |
CN110160530A (en) | A kind of spacecraft attitude filtering method based on quaternary number | |
CN110440779B (en) | Force balance control method for high-dynamic MEMS resonant gyroscope | |
CN109798885A (en) | A kind of Data Fusion of Sensor Optimal Design Method based on closed loop fusion | |
Tan et al. | A low-complexity sensor fusion algorithm based on a fiber-optic gyroscope aided camera pose estimation system | |
Pan et al. | A federated filtering personal navigation algorithm based on MEMS-INS/GPS integrated | |
CN111307176B (en) | Online calibration method for visual inertial odometer in VR head-mounted display equipment |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |