CN108680184B - Zero-speed detection method based on generalized likelihood ratio statistical curve geometric transformation - Google Patents
Zero-speed detection method based on generalized likelihood ratio statistical curve geometric transformation Download PDFInfo
- Publication number
- CN108680184B CN108680184B CN201810353728.0A CN201810353728A CN108680184B CN 108680184 B CN108680184 B CN 108680184B CN 201810353728 A CN201810353728 A CN 201810353728A CN 108680184 B CN108680184 B CN 108680184B
- Authority
- CN
- China
- Prior art keywords
- zero
- likelihood ratio
- generalized likelihood
- ratio statistical
- speed
- 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
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, 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
-
- 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)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
The invention discloses a zero-speed detection method based on generalized likelihood ratio statistical curve geometric transformation, which comprises the following steps: s1: constructing a generalized likelihood ratio statistical curve by utilizing measured values output by a gyroscope and an accelerometer which are integrated in an inertial measurement unit; s2: calculating a possible zero-speed interval by a signal translation method; s3: carrying out geometric transformation on the generalized likelihood ratio statistical curve; s4: eliminating a pseudo-zero speed interval through a difference value between generalized likelihood ratio statistical curves after geometric transformation; s5: and eliminating non-zero-velocity edge points in a zero-velocity interval through the symmetrical relation between the generalized likelihood ratio statistical curves after geometric transformation. The method has the advantages of simple model, universality and low computational complexity.
Description
Technical Field
The invention relates to the field of navigation algorithms, in particular to a zero-speed detection method based on generalized likelihood ratio statistical curve geometric transformation.
Background
The pedestrian inertial navigation system based on the integral working mode has the characteristic of error accumulation, the error accumulation is particularly rapid for low-precision MEMS-SINS, and the inhibition of the increase of the system error is the basis of the work of the pedestrian inertial navigation system. Zero velocity update (zero velocity update ZUPT) is an effective method for improving the pedestrian navigation positioning accuracy under the MEMS-SINS independent working condition. Zero-speed detection is the premise of zero-speed correction, missing detection can reduce correction frequency, false detection can bring wrong correction, and both can reduce pedestrian navigation positioning accuracy. Currently, the commonly used zero-speed detection methods are mainly classified into two types, namely threshold judgment-based detection methods and machine learning-based detection methods.
However, due to pedestrian population difference, gait difference, low signal-to-noise ratio of the low-precision MEMS-IMU and the like, the zero-speed detection method based on threshold judgment has the problems of poor adaptability to different motion states, different individuals and the like. The artificial intelligence technology excessively depends on the universality of training data and the generalization capability of a training model, so that the artificial intelligence technology has the defects of complex algorithm and difficult training, and is limited in practical use.
Disclosure of Invention
The purpose of the invention is as follows: the invention aims to provide a zero-speed detection method with low calculation complexity based on generalized likelihood ratio statistical curve geometric transformation.
The technical scheme is as follows: in order to achieve the purpose, the invention adopts the following technical scheme:
the invention discloses a zero-speed detection method based on generalized likelihood ratio statistical curve geometric transformation, which comprises the following steps:
s1: constructing a generalized likelihood ratio statistical curve by utilizing measured values output by a gyroscope and an accelerometer which are integrated in an inertial measurement unit;
s2: calculating a possible zero-speed interval by a signal translation method;
s3: carrying out geometric transformation on the generalized likelihood ratio statistical curve;
s4: eliminating a pseudo-zero speed interval through a difference value between generalized likelihood ratio statistical curves after geometric transformation;
s5: and eliminating non-zero-velocity edge points in a zero-velocity interval through the symmetrical relation between the generalized likelihood ratio statistical curves after geometric transformation.
Further, the step S1 is realized by the following process:
the measured value output by the inertia measuring unit is set as follows:
in the formula3-dimensional accelerometer output for IMU at time kThe data is measured and the data is transmitted,3-dimensional measurement data of the gyroscope output by the IMU at the moment k;
a generalized likelihood ratio statistical curve t (n) is obtained by equation (2):
in the formula of omeganA window of time series is measured for the IMU,is the observed noise variance of the accelerometer,is the observed noise variance of the gyroscope,is at the window omeganAverage of the internal accelerometer data, N represents the window length, and g is the gravitational acceleration.
Further, the step S2 is realized by the following process:
s2.1: carrying out translation transformation on the generalized likelihood ratio statistical curve T (n) by the formula (3) to obtain the generalized likelihood ratio statistical curve T after the translation transformationmov_u(n):
Tmov_u(n)=T(n-m)+ΔY (3)
In the formula, m is the number of right-shift sampling points, and delta Y is an upward shift value;
s2.2: Δ Y is determined by the following method:
using a size of N1The window intercepts the current time TcTo the previous moment Tc-N1The interval is increased from 0 by a sliding threshold Th until Th is equal to DeltaY, and all the intervals of Th-T (N) > 0 are N2,N1And N2Satisfies the following formula:
N2/N1=35% (4)
s2.3: the interval satisfying the following formula is a possible zero velocity interval:
Tmov_u(n)>T(n) (5)
further, in step S3, the generalized likelihood ratio statistical curve is geometrically transformed by equation (6):
Trev_u(n)=-T(n)+ΔY (6)
in the formula Trev_u(n) is a generalized likelihood ratio statistical curve after geometric transformation, T (n) is a generalized likelihood ratio statistical curve, and Δ Y is an up-shift magnitude value.
Further, in step S4, the zero-velocity section and the non-zero-velocity section are determined by equation (7), so as to eliminate the pseudo-zero-velocity section:
in the formula, L is a generalized likelihood ratio statistical curve T after geometric transformationrev_uAbsolute value of difference between (n) and generalized likelihood ratio statistical curve T (n), L1For statistical curves T of generalized likelihood ratios after geometric transformationrev_u(n) and generalized likelihood ratio statistical curve T after translation transformationmov_u(n) the absolute value of the difference between; zero _ flag is a zero-speed zone bit, when the zero _ flag is 1, the zero-speed is represented, and when the zero _ flag is 0, the non-zero-speed is represented; L-L1Obtained according to formula (8);
L-L1=-4T(n)+ΔY-Km| (8)
in the formula, delta Y is an upward shift value, m is the number of right shift sampling points, and K is a slope value of a curve.
Further, in step S5, the non-zero velocity edge points are removed by equation (9):
in the formula, zero _ flag is a zero-speed zone bit, when the zero _ flag is 1, the zero-speed is represented, and when the zero _ flag is 0, the non-zero speed is represented; l is after geometric transformationGeneralized likelihood ratio statistical curve Trev_u(n) the absolute value of the difference between the generalized likelihood ratio statistical curve T (n), as shown in formula (10); lambda is more than or equal to 0.9 and less than or equal to 0.95; Δ Y is the magnitude of the upshifting;
L=|Trev_u(n)-T(n)|=|(-T(n)+ΔY)-(T(n))|=|-2T(n)+ΔY| (10)。
has the advantages that: the invention discloses a zero-speed detection method based on generalized likelihood ratio statistical curve geometric transformation, which has the following beneficial effects compared with the prior art:
1) compared with a threshold method, the zero-speed detection does not pass threshold judgment, and has better adaptation effect on different pedestrians and gaits;
2) compared with a machine learning algorithm, the zero-speed detection method is simple in model, universal and low in calculation complexity.
Drawings
FIG. 1 is a graph of measured data detected by an accelerometer according to an embodiment of the invention;
FIG. 2 is a graph of measured data detected by a gyroscope according to an embodiment of the present invention;
FIG. 3 is a diagram illustrating a generalized likelihood ratio statistical curve geometry transformation according to an embodiment of the present invention;
FIG. 4 is a diagram of the zero-speed test result of the test subject A according to the embodiment of the present invention;
FIG. 5 is a diagram illustrating the zero-speed test result of the second laboratory test;
FIG. 6 is a zero-speed test result chart of the experimenter C in the embodiment of the invention.
Detailed Description
The technical solution of the present invention will be further described with reference to the following embodiments.
The specific embodiment aims at a zero-speed correction algorithm in a foot-bound inertial pedestrian navigation system, performs zero-speed detection analysis, constructs a generalized likelihood ratio statistical curve by using measurement values of a gyroscope and an accelerometer, obtains a possible zero-speed interval by using translation of the generalized likelihood ratio statistical curve, performs geometric transformation (translation and turnover transformation) on the generalized likelihood ratio statistical curve again, eliminates the pseudo-zero-speed interval by using the absolute value magnitude relation of a difference value between the generalized likelihood ratio curves after the geometric transformation, and determines the zero-speed interval.
The specific embodiment discloses a zero-speed detection method based on generalized likelihood ratio statistical curve geometric transformation, which comprises the following steps:
s1: constructing a generalized likelihood ratio statistical curve by utilizing measured values output by a gyroscope and an accelerometer which are integrated in an inertial measurement unit; fig. 1 and fig. 2 are measured data detected by an accelerometer and a gyroscope, respectively, and a generalized likelihood ratio statistical curve t (n) is constructed by using the measured data of the accelerometer and the gyroscope, as shown in fig. 3;
s2: calculating a possible zero-speed interval by a signal translation method;
s3: carrying out geometric transformation on the generalized likelihood ratio statistical curve;
s4: eliminating a pseudo-zero speed interval through a difference value between generalized likelihood ratio statistical curves after geometric transformation;
s5: and eliminating non-zero-velocity edge points in a zero-velocity interval through the symmetrical relation between the generalized likelihood ratio statistical curves after geometric transformation.
Step S1 is realized by the following procedure:
the measured value output by the inertia measuring unit is set as follows:
in the formulaFor the 3-dimensional measurement data of the accelerometer output by the IMU at time k,3-dimensional measurement data of the gyroscope output by the IMU at the moment k;
a generalized likelihood ratio statistical curve t (n) is obtained by equation (2):
in the formula of omeganA window of time series is measured for the IMU,is the observed noise variance of the accelerometer,is the observed noise variance of the gyroscope,is at the window omeganAverage of the internal accelerometer data, N represents the window length, and g is the gravitational acceleration.
Step S2 is realized by the following procedure:
s2.1: carrying out translation transformation on the generalized likelihood ratio statistical curve T (n) by the formula (3) to obtain the generalized likelihood ratio statistical curve T after the translation transformationmov_u(n):
Tmov_u(n)=T(n-m)+ΔY (3)
In the formula, m is the number of right-shift sampling points, and delta Y is an upward shift value;
s2.2: Δ Y is determined by the following method:
using a size of N1The window intercepts the current time TcTo the previous moment Tc-N1The interval is increased from 0 by a sliding threshold Th until Th is equal to DeltaY, and all the intervals of Th-T (N) > 0 are N2N1 and N2 satisfy the following formula:
N2/N1=35% (4)
s2.3: the interval satisfying the following formula is a possible zero velocity interval:
Tmov_u(n)>T(n) (5)
in step S3, the generalized likelihood ratio statistical curve is geometrically transformed by equation (6):
Trev_u(n)=-T(n)+ΔY (6)
in the formula Trev_u(n) is a generalized likelihood ratio statistical curve after geometric transformation, T (n) is a generalized likelihood ratio statistical curve, and Δ Y is an up-shift magnitude value.
In step S4, the zero-velocity section and the non-zero-velocity section are determined by equation (7), so as to eliminate the pseudo-zero-velocity section:
in the formula, L is a generalized likelihood ratio statistical curve T after geometric transformationrev_uAbsolute value of difference between (n) and generalized likelihood ratio statistical curve T (n), L1For statistical curves T of generalized likelihood ratios after geometric transformationrev_u(n) and generalized likelihood ratio statistical curve T after translation transformationmov_u(n) the absolute value of the difference between; zero _ flag is a zero-speed zone bit, when the zero _ flag is 1, the zero-speed is represented, and when the zero _ flag is 0, the non-zero-speed is represented; L-L1Obtained according to formula (8);
L-L1=-4T(n)+ΔY-Km| (8)
in the formula, delta Y is an upward shift value, m is the number of right shift sampling points, and K is a slope value of a curve.
In step S5, the non-zero velocity edge points are removed by equation (9):
in the formula, zero _ flag is a zero-speed zone bit, when the zero _ flag is 1, the zero-speed is represented, and when the zero _ flag is 0, the non-zero speed is represented; l is a generalized likelihood ratio statistical curve T after geometric transformationrev_u(n) the absolute value of the difference between the generalized likelihood ratio statistical curve T (n), as shown in formula (10); lambda is more than or equal to 0.9 and less than or equal to 0.95; Δ Y is the magnitude of the upshifting;
L=|Trev_u(n)-T(n)|=|(-T(n)+ΔY)-(T(n))|=|-2T(n)+ΔY| (10)。
the beneficial effects of the embodiment are verified by the following measured data: the experimental route is a straight line 100m, three experimenters, namely, the experimenters A (male), B (female) and C (male), each of the experimenters walks three groups of experiments at a slow speed, a normal pace and a fast speed, the actual speed participation experimental results are shown in the following table 1, the detection results of 10s to 35s are shown in figures 4, 5 and 6, the three experimenters A, B and C respectively correspond to the three experimenters A, B and C, the zero speed is represented when the logic value is 1, and the non-zero speed is represented when the logic value is 0.
Table 1: different experimenters different speed experimental data
Generalized likelihood ratio test correlation parameter sigmaaSet to 0.01, σωSet to 0.1 pi/180, window length N is set to 3; for the value of the translation value m, the value of m is 0.08s in the experiment; the value of omega is 5 s; λ in formula (11) is set to 0.9.
Claims (1)
1. A zero-speed detection method based on generalized likelihood ratio statistical curve geometric transformation is characterized in that: the method comprises the following steps:
s1: the generalized likelihood ratio statistical curve is constructed by utilizing the measured values output by the gyroscope and the accelerometer which are integrated in the inertial measurement unit, and the generalized likelihood ratio statistical curve is specifically as follows:
the measured value output by the inertia measuring unit is set as follows:
in the formulaFor the 3-dimensional measurement data of the accelerometer output by the IMU at time k,3-dimensional measurement data of the gyroscope output by the IMU at the moment k;
a generalized likelihood ratio statistical curve t (n) is obtained by equation (2):
in the formula of omeganA window of time series is measured for the IMU,is the observed noise variance of the accelerometer,is the observed noise variance of the gyroscope,is at the window omeganAverage of the internal accelerometer data, N represents the window length, g is the acceleration of gravity;
s2: the possible zero-velocity interval is obtained by a signal translation method, which specifically comprises the following steps:
s2.1: carrying out translation transformation on the generalized likelihood ratio statistical curve T (n) by the formula (3) to obtain the generalized likelihood ratio statistical curve T after the translation transformationmov_u(n):
Tmov_u(n)=T(n-m)+ΔY (3)
In the formula, m is the number of right-shift sampling points, and delta Y is an upward shift value;
s2.2: Δ Y is determined by the following method:
using a size of N1The window intercepts the current time TcTo the previous moment Tc-N1The interval is increased from 0 by a sliding threshold Th until Th is equal to DeltaY, and all the intervals of Th-T (N) > 0 are N2,N1And N2Satisfies the following formula:
N2/N1=35% (4)
s2.3: the interval satisfying the following formula is a possible zero velocity interval:
Tmov_u(n)>T(n) (5);
s3: performing geometric transformation on the generalized likelihood ratio statistical curve, specifically as follows:
the generalized likelihood ratio statistical curve is geometrically transformed by equation (6):
Trev_u(n)=-T(n)+ΔY (6)
in the formula Trev_u(n) is a generalized likelihood ratio statistical curve after geometric transformation, T (n) is a generalized likelihood ratio statistical curve, and delta Y is an up-shift value;
s4: eliminating a pseudo-zero speed interval through a difference value between generalized likelihood ratio statistical curves after geometric transformation, which is specifically as follows:
judging a zero-speed interval and a non-zero-speed interval by the formula (7) so as to eliminate a pseudo zero-speed interval:
in the formula, L is a generalized likelihood ratio statistical curve T after geometric transformationrev_uAbsolute value of difference between (n) and generalized likelihood ratio statistical curve T (n), L1For statistical curves T of generalized likelihood ratios after geometric transformationrev_u(n) and generalized likelihood ratio statistical curve T after translation transformationmov_u(n) the absolute value of the difference between; zero _ flag is a zero-speed zone bit, when the zero _ flag is 1, the zero-speed is represented, and when the zero _ flag is 0, the non-zero-speed is represented; L-L1Obtained according to formula (8);
L-L1=-4T(n)+ΔY-|Km| (8)
in the formula, delta Y is an upward shift value, m is the number of right shift sampling points, and K is a slope value of a curve;
s5: and eliminating non-zero-velocity edge points in a zero-velocity interval through a symmetrical relation between generalized likelihood ratio statistical curves after geometric transformation, which is specifically as follows:
removing non-zero-speed edge points by the following formula (9):
wherein zero _ flag is the zero speed flag, zerWhen the o _ flag is 1, the zero speed is represented, and when the zero _ flag is 0, the non-zero speed is represented; l is a generalized likelihood ratio statistical curve T after geometric transformationrev_u(n) the absolute value of the difference between the generalized likelihood ratio statistical curve T (n), as shown in formula (10); lambda is more than or equal to 0.9 and less than or equal to 0.95; Δ Y is the magnitude of the upshifting;
L=|Trev_u(n)-T(n)|
=|(-T(n)+ΔY)-(T(n))|
=|-2T(n)+ΔY| (10)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810353728.0A CN108680184B (en) | 2018-04-19 | 2018-04-19 | Zero-speed detection method based on generalized likelihood ratio statistical curve geometric transformation |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810353728.0A CN108680184B (en) | 2018-04-19 | 2018-04-19 | Zero-speed detection method based on generalized likelihood ratio statistical curve geometric transformation |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108680184A CN108680184A (en) | 2018-10-19 |
CN108680184B true CN108680184B (en) | 2021-09-07 |
Family
ID=63801204
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810353728.0A Active CN108680184B (en) | 2018-04-19 | 2018-04-19 | Zero-speed detection method based on generalized likelihood ratio statistical curve geometric transformation |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108680184B (en) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109855621B (en) * | 2018-12-27 | 2023-06-02 | 国网江苏省电力有限公司检修分公司 | Combined indoor pedestrian navigation system and method based on UWB and SINS |
CN111707294B (en) * | 2020-08-20 | 2020-11-06 | 中国人民解放军国防科技大学 | Pedestrian navigation zero-speed interval detection method and device based on optimal interval estimation |
CN113092819B (en) * | 2021-04-14 | 2022-11-18 | 东方红卫星移动通信有限公司 | Dynamic zero-speed calibration method and system for foot accelerometer |
CN114398530B (en) * | 2021-12-28 | 2024-08-23 | 东南大学 | Method for predicting vehicle behavior mode change of driver in real time |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2386828A1 (en) * | 2010-05-12 | 2011-11-16 | Technische Universität Graz | Method and system for detection of a zero velocity state of an object |
CN103499354A (en) * | 2013-09-24 | 2014-01-08 | 哈尔滨工程大学 | Neyman-Pearson criterion-based zero speed detection method |
CN104296750A (en) * | 2014-06-27 | 2015-01-21 | 大连理工大学 | Zero speed detecting method, zero speed detecting device, and pedestrian navigation method as well as pedestrian navigation system |
CN106017461A (en) * | 2016-05-19 | 2016-10-12 | 北京理工大学 | Pedestrian navigation system three-dimensional spatial positioning method based on human/environment constraints |
CN106153069A (en) * | 2015-03-31 | 2016-11-23 | 日本电气株式会社 | Attitude rectification apparatus and method in autonomous navigation system |
CN106767794A (en) * | 2017-01-19 | 2017-05-31 | 南京航空航天大学 | A kind of elastic zero-speed method of discrimination based on pedestrian movement's modal identification |
CN106908060A (en) * | 2017-02-15 | 2017-06-30 | 东南大学 | A kind of high accuracy indoor orientation method based on MEMS inertial sensor |
CN107843256A (en) * | 2017-10-11 | 2018-03-27 | 南京航空航天大学 | Adaptive zero-velocity curve pedestrian navigation method based on MEMS sensor |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10190881B2 (en) * | 2015-01-08 | 2019-01-29 | Profound Positioning Inc. | Method and apparatus for enhanced pedestrian navigation based on WLAN and MEMS sensors |
-
2018
- 2018-04-19 CN CN201810353728.0A patent/CN108680184B/en active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2386828A1 (en) * | 2010-05-12 | 2011-11-16 | Technische Universität Graz | Method and system for detection of a zero velocity state of an object |
CN103499354A (en) * | 2013-09-24 | 2014-01-08 | 哈尔滨工程大学 | Neyman-Pearson criterion-based zero speed detection method |
CN104296750A (en) * | 2014-06-27 | 2015-01-21 | 大连理工大学 | Zero speed detecting method, zero speed detecting device, and pedestrian navigation method as well as pedestrian navigation system |
CN106153069A (en) * | 2015-03-31 | 2016-11-23 | 日本电气株式会社 | Attitude rectification apparatus and method in autonomous navigation system |
CN106017461A (en) * | 2016-05-19 | 2016-10-12 | 北京理工大学 | Pedestrian navigation system three-dimensional spatial positioning method based on human/environment constraints |
CN106767794A (en) * | 2017-01-19 | 2017-05-31 | 南京航空航天大学 | A kind of elastic zero-speed method of discrimination based on pedestrian movement's modal identification |
CN106908060A (en) * | 2017-02-15 | 2017-06-30 | 东南大学 | A kind of high accuracy indoor orientation method based on MEMS inertial sensor |
CN107843256A (en) * | 2017-10-11 | 2018-03-27 | 南京航空航天大学 | Adaptive zero-velocity curve pedestrian navigation method based on MEMS sensor |
Non-Patent Citations (3)
Title |
---|
不同惯导系统零速检测算法的性能分析;石波等;《山东科技大学学报(自然科学版)》;20160430;第35卷(第02期);第57-63页 * |
基于GLRT零速检测算法的行人室内定位系统;樊启高 等;《传感技术学报》;20171130;第30卷(第11期);第1706-1711页 * |
基于MEMS的室内定位误差修正方法研究;朱彩杰等;《测绘工程》;20170531;第26卷(第05期);第57-61页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108680184A (en) | 2018-10-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108680184B (en) | Zero-speed detection method based on generalized likelihood ratio statistical curve geometric transformation | |
WO2020253854A1 (en) | Mobile robot posture angle calculation method | |
CN108225308B (en) | Quaternion-based attitude calculation method for extended Kalman filtering algorithm | |
CN110926460B (en) | Uwb positioning abnormal value processing method based on IMU | |
CN101464152B (en) | Adaptive filtering method for SINS/GPS combined navigation system | |
CN106225786B (en) | A kind of adaptive pedestrian navigation system zero-speed section detecting method | |
CN109141475B (en) | Initial alignment method for SINS robust traveling under assistance of DVL (dynamic velocity logging) | |
CN109612463B (en) | Pedestrian navigation positioning method based on lateral speed constraint optimization | |
WO2018214227A1 (en) | Unmanned vehicle real-time posture measurement method | |
CN107289930A (en) | Pure inertia automobile navigation method based on MEMS Inertial Measurement Units | |
CN105628027A (en) | Indoor environment precise real-time positioning method based on MEMS inertial device | |
CN110865334B (en) | Multi-sensor target tracking method and system based on noise statistical characteristics | |
CN103604947B (en) | Flow field state measuring method with adaptive adjusted time resolution | |
CN108304594B (en) | Method for judging driving stability of automobile based on speed and gyroscope data | |
CN109998551B (en) | Gait phase analysis method for sectional type local peak detection | |
CN109190171B (en) | Vehicle motion model optimization method based on deep learning | |
CN107270937B (en) | Off-line wavelet denoising rapid initial alignment method | |
CN103630147A (en) | Zero-speed detection method for individually autonomous navigation system based on hidden Markov model (HMM) | |
CN106153069A (en) | Attitude rectification apparatus and method in autonomous navigation system | |
CN109387198A (en) | A kind of inertia based on sequential detection/visual odometry Combinated navigation method | |
CN112946641B (en) | Data filtering method based on relevance of Kalman filtering innovation and residual error | |
CN112066980A (en) | Pedestrian navigation positioning method based on human body four-node motion constraint | |
CN109033017B (en) | Vehicle roll angle and pitch angle estimation method under packet loss environment | |
CN107340026A (en) | Unstable state level gauging value filtering method | |
CN109443378A (en) | Velocity aid recalls Initial Alignment Method between advancing |
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 |