CN114637036B - Non-integrity-constrained adaptive noise measurement method - Google Patents

Non-integrity-constrained adaptive noise measurement method Download PDF

Info

Publication number
CN114637036B
CN114637036B CN202210536291.0A CN202210536291A CN114637036B CN 114637036 B CN114637036 B CN 114637036B CN 202210536291 A CN202210536291 A CN 202210536291A CN 114637036 B CN114637036 B CN 114637036B
Authority
CN
China
Prior art keywords
nhc
vehicle
noise
measurement noise
turning
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
Application number
CN202210536291.0A
Other languages
Chinese (zh)
Other versions
CN114637036A (en
Inventor
张嘉骅
孙中亮
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shenzhen Huada Beidou Technology Co ltd
Original Assignee
Shenzhen Huada Beidou Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Shenzhen Huada Beidou Technology Co ltd filed Critical Shenzhen Huada Beidou Technology Co ltd
Priority to CN202210536291.0A priority Critical patent/CN114637036B/en
Publication of CN114637036A publication Critical patent/CN114637036A/en
Application granted granted Critical
Publication of CN114637036B publication Critical patent/CN114637036B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Navigation (AREA)

Abstract

The embodiment of the invention discloses a non-integrity-constrained self-adaptive noise measurement method, which comprises the following steps: step 1: acquiring the mounting angle precision and a GNSS positioning mode; step 2: determining an initial value of NHC (positive temperature coefficient) measurement noise according to the mounting angle precision and the GNSS positioning mode; and 3, step 3: judging the motion state of the vehicle at the current moment; and 4, step 4: NHC measurement noise is determined adaptively. The NHC measurement noise initial value is determined according to the installation angle precision and the GNSS positioning mode, the NHC lateral measurement noise is adaptively corrected by utilizing the vehicle motion state information, and a time sliding window is introduced when the vehicle continuously turns, so that the precision of a combined positioning solution is effectively improved; the invention has particularly remarkable improvement on the combined navigation performance based on the low-cost sensor; in a tunnel scene, compared with a conventional determination method of NHC measurement noise, the method disclosed by the invention can improve the MEMS recursive positioning accuracy by more than 40%.

Description

Non-integrity-constrained adaptive noise measurement method
Technical Field
The invention relates to the technical field of navigation positioning, in particular to a non-integrity-constrained self-adaptive noise measurement method.
Background
In the vehicle-mounted field integrated navigation algorithm, it is usually assumed that a vehicle body does not sideslip and is tightly attached to the ground (namely Non-integrity Constraint) in the driving process of a vehicle, and Non-integrity Constraint (NHC) observed quantity is introduced to inhibit the divergence of errors of an integrated positioning solution and ensure the precision and reliability of the positioning solution. For the sheltered environment, especially for viaducts, urban canyons and tunnels along roads, NHC plays an important role in ensuring and improving the performance of the combined navigation positioning solution.
Introducing NHC observations requires a corresponding measurement noise to be given. The determination of the value for NHC in the R-matrix of the location filtering algorithm depends on the measurement noise.
In the conventional NHC algorithm, a fixed value of the measurement noise is often given empirically. Some methods for correcting NHC measurement noise have also appeared in the field of vehicle navigation, which mainly include: giving an initial value of the measurement noise according to experience; determining the motion state of the vehicle body according to the speed and angle change information of the vehicle body, and correcting the NHC measurement noise according to the motion state; and respectively analyzing the correlation between the speed and angle change of the vehicle body and the NHC observed quantity error, and correcting the NHC measurement noise according to the correlation analysis result.
However, the above method for correcting the measurement noise has some problems: firstly, the initial value of the measured noise is a fixed empirical value, the applicability to the scene is limited, and the accuracy of the initial value selection directly influences the improvement effect of the combined positioning performance. Furthermore, the correlation between the velocity and angle change of the analyzed vehicle body and the NHC observed quantity error depends on the observation accuracy of the inertial navigation device itself. For a consumer-grade inertial navigation sensor MEMS (Micro-Electro-Mechanical System), which is influenced by the manufacturing process level, the observation noise is large, and the correlation analysis between the speed and angle change of a vehicle body and the NHC observation error is not suitable. In addition, when the vehicle turns, the value of the NHC measurement noise is usually larger than that of the vehicle in a straight running state, and the negative effect caused by the fact that the NHC measurement noise is large for a long time is not considered. Especially for low cost sensors, when NHC measurement noise is large for a long time, the integrated navigation positioning error will quickly diverge.
The existing NHC correction noise measurement method plays a limited role in improving the combined positioning performance.
Disclosure of Invention
The technical problem to be solved by the embodiments of the present invention is to provide a non-integrity-constrained adaptive noise measurement method to improve the accuracy of a combined positioning solution.
In order to solve the above technical problem, an embodiment of the present invention provides a non-integrity-constrained adaptive noise measurement method, including:
step 1: acquiring the mounting angle precision and a GNSS positioning mode;
step 2: determining an initial value of NHC (positive temperature coefficient) measurement noise according to the mounting angle precision and the GNSS positioning mode;
and step 3: judging the motion state of the vehicle at the current moment, and judging whether the vehicle is in a straight line or a turning line at the current moment according to the change of the advancing speed and the course angle of the vehicle, wherein the turning line is divided into a small-angle turning line, a large-angle turning line and a lane changing line;
and 4, step 4: the NHC measurement noise is determined in a self-adaptive mode, the NHC lateral measurement noise is corrected in real time by combining the motion state of the vehicle, and the NHC measurement noise of the vehicle in different motion states is determined in a self-adaptive mode; if the vehicle is in a turning state, introducing a time sliding window, setting the length of the time sliding window, correcting the NHC lateral measurement noise in real time according to the turning state of the vehicle in a preset time period when the vehicle body turns continuously, and then gradually reducing the NHC lateral measurement noise in the next time period.
Further, in step 1, respectively determining the mounting angle precision according to whether the mounting angle is estimated on line in real time, wherein:
(1) when the installation angle is estimated online in real time, the corresponding post-test variance is taken;
(2) and when the mounting angle is estimated online in a non-real-time manner, taking the standard deviation of the mounting angle.
Further, in step 2, the initial value of NHC measurement noise is determined according to the following formula:
Figure 662930DEST_PATH_IMAGE001
Figure 73051DEST_PATH_IMAGE002
Figure 701741DEST_PATH_IMAGE003
wherein,
Figure 146498DEST_PATH_IMAGE004
the initial value of the noise of the NHC measurement determined by the method is determined;
Figure 514025DEST_PATH_IMAGE005
the measured noise value is NHC;
Figure 644399DEST_PATH_IMAGE006
is a coefficient term of
Figure 122785DEST_PATH_IMAGE007
And
Figure 422048DEST_PATH_IMAGE008
composition is carried out;
Figure 648892DEST_PATH_IMAGE009
for coefficients determined according to the accuracy of the setting angle, by piecewise functions
Figure 33606DEST_PATH_IMAGE010
Determining a numerical value;
Figure 1168DEST_PATH_IMAGE011
mounting angle accuracy;
Figure 640091DEST_PATH_IMAGE012
coefficients determined from the GNSS positioning mode; a different GNSS positioning mode may be used,
Figure 67531DEST_PATH_IMAGE012
and taking values respectively.
Further, in step 4, the NHC lateral measurement noise of the vehicle in different motion states is adaptively determined according to the following formula:
Figure 706585DEST_PATH_IMAGE013
Figure 995615DEST_PATH_IMAGE014
Figure 269470DEST_PATH_IMAGE015
wherein,
Figure 631925DEST_PATH_IMAGE016
the NHC lateral measurement noise is the NHC lateral measurement noise when the vehicle is in a straight-ahead driving;
Figure 741963DEST_PATH_IMAGE017
the corresponding coefficient when the vehicle runs straight is represented by a piecewise function
Figure 83952DEST_PATH_IMAGE018
Determining a numerical value;
Figure 494204DEST_PATH_IMAGE019
the real-time forward speed of the vehicle;
Figure 296070DEST_PATH_IMAGE020
measuring the noise of NHC side direction when the vehicle turns;
Figure 158983DEST_PATH_IMAGE021
is the threshold value of NHC lateral measurement noise;
Figure 570242DEST_PATH_IMAGE022
is a corresponding coefficient when the vehicle turns, different turning states of the vehicle (small-angle turning, large-angle turning and lane changing),
Figure 835001DEST_PATH_IMAGE023
respectively taking values;
Figure 539259DEST_PATH_IMAGE024
the real-time course angular speed of the vehicle;
Figure 889468DEST_PATH_IMAGE025
the threshold value of the course angular speed is used for judging whether the vehicle turns.
Further, in step 4, when the vehicle body is continuously turned, the turning is performed for a preset time period
Figure 838839DEST_PATH_IMAGE026
Correcting NHC lateral measurement noise in real time according to the turning state of the vehicle within seconds to obtain
Figure 958105DEST_PATH_IMAGE027
(ii) a Then, in the next time periodt b Within seconds, gradually decrease according to time intervals
Figure 101772DEST_PATH_IMAGE028
To
Figure 922967DEST_PATH_IMAGE029
(ii) a Wherein,
Figure 161181DEST_PATH_IMAGE030
Figure 640614DEST_PATH_IMAGE031
are coefficients.
Further, the air conditioner is characterized in that,
Figure 922560DEST_PATH_IMAGE031
has a value range of
Figure 450624DEST_PATH_IMAGE032
0 and
Figure 977683DEST_PATH_IMAGE033
1。
the invention has the beneficial effects that: the NHC measurement noise initial value is determined according to the installation angle precision and the GNSS positioning mode, the NHC lateral measurement noise is adaptively corrected by utilizing the vehicle motion state information, and a time sliding window is introduced when the vehicle continuously turns, so that the precision of a combined positioning solution is effectively improved; the invention has particularly remarkable improvement on the integrated navigation performance based on the consumption-level MEMS inertial navigation sensor; in a tunnel scene, compared with the conventional determination method of NHC measurement noise, the method provided by the invention has the advantage that the pure inertial navigation recursion positioning precision of the MEMS can be improved by more than 40%.
Drawings
Fig. 1 is a flow chart illustrating a non-integrity-constrained adaptive noise measurement method according to an embodiment of the present invention.
Detailed Description
It should be noted that the embodiments and features of the embodiments in the present application can be combined with each other without conflict, and the present invention is further described in detail with reference to the drawings and specific embodiments.
The nature of NHC is: the assumption is that the moving carrier does not sideslip and cling to the ground during driving.
Taking the front right bottom (FRD) coordinate system as an example, NHC observations were introduced:
Figure 55229DEST_PATH_IMAGE034
(1)
Figure 524388DEST_PATH_IMAGE035
(2)
in the formulas (1) and (2),
Figure 553130DEST_PATH_IMAGE036
representing a carrier lateral velocity observation;
Figure 664306DEST_PATH_IMAGE037
represents the observed vertical velocity of the carrier.
NHC can effectively restrain the divergence of error of the combined positioning solution, and ensure the precision and reliability of the positioning solution. According to the NHC principle, the degree of dependence of the combined positioning on NHC is different in straight driving and turning states of the vehicle. In the straight-ahead state, the vehicle body will not usually slip, and the measured noise value of NHC can be relatively small to increase the effect of NHC. In a cornering situation, the vehicle may be accompanied by a certain degree of body side slip, which conflicts with the principle of NHC. However, considering that the observation noise level of the low-cost sensor is larger, the NHC can still effectively suppress the divergence of the positioning error of the vehicle, and the improvement effect on the positioning accuracy is not as good as that when the vehicle moves straight. The corresponding solution is to increase NHC measurement noise during vehicle turning to reduce NHC effect compared to when the vehicle is traveling straight. It should be noted that, in order to ensure that the NHC can still effectively suppress the divergence of the combined positioning error when the vehicle is in a turning state, the value of the NHC measurement noise is not too large.
Referring to fig. 1, the non-integrity-constrained adaptive noise measurement method according to the embodiment of the present invention includes steps 1 to 4.
Step 1: acquiring mounting angle precision and a GNSS positioning mode;
according to the invention, the accuracy of the mounting angle is respectively determined according to whether the mounting angle is estimated on line in real time:
(1) and when the mounting angle is estimated online in real time, taking the corresponding post-test variance.
(2) And taking the standard deviation of the mounting angle when the mounting angle is estimated online in a non-real time manner.
And 2, step: determining an initial value of NHC (positive temperature coefficient) measurement noise according to the mounting angle precision and the GNSS positioning mode;
before introducing NHC observations, the mounting angle between the inertial and moving carrier coordinate systems needs to be determined. The accuracy of the mount angle estimation directly affects the NHC effect. In the integrated Navigation algorithm, the estimation of the installation angle depends on positioning information of a Global Navigation positioning System (GNSS). The GNSS positioning mode includes: a pseudorange Point Positioning (SPP) mode, a Real Time Differential (RTD) mode, a Real Time Kinematic (RTK) mode, and a Precision Point Positioning (PPP) mode. The RTK and PPP are further divided into a floating solution mode and a fixed solution mode according to the fixed condition of the integer ambiguity. Different GNSS positioning modes represent different GNSS positioning accuracy. There are differences in the mounting angle accuracy that are obtained depending on different GNSS positioning accuracies. The initial value of the NHC measurement noise is determined according to the mounting angle precision and the positioning mode of the GNSS. The worse the mounting angle accuracy is, the worse the GNSS positioning accuracy is, and the larger the value of the NHC measurement noise initial value is.
Here, it is defined that:
Figure 861938DEST_PATH_IMAGE038
(3)
Figure 767577DEST_PATH_IMAGE039
(4)
Figure 552124DEST_PATH_IMAGE040
(5)
in the formulae (3), (4), (5),
Figure 935832DEST_PATH_IMAGE041
the initial value of the noise of the NHC measurement determined by the method is determined;
Figure 253550DEST_PATH_IMAGE042
the measured noise value is NHC;
Figure 330090DEST_PATH_IMAGE043
is a coefficient term of
Figure 599004DEST_PATH_IMAGE044
And
Figure 786403DEST_PATH_IMAGE045
forming;
Figure 224207DEST_PATH_IMAGE046
for coefficients determined according to the accuracy of the setting angle, by piecewise functions
Figure 471648DEST_PATH_IMAGE047
Determining a numerical value;
Figure 230788DEST_PATH_IMAGE048
mounting angle accuracy;
Figure 221878DEST_PATH_IMAGE049
coefficients determined according to the GNSS positioning mode; different GNSS positioning modes (SPP, RTD, RTK, PPP),
Figure 248609DEST_PATH_IMAGE050
respectively taking values;
and step 3: and judging the motion state of the vehicle at the current moment. Judging whether the vehicle is going straight or turning at the current moment according to the changes of the advancing speed and the course angle of the vehicle, wherein the turning is divided into small-angle turning, large-angle turning and lane changing;
and 4, step 4: NHC measurement noise is determined adaptively.
(1) And (3) correcting the NHC lateral measurement noise in real time by combining the motion state of the vehicle, and adaptively determining the NHC measurement noise of the vehicle in different motion states.
Here, it is defined that:
Figure 666952DEST_PATH_IMAGE051
(6)
Figure 644878DEST_PATH_IMAGE052
(7)
Figure 705238DEST_PATH_IMAGE053
(8)
in the formulae (6), (7) and (8),
Figure 586476DEST_PATH_IMAGE054
the NHC lateral measurement noise is the NHC lateral measurement noise when the vehicle is in a straight-ahead driving;
Figure 175720DEST_PATH_IMAGE055
the corresponding coefficient when the vehicle runs straight is represented by a piecewise function
Figure 909452DEST_PATH_IMAGE056
Determining a numerical value;
Figure 242344DEST_PATH_IMAGE057
the real-time forward speed of the vehicle;
Figure 978088DEST_PATH_IMAGE058
measuring the noise of NHC side direction when the vehicle turns;
Figure 3813DEST_PATH_IMAGE059
is the threshold value of NHC lateral measurement noise;
Figure 956332DEST_PATH_IMAGE060
the corresponding coefficients when the vehicle turns, different turning states of the vehicle (small-angle turning, large-angle turning and lane changing),
Figure 827336DEST_PATH_IMAGE060
respectively taking values;
Figure 683165DEST_PATH_IMAGE061
the real-time course angular speed of the vehicle;
Figure 879791DEST_PATH_IMAGE062
the threshold value of the course angular speed is used for judging whether the vehicle turns;
(2) a time sliding window is introduced.
According to the NHC principle, the NHC measurement noise adapted when the vehicle turns is generally larger than when the vehicle travels straight. NHC measurementThe more noise, the less NHC plays a role. When NHC lateral measurement noise is large for a long time in a turning state, the combined navigation positioning error based on the low-cost sensor can be rapidly dispersed. Therefore, the invention introduces a time sliding window, and the basic principle is as follows: while the vehicle body is turning continuously for a certain period of time
Figure 56957DEST_PATH_IMAGE063
Second), correcting NHC lateral measurement noise in real time according to the turning state of the vehicle to obtain
Figure 731652DEST_PATH_IMAGE064
(ii) a Then, for the next period of time (
Figure 441988DEST_PATH_IMAGE065
Seconds), gradually decrease at intervals
Figure 278357DEST_PATH_IMAGE064
To
Figure 205468DEST_PATH_IMAGE066
Defining:
Figure 683854DEST_PATH_IMAGE067
(9)
in the formula (9), the reaction mixture is,
Figure 248697DEST_PATH_IMAGE068
is a coefficient with a value range of
Figure 787125DEST_PATH_IMAGE069
0 and
Figure 938883DEST_PATH_IMAGE070
1。
the invention firstly determines the initial value of NHC measurement noise according to the mounting angle precision and the GNSS positioning mode. And then judging the motion state of the vehicle according to the change of the advancing speed and the heading angle of the vehicle. And finally, carrying out self-adaptive correction on the NHC lateral measurement noise according to the motion state of the vehicle, and determining the NHC measurement noise in a self-adaptive manner. When the vehicle continuously turns, if the NHC measurement noise is large for a long time, the combined navigation positioning error based on the low-cost sensor will quickly diverge. Therefore, the invention introduces a time sliding window, and effectively inhibits the divergence of the combined navigation positioning error. Series additions and modifications to the present invention are within the scope of the present invention.
Although embodiments of the present invention have been shown and described, it will be appreciated by those skilled in the art that various changes, modifications, substitutions and alterations can be made in these embodiments without departing from the principles and spirit of the invention, the scope of which is defined in the appended claims and their equivalents.

Claims (5)

1. A non-integrity-constrained adaptive noise measurement method is characterized by comprising the following steps:
step 1: acquiring the mounting angle precision and a GNSS positioning mode;
and 2, step: determining an initial value of NHC (positive temperature coefficient) measurement noise according to the mounting angle precision and the GNSS positioning mode;
and 3, step 3: judging the motion state of the vehicle at the current moment, and judging whether the vehicle is going straight or turning at the current moment according to the change of the advancing speed and the course angle of the vehicle, wherein the turning is divided into small-angle turning, large-angle turning and lane changing;
and 4, step 4: the NHC measurement noise is determined in a self-adaptive mode, the NHC lateral measurement noise is corrected in real time by combining the motion state of the vehicle, and the NHC measurement noise of the vehicle in different motion states is determined in a self-adaptive mode; if the vehicle is in a turning state, introducing a time sliding window, setting the length of the time sliding window, correcting the NHC lateral measurement noise in real time according to the turning state of the vehicle in a preset time period when the vehicle body turns continuously, and then gradually reducing the NHC lateral measurement noise in the next time period;
in step 2, the initial value of NHC measurement noise is determined according to the following formula:
Figure DEST_PATH_IMAGE001
Figure DEST_PATH_IMAGE002
Figure DEST_PATH_IMAGE003
wherein,
Figure DEST_PATH_IMAGE004
measuring the initial value of noise for NHC;
Figure DEST_PATH_IMAGE005
the measured noise value is NHC;
Figure DEST_PATH_IMAGE006
is a coefficient term of
Figure DEST_PATH_IMAGE007
And
Figure DEST_PATH_IMAGE008
composition is carried out;
Figure DEST_PATH_IMAGE009
for coefficients determined according to the accuracy of the setting angle, by piecewise functions
Figure DEST_PATH_IMAGE010
Determining a numerical value;
Figure DEST_PATH_IMAGE011
mounting angle accuracy;
Figure DEST_PATH_IMAGE012
coefficients determined from the GNSS positioning mode; the different GNSS positioning modes may be different from each other,
Figure DEST_PATH_IMAGE013
and taking values respectively.
2. The non-integrity-constrained adaptive noise measurement method as claimed in claim 1, wherein in step 1, the mounting angle accuracy is determined according to whether the mounting angle is estimated on-line in real time, respectively, wherein:
(1) when the installation angle is estimated online in real time, the corresponding post-test variance is taken;
(2) and when the mounting angle is estimated online in a non-real-time manner, taking the standard deviation of the mounting angle.
3. The non-integrity-restricted adaptive noise measurement method of claim 1, wherein in step 4, NHC lateral measurement noise of the vehicle under different motion states is adaptively determined according to the following formula:
Figure DEST_PATH_IMAGE014
Figure DEST_PATH_IMAGE015
Figure DEST_PATH_IMAGE016
wherein,
Figure DEST_PATH_IMAGE017
the NHC lateral measurement noise is measured when the vehicle runs straight;
Figure DEST_PATH_IMAGE018
the corresponding coefficient when the vehicle runs straight is represented by a piecewise function
Figure DEST_PATH_IMAGE019
Determining a numerical value;
Figure DEST_PATH_IMAGE020
the real-time forward speed of the vehicle;
Figure DEST_PATH_IMAGE021
measuring noise laterally for NHC when the vehicle turns;
Figure DEST_PATH_IMAGE022
is the threshold value of NHC lateral measurement noise;
Figure DEST_PATH_IMAGE023
the corresponding coefficients when the vehicle turns and different turning states of the vehicle,
Figure DEST_PATH_IMAGE024
respectively taking values;
Figure DEST_PATH_IMAGE025
the real-time course angular speed of the vehicle;
Figure DEST_PATH_IMAGE026
the threshold value of the course angular speed is used for judging whether the vehicle turns.
4. The non-integrity-restricted adaptive noise measurement method according to claim 3, wherein in step 4, when the vehicle body continuously turns, the vehicle body continuously turns for a preset time periodt a Correcting NHC lateral measurement noise in real time according to the turning state of the vehicle within seconds to obtain
Figure DEST_PATH_IMAGE027
(ii) a Then, in the next time periodt b Within seconds, gradually decrease according to time intervals
Figure DEST_PATH_IMAGE028
To is that
Figure DEST_PATH_IMAGE029
(ii) a Wherein,
Figure DEST_PATH_IMAGE030
Figure DEST_PATH_IMAGE031
are coefficients.
5. The non-integrity-constrained adaptive noise measurement method of claim 4,
Figure 115414DEST_PATH_IMAGE031
has a value range of
Figure DEST_PATH_IMAGE032
0 and
Figure DEST_PATH_IMAGE033
1。
CN202210536291.0A 2022-05-18 2022-05-18 Non-integrity-constrained adaptive noise measurement method Active CN114637036B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210536291.0A CN114637036B (en) 2022-05-18 2022-05-18 Non-integrity-constrained adaptive noise measurement method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210536291.0A CN114637036B (en) 2022-05-18 2022-05-18 Non-integrity-constrained adaptive noise measurement method

Publications (2)

Publication Number Publication Date
CN114637036A CN114637036A (en) 2022-06-17
CN114637036B true CN114637036B (en) 2022-08-19

Family

ID=81952741

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210536291.0A Active CN114637036B (en) 2022-05-18 2022-05-18 Non-integrity-constrained adaptive noise measurement method

Country Status (1)

Country Link
CN (1) CN114637036B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115839718B (en) * 2022-09-29 2024-04-23 北京斯年智驾科技有限公司 Fusion positioning method and device based on motion constraint

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101476894A (en) * 2009-02-01 2009-07-08 哈尔滨工业大学 Vehicle-mounted SINS/GPS combined navigation system performance reinforcement method
CN112066983A (en) * 2020-09-08 2020-12-11 中国人民解放军国防科技大学 Inertial/odometer combined navigation filtering method, electronic equipment and storage medium
CN112254718A (en) * 2020-08-04 2021-01-22 东南大学 Motion constraint assisted underwater combined navigation method based on improved Sage-Husa adaptive filtering
CN112577521A (en) * 2020-11-26 2021-03-30 北京邮电大学 Combined navigation error calibration method and electronic equipment
CN112859132A (en) * 2019-11-27 2021-05-28 华为技术有限公司 Navigation method and device
CN114076610A (en) * 2020-08-12 2022-02-22 千寻位置网络(浙江)有限公司 Error calibration and navigation method and device of GNSS/MEMS vehicle-mounted integrated navigation system
CN114111792A (en) * 2021-11-22 2022-03-01 中国电子科技集团公司第五十四研究所 Vehicle-mounted GNSS/INS/odometer combined navigation method
CN114459469A (en) * 2022-01-14 2022-05-10 北京信息科技大学 Multi-motion-state navigation method and device and intelligent wearable equipment

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9151613B2 (en) * 2011-08-12 2015-10-06 Qualcomm Incorporated Methods and apparatus for detecting, measuring, and mitigating effects of moving an inertial navigation device's cradle
US10371530B2 (en) * 2017-01-04 2019-08-06 Qualcomm Incorporated Systems and methods for using a global positioning system velocity in visual-inertial odometry
US10739140B2 (en) * 2017-09-08 2020-08-11 Apple Inc. Iterative estimation of non-holonomic constraints in an inertial navigation system

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101476894A (en) * 2009-02-01 2009-07-08 哈尔滨工业大学 Vehicle-mounted SINS/GPS combined navigation system performance reinforcement method
CN112859132A (en) * 2019-11-27 2021-05-28 华为技术有限公司 Navigation method and device
CN112254718A (en) * 2020-08-04 2021-01-22 东南大学 Motion constraint assisted underwater combined navigation method based on improved Sage-Husa adaptive filtering
CN114076610A (en) * 2020-08-12 2022-02-22 千寻位置网络(浙江)有限公司 Error calibration and navigation method and device of GNSS/MEMS vehicle-mounted integrated navigation system
CN112066983A (en) * 2020-09-08 2020-12-11 中国人民解放军国防科技大学 Inertial/odometer combined navigation filtering method, electronic equipment and storage medium
CN112577521A (en) * 2020-11-26 2021-03-30 北京邮电大学 Combined navigation error calibration method and electronic equipment
CN114111792A (en) * 2021-11-22 2022-03-01 中国电子科技集团公司第五十四研究所 Vehicle-mounted GNSS/INS/odometer combined navigation method
CN114459469A (en) * 2022-01-14 2022-05-10 北京信息科技大学 Multi-motion-state navigation method and device and intelligent wearable equipment

Non-Patent Citations (7)

* Cited by examiner, † Cited by third party
Title
A GNSS/INS‑integrated system for an arbitrarily mounted land vehicle navigation device;Mengxue Mu等;《GPS Solutions》;20190823;第111-123页 *
Improved robust and adaptive filter based on non-holonomic constraints for RTK/INS integrated navigation;Zhehua Yang等;《Measurement Science and Technology》;20210628;第32卷(第10期);第1-14页 *
The promise of MEMS to the navigation community;Naser El-Sheimy等;《Inside GNSS》;20070131;第46-56页 *
利用MEMS-IMU检测车辆运动状态的自适应方法;胡昊杰等;《导航定位学报》;20201031;第8卷(第5期);第11-18页 *
基于深度学习辅助量测估计的组合导航算法研究与实现;肖逸敏;《中国优秀博硕士学位论文全文数据库(硕士)信息科技辑(月刊)》;20220115(第1期);第I136-2320页 *
非完整性约束量测噪声在组合导航算法中的应用研究;肖逸敏等;《中国科技论文在线》;20210317;第1-12页 *
非完整约束的OD_SINS自适应组合导航方法;刘万科等;《测绘学报》;20220131;第51卷(第1期);第9-17页 *

Also Published As

Publication number Publication date
CN114637036A (en) 2022-06-17

Similar Documents

Publication Publication Date Title
US8195357B2 (en) In-vehicle sensor-based calibration algorithm for yaw rate sensor calibration
US8510044B2 (en) Position sensing device and method
US5784029A (en) Recognition of and method and apparatus for GPS antenna lever arm compensation in integrated GPS/dead reckoning navigation systems
JP5855249B2 (en) Positioning device
CN101363740B (en) Position correction apparatus
US9719786B2 (en) Systems for navigating using corrected yaw bias values
RU2682137C1 (en) Motion control method and motion control device
CN111536972B (en) Vehicle-mounted DR navigation method based on odometer scale factor correction
WO2007059134A1 (en) Dead reckoning system
KR20140073977A (en) Method for obtaining bias of yawrate sensor for vehicle
CN114637036B (en) Non-integrity-constrained adaptive noise measurement method
CN104864867B (en) GNSS vehicle is applicable in VSYR blind areas position error modification method
CN114279454B (en) Method and system for navigating a mobile platform in an environment
JP3218876B2 (en) Current position detection device for vehicles
JP6539129B2 (en) Vehicle position estimation device, steering control device using the same, and vehicle position estimation method
CN112229422A (en) Speedometer quick calibration method and system based on FPGA time synchronization
CN112455446A (en) Method, apparatus, electronic device, and storage medium for vehicle control
CN115060257A (en) Vehicle lane change detection method based on civil-grade inertia measurement unit
JP7069624B2 (en) Position calculation method, vehicle control method and position calculation device
JPH07301541A (en) Navigation device
CN113917512B (en) Positioning method and device for automatic driving vehicle, electronic equipment and storage medium
JP3451636B2 (en) Speed sensor coefficient calculation device
KR20180003728A (en) Gyro sensor correction apparatus and method for improving accuracy location of car navigation system
JPH08338733A (en) Device for calculating direction of travel of vehicle
CN112829760B (en) Vehicle driving track prediction method and system

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