CN1322311C - vehicle-carrying quick positioning and orienting method - Google Patents

vehicle-carrying quick positioning and orienting method Download PDF

Info

Publication number
CN1322311C
CN1322311C CNB200510057162XA CN200510057162A CN1322311C CN 1322311 C CN1322311 C CN 1322311C CN B200510057162X A CNB200510057162X A CN B200510057162XA CN 200510057162 A CN200510057162 A CN 200510057162A CN 1322311 C CN1322311 C CN 1322311C
Authority
CN
China
Prior art keywords
information
data processor
odometer
gps
inertial navigation
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.)
Expired - Fee Related
Application number
CNB200510057162XA
Other languages
Chinese (zh)
Other versions
CN1731091A (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.)
Individual
Original Assignee
Individual
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 Individual filed Critical Individual
Priority to CNB200510057162XA priority Critical patent/CN1322311C/en
Publication of CN1731091A publication Critical patent/CN1731091A/en
Application granted granted Critical
Publication of CN1322311C publication Critical patent/CN1322311C/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Navigation (AREA)

Abstract

The present invention relates to a quick position and orientation method on vehicles, which comprises the steps that the optimal-selection mode order is executed by a data processor via a software system and a hardware system which are composed of inertial navigation of laser gyro on the vehicles, a milometer, an altimeter, a GPS, a GLONASS, a BD, a geographic information and data processor. The method comprises the following procedures: aligning initially; obtaining mileage information by the milometer; combining the mileage information of navigation solution; obtaining height information by the altimeter; correcting error by the milometer, and latitude and longitude of the geographic information; outputting and displaying a geography coordinate and course angles by the data processor. The present invention has the advantages that the present invention integrates the position and orientation advantages of the inertial navigation system and the position advantages of the satellite, the functions can be mutually complementary, and the present invention can independently carry out the autonomous and accurate position and orientation, and height output.

Description

Vehicle-mounted quick positioning and directing system
Technical field
The present invention relates to the quick positioning and directing of a kind of novel on-vehicle system, particularly provide a kind of zero-speed correction, good reliability, precision high vehicle-mounted quick positioning and directing system.
Background technology
One of tactical characteristic of modern war under the high-technology condition is to disperse deployment, concentrated, the precision strike of firepower.Therefore, just need guided missile and launch truck that course, geographic coordinate position, the elevation of car launcher under static and the current intelligence are provided in real time, mission to scout car is scouted operation exactly in battlefield surroundings, finish the search to target, the task of location.For this reason, guided missile and launch truck, battle reconnaissance car etc. just must be equipped advanced detecting devices, require operation quick and precisely, and good concealment is changed rapidly, and adaptive capacity to environment is strong.Thisly can provide course, position, the isoparametric system of elevation, be exactly the vehicle positioning orientation system.
At present, vehicle-mounted positioning and directing system kind is more, and according to the application difference, technical scheme is different, but can be divided three classes substantially:
(1) platform-type inertial measurement system
Use high-accuracy mechanical gyro and accelerometer, constitute three ring Platform INS Inertial, adopt the zero-speed correction technique, suppress the emission of navigation error, horizon location error, generally below 30 meters (CEP), course error is less than 1.5mil (1).ULISS30 (France), FILS-3 (Britain), GEO-SPN (U.S.) system etc. and 618 in China, 707 geodesic systems of being developed belong to this type of.But this system's shortcoming is the zero-speed correction will stop, and reliability is very poor, and setup time is long, complex structure, maintenance difficult.
(2) the course maintaining body adds odometer
Adopt the two-axis table structure, follow the tracks of local level.The course keeps gyro then to use the strapdown mode, by course information and odometer output, infers carrier positions, and system architecture is simple, but precision is on the low side, and reliability is relatively poor.This type systematic has FNA55 (Germany), NFS (Israel), LNS, ANS2000 (U.S.) or the like.
(3) strapdown inertia adds the integrated navigation system of out of Memory source (GPS, odometer, geography information etc.)
Many based on inertial navigation information, odometer, GPS, geography information etc. are auxilliary with optical gyroscope (laser gyro, optical fibre gyro) and accelerometer formation strapdown inertia, and the optimal synthesis of realizing information with Kalman Filter Technology is to obtain navigational parameter.This external series products has: FNA2012, the FIN1155 of Britain, LLN-80, II-726 of the U.S. or the like of SIGMA30, the EPSILON of France, Germany.Domestic have how tame unit also developing homogeneous system, but that this series products relies on satellite is more, when pure inertial navigation navigation, still needs the zero-speed correction of stopping, otherwise precision still can not meet the demands, and also has defectives such as the integrated mode of many information is single.
Therefore, improving vehicle-mounted zero-speed correction, improve system reliability and precision, then is that problem to be solved is arranged in the prior art.
Summary of the invention
At the prior art above shortcomings, the purpose of this invention is to provide the high vehicle-mounted quick positioning and directing system of a kind of zero-speed correction, good reliability, precision.
The object of the present invention is achieved like this: vehicle-mounted quick positioning and directing system is characterized in that containing vehicle-mounted laser gyro inertial navigation+odometer+altitude gauge/GPS/GLONASS/BD/ geography information, data processor and software; The output terminal of odometer, altitude gauge, GPS/GLONASS/BD and geography information connects the input end of data processor, and the output terminal output of data processor also shows geographic coordinate and course angle; In order to weaken the accumulated error of inertia system, improve reliability, when certain part broke down, system automatically switched to other pattern and works on, and described data processor is carried out the following step:
(1) initial alignment;
(2) obtain mileage information by odometer, simultaneously with odometer duty Input Data Process;
(3) mileage information is resolved in integrated navigation, simultaneously to data processor output information pattern 5;
(4) obtain elevation information by altitude gauge, simultaneously with altitude gauge duty Input Data Process;
(5) carry out altimetric compensation by altitude gauge, and to data processor output information pattern 4;
(6) by 1. electronic chart 2. the geography information of the autonomous mapping of inertial navigation system obtain geography information, simultaneously with geography information duty Input Data Process;
(7) carry out error correction by the longitude and latitude in odometer, the geography information, to data processor output information mode 3;
(8) obtain GPS/GLONASS/BD information, to data processor output information pattern 2; Simultaneously with GPS duty Input Data Process;
(9) by Kalman filtering, to data processor output information pattern 1;
(10) data processor output and demonstration geographic coordinate and course angle.
Described data processor is carried out preference pattern:
Laser gyro inertial navigation+odometer+altitude gauge/GPS/GLONASS/BD/ geography information;
Pure GPS/GLONASS/BD;
Laser gyro inertial navigation+odometer+altitude gauge+geography information;
Laser gyro inertial navigation+geography information;
Mileage information is resolved in integrated navigation.
Compared to existing technology, the present invention has following advantage:
(1) combining the advantage and the function of the positioning and directing of inertial navigation system and satnav can be complementary.
(2) system model of laser inertial system/odometer/altitude gauge combination can independently carry out the directed and output highly of autonomous positioning.
(3) laser inertial/GPS/GLONASS/BD geography information/odometer/height indicator can be formed the multiple mode of operation of system, can realize under the available condition of satellite resource accurately positioning and directing and elevation output.
(4) system can realize the normal fault distinguishing that uses of satellite, and system discerns automatically and changes the mode of operation of switching other.
(5) this system possesses the function of satellite location data and laser gyro inertial positioning directional data being carried out fusion treatment, and fast positioning and directing, stopping to continue to travel keeps very high positioning and directing precision.
Description of drawings
The process flow diagram of Fig. 1 vehicle-carrying quick positioning and orienting method of the present invention.
Fig. 2 is a structure principle chart of the present invention.
Fig. 3 is circuit theory diagrams of the present invention.
Embodiment
The quick positioning and directing of novel on-vehicle of the present invention system, comprise vehicle-mounted laser gyro inertial navigation+odometer+altitude gauge/GPS/GLONASS/BD/ geography information and data processor, data processor adopts the industrial computer that carries out data processing and message exchange to get final product.The used hardware of the present invention all adopts existing mature technology.
Referring to Fig. 1, vehicle-carrying quick positioning and orienting method, this method is carried out the preference pattern order by containing soft, the hardware system that vehicle-mounted laser gyro inertial navigation+odometer+altitude gauge/GPS/GLONASS/BD/ geography information and data processor constitute by data processor; Described quick positioning and orienting method comprises the following steps:
(1) initial alignment, promptly the initial position of inertial navigation system is the north orientation and the earth surface level aligning of the earth;
(2) obtain mileage information by odometer, simultaneously with odometer duty Input Data Process;
(3) mileage information is resolved in integrated navigation, simultaneously to data processor output information pattern 5;
(4) obtain elevation information by altitude gauge, simultaneously with altitude gauge duty Input Data Process;
(5) by pressing altitude gauge to carry out altimetric compensation, to data processor output information pattern 4;
(6) by 1. electronic chart 2. the geography information of the autonomous mapping of inertial navigation system obtain geography information, simultaneously with geography information duty Input Data Process;
(7) carry out error correction by the longitude and latitude in odometer, the geography information, to data processor output information mode 3;
(8) obtain GPS/GLONASS/BD information, to data processor output information pattern 2; Simultaneously with GPS duty Input Data Process;
(9) by Kalman filtering, to data processor output information pattern 1;
(10) data processor output and demonstration geographic coordinate and course angle.
The system works principle:
Referring to Fig. 2, Fig. 3, this system is the integrated navigation system after many information fusion, utilize three laser gyro strap down inertial navigation systems to set up the navigation benchmark, and initial alignment, carry out the coordinates matrix conversion then in real time and measure the kinematic parameter of carrier with respect to inertial space, and, implement navigation task through after calculating.Giving under its starting condition, calculating the attitude and the course angle of speed, position coordinates and the carrier of carrier by navigational computer.Because the precision of pure inertial navigation is when starting working or very high in the short time, but from initial alignment, owing to its error of drift of gyro just accumulates in time, precision reduces in time.In order effectively to weaken the accumulation error of inertial navigation system, satisfy the requirement of car launcher overall process, system has selected GPS/GLONASS/BD+ odometer+geography information+altitude gauge to proofread and correct inertial navigation system in order to the data that provide continually as external information, thereby form a kind of integrated navigation positioning and directing system by the effective information fusion of Kalman filtering, make it under task environment, accurately export desired geographic coordinate and course angle.Under this many information fusion integrated navigation, system follows the principle that satellite information usefulness is not leaned on, and in Design of System Software, cooks up the preferred sequence in many information fusion, makes it be in navigational state in real time.Referring to Fig. 1, its preference pattern is in proper order:
Laser gyro inertial navigation+odometer+altitude gauge/GPS/GLONASS/BD/ geography information;
Pure GPS/GLONASS/BD;
Laser gyro inertial navigation+odometer+altitude gauge+geography information;
Laser gyro inertial navigation+geography information.
When certain part broke down, system automatically switched to other pattern and works on, thereby made system have redundance, had improved the reliability of system.In the system design, when the inertia self-navigation is leaned on by system, designed and a kind ofly do not stopped, make up when relying on autonomous geography information of surveying and drawing and inertial navigation, that is: the car that the laser gyro inertial navigation system is installed is started to walk after initial alignment, every 3~4min about 10~20s that stops, on each stop, its speed, acceleration are zero in theory then.But because the influence of systematic error and disturbing gravity field, the velocity amplitude that layout is calculated is not equal to zero, the route that travel is made the laggard line data of zero-speed error measure handle, and obtaining the zero-speed error sequence then is δ V i, utilize the velocity error curve δ V (t) of smooth and continuous of match such as splines.Then, utilize the analytical expression of this matched curve, press δ V (t)=∫ 0δ V (t) dt formula is calculated corresponding site error, and correction position result of calculation, plots the geography information of testing oneself ins error is compensated, and can reach so not stop when executing the task and to make the revised precision of zero-speed the same in parking.
System of the present invention also has following characteristics:
(1) complete function: parameters such as real-time outgoing position, course, can independently determine original state own.
(2) independence is strong: without any external signal the time, system can operate as normal.
(3) degree of accuracy height: absolute fix error (do not stop travel in) is less than 25m, and the initial orientation error is less than 0.05 °, and long-time course keeps precision less than 0.1 °, and the horizontal attitude error is less than 0.01 °.
(4) start rapidly: the preliminary work time was less than 3 minutes.
(5) good concealment: externally unglazed, sound, the radiation of electromagnetism homenergic.
(6) environmental adaptability: chemical contamination and flue dust, strong electromagnetic are had sufficient resistivity, shock-resistant, vibrations, high low temperature working environment, long time continuous working is reliable and stable.
In a word, the present invention has and 1. realizes the zero-speed correction; 2. during many information fusion, mode of operation is various and can be redundant; 3. precision height, the reliability height; 4. the course retention time is long and take a stand and seek advantages such as north is fast.
Adopt the technical solution of the present invention technical indicator to reach:
Bearing accuracy (CEP) :≤30m (travelling continuously)
Orientation accuracy :≤0.05 °
Travel speed :≤80km/h
Start setup time :≤3min
The initial alignment time :≤1min
Time between failures: 〉=2000 hours
Operating ambient temperature :-55 ℃~+ 70 ℃.

Claims (1)

1, vehicle-mounted quick positioning and directing system is characterized in that containing vehicle-mounted laser gyro inertial navigation+odometer+altitude gauge/GPS/GLONASS/BD/ geography information, data processor and software; The input end of the output terminal linking number pick processor of odometer, altitude gauge, GPS/GLONASS/BD and geography information, the output terminal output of data processor also shows geographic coordinate and course angle; Described data processor is carried out the following step:
(1) initial alignment;
(2) obtain mileage information by odometer, simultaneously with odometer duty input number pick processor;
(3) mileage information is resolved in integrated navigation, simultaneously to data processor output information pattern 5;
(4) obtain elevation information by altitude gauge, simultaneously with altitude gauge duty Input Data Process;
(5) carry out altimetric compensation by altitude gauge, and to data processor output information pattern 4;
(6) by 1. electronic chart 2. the geography information of the autonomous mapping of inertial navigation system obtain geography information, simultaneously with geography information duty Input Data Process;
(7) carry out error correction by the longitude and latitude in odometer, the geography information, to data processor output information mode 3;
(8) obtain GPS/GLONASS/BD information, to data processor output information pattern 2; Simultaneously with GPS duty input number pick processor;
(9) by Kalman filtering, to data processor output information pattern 1;
(10) data processor output and demonstration geographic coordinate and course angle.
Described data processor is carried out preference pattern:
Laser gyro inertial navigation+odometer+altitude gauge/GPS/GLONASS/BD/ geography information;
Pure GPS/GLONASS/BD;
Laser gyro inertial navigation+odometer+altitude gauge+geography information;
Laser gyro inertial navigation+geography information;
Mileage information is resolved in integrated navigation.
CNB200510057162XA 2005-07-13 2005-07-13 vehicle-carrying quick positioning and orienting method Expired - Fee Related CN1322311C (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CNB200510057162XA CN1322311C (en) 2005-07-13 2005-07-13 vehicle-carrying quick positioning and orienting method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CNB200510057162XA CN1322311C (en) 2005-07-13 2005-07-13 vehicle-carrying quick positioning and orienting method

Publications (2)

Publication Number Publication Date
CN1731091A CN1731091A (en) 2006-02-08
CN1322311C true CN1322311C (en) 2007-06-20

Family

ID=35963488

Family Applications (1)

Application Number Title Priority Date Filing Date
CNB200510057162XA Expired - Fee Related CN1322311C (en) 2005-07-13 2005-07-13 vehicle-carrying quick positioning and orienting method

Country Status (1)

Country Link
CN (1) CN1322311C (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101900573A (en) * 2010-07-15 2010-12-01 北京理工大学 Method for realizing landtype inertial navigation system movement aiming
CN101290230B (en) * 2008-04-14 2011-03-30 深圳市凯立德软件技术股份有限公司 Road crossing navigation method and navigation system using the navigation method
CN102322858A (en) * 2011-08-22 2012-01-18 南京航空航天大学 Geomagnetic matching navigation method for geomagnetic-strapdown inertial navigation integrated navigation system

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN100419380C (en) * 2007-01-05 2008-09-17 北京航空航天大学 High integral navigation device combined by MIMU/GPS/micromagnetic compass/barometric altimeter
CN101592493B (en) * 2009-07-06 2011-07-27 北京航空航天大学 Course updating method in vehicle navigation system
CN102183254B (en) * 2011-02-21 2012-11-21 戴庆源 Mine location and communication system based on inertial measurement unit and radio low-frequency technology
CN103162689B (en) * 2011-12-16 2016-01-20 希姆通信息技术(上海)有限公司 The assisted location method of auxiliary vehicle positioning system and vehicle
CN104154916B (en) * 2013-08-30 2018-11-30 北京航天发射技术研究所 A kind of vehicle positioning equipment based on the used group of laser gyro strap down
CN104711912B (en) * 2013-12-11 2016-08-24 中航西安飞行自动控制技术有限公司 A kind of high-speed railway mileage is to mark method
CN103791916B (en) * 2014-01-28 2016-05-18 北京融智利达科技有限公司 A kind of combination onboard navigation system based on MEMS inertial navigation
CN104296744A (en) * 2014-09-25 2015-01-21 中国科学院嘉兴微电子与系统工程中心 Vehicle-mounted inertial navigation system
CN105573310B (en) * 2014-10-11 2020-06-26 航天科工智能机器人有限责任公司 Coal mine roadway robot positioning and environment modeling method
CN104316059B (en) * 2014-11-05 2017-08-25 中国科学院嘉兴微电子与系统工程中心 The dead reckoning navigation localization method and system of vehicle longitude and latitude are obtained by odometer
CN105865461B (en) * 2016-04-05 2019-07-12 武汉理工大学 A kind of car position system and method based on Multi-sensor Fusion algorithm
CN107608348B (en) * 2017-09-04 2024-09-24 上海圭目机器人有限公司 Autonomous marking robot system
CN108051839B (en) * 2017-10-27 2021-11-05 成都天合世纪科技有限责任公司 Vehicle-mounted three-dimensional positioning device and three-dimensional positioning method
CN108399789A (en) * 2018-03-28 2018-08-14 成都天合世纪科技有限责任公司 A kind of intelligent parking management system and method
CN111811537B (en) * 2020-07-02 2023-09-08 重庆青年职业技术学院 Error compensation method for strapdown inertial navigation and navigation system

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5928309A (en) * 1996-02-05 1999-07-27 Korver; Kelvin Navigation/guidance system for a land-based vehicle
CN1361409A (en) * 2000-12-23 2002-07-31 林清芳 Enhancement navigation positioning method and its system
CN1362613A (en) * 2002-02-06 2002-08-07 何秀凤 Autonomous positioning and directing navigator
CN1417061A (en) * 2001-10-30 2003-05-14 宋建平 Automobile navigation device
JP2004003904A (en) * 2002-06-03 2004-01-08 Asahi National Broadcasting Co Ltd Position-correcting data supply apparatus for high-precision satellite positioning apparatus

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5928309A (en) * 1996-02-05 1999-07-27 Korver; Kelvin Navigation/guidance system for a land-based vehicle
CN1361409A (en) * 2000-12-23 2002-07-31 林清芳 Enhancement navigation positioning method and its system
CN1417061A (en) * 2001-10-30 2003-05-14 宋建平 Automobile navigation device
CN1362613A (en) * 2002-02-06 2002-08-07 何秀凤 Autonomous positioning and directing navigator
JP2004003904A (en) * 2002-06-03 2004-01-08 Asahi National Broadcasting Co Ltd Position-correcting data supply apparatus for high-precision satellite positioning apparatus

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
GNSS/INU/DMAP组合导航定位技术在车辆导航中的应用 腾继涛 等,中国惯性技术学报,第11卷第1期 2003 *
GNSS/INU/DMAP组合导航定位技术在车辆导航中的应用 腾继涛 等,中国惯性技术学报,第11卷第1期 2003;弹道导弹INS/GNSS/CNS组合导航系统研究 张国良 等,导弹与航天运载技术,第2期 2004 *
弹道导弹INS/GNSS/CNS组合导航系统研究 张国良 等,导弹与航天运载技术,第2期 2004 *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101290230B (en) * 2008-04-14 2011-03-30 深圳市凯立德软件技术股份有限公司 Road crossing navigation method and navigation system using the navigation method
CN101900573A (en) * 2010-07-15 2010-12-01 北京理工大学 Method for realizing landtype inertial navigation system movement aiming
CN101900573B (en) * 2010-07-15 2011-12-07 北京理工大学 Method for realizing landtype inertial navigation system movement aiming
CN102322858A (en) * 2011-08-22 2012-01-18 南京航空航天大学 Geomagnetic matching navigation method for geomagnetic-strapdown inertial navigation integrated navigation system

Also Published As

Publication number Publication date
CN1731091A (en) 2006-02-08

Similar Documents

Publication Publication Date Title
CN1322311C (en) vehicle-carrying quick positioning and orienting method
CN101858748B (en) Fault-tolerance autonomous navigation method of multi-sensor of high-altitude long-endurance unmanned plane
CN102506871B (en) Airborne double-fiber IMU (inertial measurement unit)/DGPS (differential global positioning system) integrated relative deformation attitude measurement device
CN107132563B (en) Combined navigation method combining odometer and dual-antenna differential GNSS
De Agostino et al. Performances comparison of different MEMS-based IMUs
CN111637888B (en) Tunneling machine positioning method and system based on inertial navigation and laser radar single-point distance measurement
CN201955092U (en) Platform type inertial navigation device based on geomagnetic assistance
CN104180803A (en) Non-similar dual-redundancy integrated navigation device applied to unmanned plane
CN107765279B (en) Vehicle-mounted positioning and directional aiming system and method integrating inertia and satellite
CN105571591A (en) Multi-information deep integration navigation micro-system and navigation method
CN113220013A (en) Multi-rotor unmanned aerial vehicle tunnel hovering method and system
US20210035456A1 (en) Unmanned aircraft, and method and system for navigation
CN106093992A (en) A kind of sub-meter grade combined positioning and navigating system based on CORS and air navigation aid
CN103017764A (en) Autonomous navigation and attitude measurement device for high speed train
CN114964221B (en) RTK/UWB/IMU-based multi-unit collaborative indoor and outdoor positioning method
EP1852681A1 (en) Method for elaborating navigation parameters and vertical of a place
CN116839591B (en) Track tracking and positioning filtering system and fusion navigation method of rescue unmanned aerial vehicle
CN110095135A (en) A kind of method and device for development machine positioning and directing
CN105953797A (en) Combined navigation device based on single-axis gyroscope, inclinometer and milemeter and method
CN105466423A (en) Unmanned aerial vehicle navigation system and operation method thereof
CN211012986U (en) Unmanned autonomous cruise vehicle navigation system based on inertial navigation technology
CN101672650A (en) Orienting and locating navigation system in circumstance of electromagnetic interference
CN102589352A (en) Low-cost high-accuracy guidance control device
Mandapat Development and evaluation of positioning systems for autonomous vehicle navigation
Maklouf et al. Trajectory Tracking, Simulation and Shaping of Moving Land Vehicle Using MATLAB, INS and GPS

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
C17 Cessation of patent right
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20070620

Termination date: 20100713