TW448304B - Fully-coupled positioning process and system - Google Patents

Fully-coupled positioning process and system Download PDF

Info

Publication number
TW448304B
TW448304B TW88106585A TW88106585A TW448304B TW 448304 B TW448304 B TW 448304B TW 88106585 A TW88106585 A TW 88106585A TW 88106585 A TW88106585 A TW 88106585A TW 448304 B TW448304 B TW 448304B
Authority
TW
Taiwan
Prior art keywords
gps
navigation
module
kalman filter
fully integrated
Prior art date
Application number
TW88106585A
Other languages
Chinese (zh)
Inventor
Ching-Fang Lin
Original Assignee
Lin Ching Fang
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 Lin Ching Fang filed Critical Lin Ching Fang
Priority to TW88106585A priority Critical patent/TW448304B/en
Application granted granted Critical
Publication of TW448304B publication Critical patent/TW448304B/en

Links

Landscapes

  • Position Fixing By Use Of Radio Waves (AREA)
  • Navigation (AREA)

Abstract

A positioning method and a system are disclosed for measuring a position of a vehicle on land, air, and space, using measurements from a global positioning system receiver and an inertial measurement unit. In the present invention, an integrated Kalman filter processes the all-available measurements of the global positioning system pseudorange, delta range, carrier phase, and the solution of an inertial navigation system. The integrated Kalman filter is a multi-mode, robust kalman filter, in which optimal integrated mode is selected based on the measurement availability and filter stability. The high accurate solution of the inertial navigation system, which is corrected by the Kalman filter, is used to aid on-the-fly resolution of the carrier phase integer ambiguity of global positioning system in order to incorporate the carrier phase measurements into the Kalman filter, and to aid the carrier phase and code tracking loops of the receiver of the global positioning system to improve the receiver jamming and high dynamic resistance.

Description

/14 8 3 0 4/ 14 8 3 0 4

ίο 15 20 經濟部中央梯準局貝工消費合作社印袋 本發明係與-全球定位係統(G1〇bai p〇siti{)ng ,GPS)/惯性測量儀(inerial Mea__脑,麵)组合導 航定位方絲紐幻旨—種完全整合㈣μ ^oupled)、動態(Kinematic)全球定位系統聰生測量儀導航 定位方法和系統,以便提高GPS導引馳地、空中、太空 中之運載體的導航精度。 工 為滿足未來的應用需求,發展一種可靠的、高精度、 體積小、低成本的GPS/慣性測量儀組合導航系統是非常有 必要的;這種組合導航系統應當能在高動態且同時可能有 多種情沉的GPS信號丟失和GPS不良信號的環境中操作, 以便能提高GPS導引之運载體的導航精度。 降低導航系統的成本的主要途徑是使用廉價的傳感器 和部件,這樣,使得組合導肮、制導和控制系統的設計更 加具有挑戰性;傳統的導引運載體的制導導航系統,主要 是惯性導航系統(Inertial Navigation System^INS),它主要由 一慣性測量儀和微外理機組成;INS的主要優點是,它不 需任何外部信息支持,不像其它導航系統,INS不會被敵 方干擾和欺詐,但不幸地是,INS不能提供遠程的高精度 導肮信息;由於慣性傳感器存在誤差,INS誤差隨時間積 累,飛行時間越長,誤差越大,開發和生產陀螺儀的成本 隨它的精度要求而增加;生產高精度的陀螺儀很困難,世 界上只有少數幾個公司有能力生產高精度的陀螺儀,從某 種程度上也反映了高精度INS的陀螺儀的市場極為有限, 因此,INS固有的精度特性,表明它不適於應用於高精度 -3- 本紙張/Ut適用中a國家揉率(CNS ) A4規格(210X297公釐) 83· 3. !0,〇〇〇 I.- I - — Hr I I 裂----------I .線 (請先聞讀背面之注$項再填寫本頁} 經濟部中央梯準局負工消費合作社印装 4483 A7 __B7_ 五、發明说明(2 ) 的戰術導彈,需要輸入外部信息,用於校正INS誤差。 最近在衛星導航技術方面的進展,實現了低成本、高 精度的導航;正在進行的很多研究,正在致力於一種組合 GPS/IMU導航和制導系統,這種系統可用於強干擾和高動 5態的飛行環境中,組合GPS/INS系統可使用於低成本、易 於製造的IMU,顯然可大大降低系統的成本。 因此,在慣性傳感器、GPS精度及組合GPS/IMU系統 等方面的技術進步將會導致出現精度可達到1米的導航系 統;技術挑戰在於提高慣性傳感器和GPS傳感器,以及這 ίο些傳感器最佳組合的軟體和硬體設計;對慣性傳感器來説 ,目前的趨勢是開發光纖陀螺、矽微機械陀螺,振梁加速 度計(Resonating beam accelermometer),妙微機械加速度計 ,利用這些新技術將會產生出低成本高可靠性、重量輕的 新型慣性傳感器,以及使用這些新型慣性傳感器的系統。 15 對GPS精度而言,現有的GPS精密定位服務(Preciseίο 15 20 The printed bag of the Central Laboratories of the Ministry of Economic Affairs, Shellfish Consumer Cooperative, and the present invention are combined with-Global Positioning System (G1〇bai p〇siti {) ng, GPS) / Inerial Measuring Instrument (inerial Mea__ 脑, 面) Integrated Navigation Positioning Fangsi New Magical Purpose-A fully integrated ㈣μ ^ upled, Kinematic Global Positioning System Congsheng measuring instrument navigation positioning method and system, in order to improve the navigation accuracy of GPS-guided carriers in the ground, air and space . In order to meet the future application needs, it is necessary to develop a reliable, high-precision, small, low-cost integrated GPS / inertial measurement instrument integrated navigation system; this integrated navigation system should be capable of being highly dynamic and at the same time possible. A variety of emotional GPS signal loss and GPS bad signal operation in order to improve the navigation accuracy of the GPS guided carrier. The main way to reduce the cost of the navigation system is to use cheap sensors and components, so that the design of the combined guidance, guidance and control system is more challenging; the guidance and navigation systems of traditional guidance carriers are mainly inertial navigation systems (Inertial Navigation System ^ INS), which is mainly composed of an inertial measuring instrument and a micro-processor. The main advantage of INS is that it does not require any external information to support it. Unlike other navigation systems, INS will not be interfered by the enemy and Fraud, but unfortunately, INS cannot provide remote high-precision guidance information; due to errors in inertial sensors, INS errors accumulate over time, the longer the flight time, the greater the error, and the cost of developing and producing the gyroscope depends on its accuracy It is difficult to produce high-precision gyroscopes. Only a few companies in the world are capable of producing high-precision gyroscopes. To some extent, it also reflects that the market for high-precision INS gyroscopes is extremely limited. Therefore, INS's inherent precision characteristics indicate that it is not suitable for high precision applications. S) A4 specification (210X297 mm) 83 · 3.! 0, 〇〇〇〇I.- I-— Hr II split ---------- I. Line (please read the note on the back first) Please fill in this page again} Printed by 4483 A7 __B7_ of the Ministry of Economic Affairs' Central Work Station Consumer Cooperative V. The tactical missile of invention description (2) requires external information to be used to correct INS errors. Recently in satellite navigation technology, Progress has achieved low-cost, high-precision navigation; many ongoing studies are working on a combined GPS / IMU navigation and guidance system, which can be used in high-interference and high-motion 5-state flight environments to combine GPS The / INS system can be used for a low-cost, easy-to-manufacture IMU, which obviously can greatly reduce the cost of the system. Therefore, technological advancements in inertial sensors, GPS accuracy, and combined GPS / IMU systems will lead to accuracy of up to 1 meter. The technical challenge lies in improving the inertial sensors and GPS sensors, as well as the software and hardware design of the optimal combination of these sensors. For inertial sensors, the current trend is to develop fiber optic gyroscopes, silicon micromechanical gyroscopes, Beam accelerometer (Resonating beam accelermometer), Miaowei mechanical accelerometer, the use of these new technologies will produce low cost, high reliability, light weight new inertial sensors, and systems using these new inertial sensors. 15 GPS accuracy In other words, existing GPS precision positioning services (Precise

Positioning Service),具有 16m(S£P,SphericaUrror probable) 的設計精度、l〇m(CEP,Circularerrorprobable)的觀溯精度, 如果多重GPS量測被組合在一個魯棒(Robust)的中心卡爾曼 (Kalman)濾波器,用以更新INS,則精度會更一步提高,·濾 20波器有能力動態校正GPS誤差和慣性誤差,如果濾波器設 計得更好,大大優於8米的導航精度可望達到;對精密制 導和飛機的自動降落,對組合導航系統的精度要求是優於 3米或更好》 提高組合導肮系統精度的技術趨勢是利用動態GPS精 --------―襄------ix----1 > 線’ (諳先閲讀背面之注意事項再填寫本頁) 本紙張尺度適用中國國家梂準(CNS ) A4現格(210X297公釐) 83, 3.1〇.000 448304 經濟部中央棣準局貝工消費合作杜印製 A7 B7 五、發明説明(3 ) 度和開發先進的全整動態GPS_組合導航系統,在全整 合GPS/INS紐+,GPS^M_和龍職環路被慣 性傳感器信息輔助,因而GPS的測量精度和抗干擾能力被 大大提高和加強;在慣性數據的輔助下,Gps的快速相位 5模糊整數搜索和求解、周跳檢测和隔離,將在幾秒鐘内完 成;此外,由於GPS廣域增強技術(WideareaGPS Enhancement)的出現,GPS現有的設計和觀測精度將會進 一步提高。 這樣,設計和開發動態(Kinematic)GPS/INS組合導航 10極富挑戰性,特別之處在於組合導航系統的傳感器硬體和 算法軟體應滿足以下要求: 1、慣性傳感器 目前用於穩定'控制和導航系統的傳感器技術正在外於大 的發展變化之中,這些變化將會使得慣性傳感器更加廣泛 15地應用於軍用和商業方面,設計和製造慣性傳感器的主要 要求是低成本、高可靠性、適當的精度、小尺寸、重量輕 〇 1) 光纖陀螺(Fiber-optic Gyro, FOG) 它是環形激光陀螺(ring lasergyro)的極為經濟的替代品 2〇 ,具有與環形激光陀螺同樣的性能。 2) 妙微機械陀螺(Silicon micro mechnical Gyros) 需要進一步減少矽微機械陀螺的陀螺漂栘,以便 更多應用要求。 3) 振梁加速度計(Resonating beam accelerometer) 本紙張从逋用中困B家揉準(CNS )八4祕(210X297公釐) 83· 3. !〇,〇〇〇 -----:--- I裝------訂----- .線 <請先聞讀背面之注$項再埃寫本頁) 4483 04 經濟部中央橾隼局負工消費合作社印製 A7 B7 五、發明説明(4 ) 4)矽微機械加速度計(Silicon micro mechnicai accelermometers) 2、 GPS接收機 對於GPS接收機的大小,現有的GPS接收機卡 5 (OEM,Original equipment manufacture)的尺寸已遠小於一個 香煙盒,用於導引運载體之GPS接收機的技術發展趨勢是 增強其抗干擾、高動態能力,並降低GPS的測量噪聲,包 括多徑效應(Multipath effects)。 1) 在跟蹤環路帶寬和GPS接收機抗干擾性能之間的折 10 衷設計 2) 短的首次定位時間和信號再捕獲時間 3) 直接、快速的p碼捕獲和跟蹤 4) 碼和載波跟蹤環路的慣性辅助 5) 接收機硬體/軟體的數字信號處理 15 6)抗多徑信號的天線設計 3、 組合系統算法在將來的GPS/IMU組合導航系統中,全 整合設計要求GPS量測和慣性傳感器信息直接在一個中心 導航卡爾曼濾波器中融合,濾波器的输出可輔助GpS接收 機的彳§號跟蹤環路,以便提高其抗干擾能力;因而,技術 20 要求將是 1) 基於多傳感器的系統重構 2) 多模式魯棒(Robust)卡爾曼濾波器 3) 傳感器故障檢测和融離 4) 恢性辅助的運動中(〇n-the-fly)相位模糊求解和周跳 本紙張纽it用tss公兼 83.3.10,000 I. —裝------訂-----線 (請先Μ讀背面之注意ί項再填寫本頁) 4483 0 Μ濟部中央揉準局貝工消费合作社印装 A7 B7 五、發明説明(5 ) (Cyclesiip)檢測。 4、快速傳送對準 正在出現的新技術致力於將來高動態運載體的應用;傳統 上,開發高動態制導的運載體之主要的技術障礙是運載體 5制導系統的成本和復雜性。 本發明之主要目的在於提供一種「完全整合式導航定 位方法和系統」,該系統是一種新的全整合〇1>3/1]^算法 ’它利用GPS載波相位信息’以求解出高精度的時間、空 間位置和速度信息;它提高了 GPS/INS組合導航系統在強 10干擾和高動態環境中的性能者。 本發明之另一目的在於提供一種「完全整合式導航定 位方法和系統」,其中,開發的全整合GPS/INS组合系統 結構,使得有可能從硬體和軟體上實現GPS和INS之間的誤 差互補和輔助’它為實現組合系統的硬體和軟體以及用 15 INS數據辅助GPS,提供了一個性能/價格比較高的方案者 本發明之另一目的在於提供一種「完全整合式導航定 位方法和系統」,其中,實現了一種新的ν_Α(速度一加速 度)辅助GPS信號跟蹤環器的算法,它包括碼跟蹤算法和載 20波跟蹤算法;在這種新的組合GPS/INS系統結構中,Gps 接收機的碼和载波跟蹤0路都可以被INS數據高速率地進 行辅助,從而大大提高了GPS接收機的测量精度、高動態 跟蹤能力、以及抗干擾能力者。 本發明之另一目的在於提供一種「完全整合式導航定 本紙張尺度適用中囷國家梯準(CNS ) A4規格(210X297公釐} 83.3.10,000 ---------- I裂------訂----- .線 (請先閱讀背面之注f項再嗔寫本頁:> 經濟部中央標準局貝工消资合作社印製 A7 B7 五、發明説明(6 ) ~ 位方法和紐」,其中,開發出—種賴^^輔助的寬道 (widelane)載波相位模糊求解動態(〇rHhe_fly)算法,可為組 合導航卡爾曼濾波器提供精確的載波相位測量,這種方法 也可大大降低模糊整數求解的搜索時間,以及提高模糊整 5 數求解精度者。 本發明之另一目的在於提供一種「完全整合式導航定 位方法和系統」,其中,以實時方式實現了一魯棒組合導 航卡爾曼濾波器;該濾波器更加有效地利用了所有的量測 信息和先驗信息(priorinfonnadoii),用以確定和校正系統誤 10差’其量測1¾息包括GPS偽距(Pseudorange)偽距率 (daltarange),载波相位(carrierphase)者。 本發明之另一目的在於提供一種「完全整合式導航定 位方法和系統」,其中,發展了一種為飛機INS和武器 (Munition)INS快速傳送對準的新算法,它用以除去戰術武 15器的初始位置、速度和姿態誤差者。 本發明之另一目的在於提供一種「完全整合式導航定 位方法和系統」,其中,實現了 一個實時動態GPS/IMU組 合導肮軟件,它可為發展不同水平的GPS/TMU組合導航系 統提供一個工具,這些不同水平的GPS/IMU組合導航系統 20可適應不同的應用場合者。 本發明之另一目的在於提供一種「完全整合式導航定 位方法和系統」,其中,設計一導肮計算機系統,該系統 直接面向軍用/民用/政府的應用場合,包括打擊武器,無 人飛行器及其它航空電子平台者。 本紙张尺度適用中國國家標率(CNS ) A4規格U10X2»7公釐) S3.3.10,000Positioning Service), with a design accuracy of 16m (S £ P, SphericaUrror probable), and traceability accuracy of 10m (CEP, Circularerrorprobable), if multiple GPS measurements are combined in a robust Robust center Kalman ( Kalman) filter, used to update the INS, the accuracy will be further improved. · 20 wave filter has the ability to dynamically correct GPS and inertial errors. If the filter is better designed, the navigation accuracy is much better than 8 meters. Achieved; for precision guidance and automatic landing of aircraft, the accuracy requirements for integrated navigation systems are better than 3 meters or better. The technical trend to improve the accuracy of integrated guidance systems is to use dynamic GPS precision ------------ Xiang ------ ix ---- 1 > Line '(谙 Please read the notes on the back before filling this page) This paper size is applicable to China National Standard (CNS) A4 (210X297 mm) 83 , 3.1〇.000 448304 A7 B7, printed by DuPont Consumer Cooperative of Central Bureau of Standards, Ministry of Economic Affairs 5. Description of invention (3) Degree and development of advanced full integrated dynamic GPS_ integrated navigation system, fully integrated GPS / INS New Zealand + , GPS ^ M_ and Longzhi Loop are assisted by inertial sensor information Therefore, the measurement accuracy and anti-interference ability of GPS have been greatly improved and strengthened. With the aid of inertial data, the fast phase 5 fuzzy integer search and solution of GPS, cycle slip detection and isolation will be completed in a few seconds; With the advent of WideareaGPS Enhancement, the existing GPS design and observation accuracy will be further improved. In this way, designing and developing a dynamic (Kinematic) GPS / INS integrated navigation 10 is extremely challenging, and the special thing is that the sensor hardware and algorithm software of the integrated navigation system should meet the following requirements: 1. Inertial sensors are currently used to stabilize 'control and Navigation system sensor technology is undergoing major development changes. These changes will make inertial sensors more widely used in military and commercial applications. The main requirements for designing and manufacturing inertial sensors are low cost, high reliability, and appropriateness. (1) Fiber-optic Gyro (FOG) It is a very economical alternative to ring lasergyro. It has the same performance as ring laser gyro. 2) Silicon micro mechnical Gyros need to further reduce the gyro drift of silicon micro mechnical Gyros in order to meet more application requirements. 3) Resonating beam accelerometer This paper has been used in a difficult way, and it is not easy to use (CNS), 8 secrets (210X297 mm) 83. 3.! 〇, 〇〇〇 -----:- -I install ------ Order -----. Line < Please read the note on the back before writing this page) 4483 04 Printed by A7, Central Office of the Ministry of Economic Affairs B7 V. Description of the invention (4) 4) Silicon micro mechnicai accelermometers 2. The size of the GPS receiver for the GPS receiver, the size of the existing GPS receiver card 5 (OEM, Original equipment manufacture) has been Much smaller than a cigarette case, the technical development trend of GPS receivers used to guide carriers is to enhance their anti-interference, high dynamic capabilities, and reduce GPS measurement noise, including multipath effects. 1) 10 compromise design between tracking loop bandwidth and GPS receiver anti-jamming performance 2) Short first positioning time and signal reacquisition time 3) Direct and fast p-code acquisition and tracking 4) Code and carrier tracking Inertial assistance of the loop 5) Digital signal processing of receiver hardware / software 15 6) Antenna design against multipath signals 3, Integrated system algorithm In the future GPS / IMU integrated navigation system, fully integrated design requires GPS measurement The information of the inertial sensor and the inertial sensor are directly fused in a central navigation Kalman filter, and the output of the filter can assist the GpS receiver's tracking loop in order to improve its anti-interference ability; therefore, the technology 20 requirement will be 1) based on Multi-sensor system reconstruction 2) Multi-mode Robust Kalman filter 3) Sensor fault detection and fusion 4) Recovery-assisted motion (On-the-fly) phase fuzzy solution and cycle slip This paper button uses tss and 83.3.10,000 I. —Installation ------ Order ----- Thread (please read the note on the back before filling this page) 4483 0 Printed by the Zhuhai Bureau Shellfish Consumer Cooperative A7 B7 V. Description of Invention (5) (C yclesiip) detection. 4. Fast transfer alignment New emerging technologies are devoted to the application of highly dynamic carriers in the future; traditionally, the main technical obstacle to the development of highly dynamic guided carriers is the cost and complexity of the carrier 5 guidance system. The main object of the present invention is to provide a "fully integrated navigation positioning method and system", which is a new fully integrated 〇1 > 3/1] ^ algorithm 'it uses GPS carrier phase information' to solve high-precision Time, space position and speed information; it improves the performance of GPS / INS integrated navigation system in strong 10 interference and high dynamic environment. Another object of the present invention is to provide a "fully integrated navigation positioning method and system", in which the developed fully integrated GPS / INS combined system structure makes it possible to realize the error between GPS and INS from hardware and software Complementarity and assistance 'It provides a high performance / price solution for the hardware and software of the combined system and GPS with 15 INS data. Another object of the present invention is to provide a "fully integrated navigation and positioning method and "System", in which a new ν_Α (velocity-acceleration) assisted GPS signal tracking loop algorithm is implemented, which includes a code tracking algorithm and a 20-wave carrier tracking algorithm. In this new combined GPS / INS system structure, Both the GPS receiver code and carrier tracking channel 0 can be assisted by the INS data at a high rate, which greatly improves the GPS receiver's measurement accuracy, high dynamic tracking capability, and anti-interference ability. Another object of the present invention is to provide a "fully integrated navigation standard paper size applicable to the Chinese National Standard (CNS) A4 specification (210X297 mm) 83.3.10,000 ---------- I crack- ---- Order -----. (Please read the note f on the back before writing this page: > Printed by A7 B7, Shellfish Consumer Cooperatives, Central Bureau of Standards, Ministry of Economic Affairs. 5. Description of Invention (6) ~ Bit method and button ", among which, a kind of widelane carrier phase ambiguity resolution dynamic (〇rHhe_fly) algorithm assisted by ^^ is developed, which can provide accurate carrier phase measurement for integrated navigation Kalman filter. This method can also greatly reduce the search time for solving fuzzy integers and improve the accuracy of solving fuzzy integers. Another object of the present invention is to provide a "fully integrated navigation and positioning method and system" in which the real-time method is implemented A robust integrated navigation Kalman filter; this filter makes more effective use of all measurement information and prior information (priorinfonnadoii) to determine and correct 10 errors in the system's measurement, including GPS pseudorange (Pseudorange) pseudorange rate (d altarange) and carrierphase. Another object of the present invention is to provide a "fully integrated navigation and positioning method and system", in which a new method for rapid transmission alignment of aircraft INS and weapons (Munition) INS is developed. Algorithm, which is used to remove the initial position, speed, and attitude errors of the tactical weapon. Another object of the present invention is to provide a "fully integrated navigation positioning method and system", in which a real-time dynamic GPS / IMU is implemented Integrated guidance software, which can provide a tool for the development of different levels of GPS / TMU integrated navigation systems, these different levels of GPS / IMU integrated navigation system 20 can be adapted to different applications. Another object of the present invention is to provide a "Fully integrated navigation and positioning method and system", in which a guidance computer system is designed, which is directly oriented to military / civilian / government applications, including strike weapons, unmanned aerial vehicles and other avionics platforms. This paper applies to China National Standard (CNS) A4 size U10X2 »7mm) S3.3.10,000

-----^--- —^------*------ ,捧 (請先聞讀背面之注f項再填窝本頁J 經濟部中央棣率局貝工消費合作社印製 4483 04 A7 ______B7 五、發明説明(7 ) 本發明另一目的在於提供一種「完全整合式導航定位 方法和系統」’它不僅為提高用於制導運载體的導航系統 之精度的努力方向,提供了—個堅實的基礎和強有力之工 具’而且為設計用於高動態運載體的導航系統所面臨的確 5點,提供了新的研究方向者。 為實現上述之目的,本發明採用了下列新的技術措施 1、最佳組合模式:位置和速度(P_V)組合方法,沒有 IMU輔助GPS跟蹤環路的偽距和偽距率組合方法v + 10 Δθ) ’沒有IMU輔助GPS跟蹤環路的動態組合ρ +(^/Δ ν +么0方法,有1^輔助〇?3跟蹤環路的的(/3仏^;+^沒) 組合方法,擁有IMU辅助GPS跟蹤環路的動態組合ρ +0/ Λ t; + Δ Θ方法,比較現有不同的組合方法,得出全整合 動態GPS/MU組合導航系統的最佳組合模式。 15 2、Gps跟蹤環路的慣性輔助的新技術:GPS/IMU組合 導航系統的發展趨勢是開發全整合動態GPS/IMU組合系統 ,其中’ GPS接收機的碼和載波跟蹤環路受來自_數據 的輔助;在本發明中,開發了最新的]MU輔助GPS跟蹤環 路的算法,用以提高GPS在戰術高動態環境中的測量精度 2〇和坑干擾能力。 3、新的慣性辅助的載波相位模糊整數求解技術:高 動態之動態GPS導航受制於即時求解载波相位模糊整數的 能力;IMU輔助的寬道載波相位模糊整數求解方法可大大 縮短在高動態環境下模糊整數求解的搜索時間和提高求解 _9_ 本紙張揉準(CNS) (21()><297公瘦) II-------裝------訂----- ,線 (請先Μ婧背面之注意事項再填寫本頁) 4483 0 經濟部中央標準局員工消費合作社印製 A7 B7 五、發明説明(8) 的精度,這種方法也可用於單頻動態GPS測量的載波相位 模糊整數的求解。 4、 魯棒的中心組合卡爾曼濾波器:開發一個可靠的 魯棒、自適應卡爾曼濾波器,它可運行於多種動態環境, 5以便能預測實際系統的性能;這種濾波器的結構與通常的 卡爾曼濾波器相比,有許多優點,如大的收斂區域,平滑 的過度過程,以及當某些狀態被凍結時,如當時鐘和高度 保持時,更保守的建模;此外,這種動態GPS/IMU組合算 法的中心濾波方案,也避免了濾波器驅動濾波器方案的濾 10 波器之不穩定問題。----- ^ ----^ ------ * ------, hold (please read the note f on the back before filling in this page. Printed by the consumer cooperative 4483 04 A7 ______B7 V. Description of the invention (7) Another object of the present invention is to provide a "fully integrated navigation and positioning method and system", which is not only used to improve the accuracy of the navigation system used to guide the carrier. The direction of the effort provides a solid foundation and powerful tools' and provides a new research direction for the design of the 5 points facing the navigation system for highly dynamic carriers. In order to achieve the above purpose, the present invention The following new technical measures were adopted: 1. The best combination mode: position and velocity (P_V) combination method, pseudo range and pseudo range rate combination method without IMU assisted GPS tracking loop v + 10 Δθ) 'No IMU assisted GPS tracking Dynamic combination of loops ρ + (^ / Δ ν +? 0 method, with 1 ^ auxiliary 0? 3 tracking loop (/ 3 仏 ^; + ^ no) Combination method, with IMU assisted GPS tracking loop Dynamic combination ρ + 0 / Λ t; + Δ Θ method, comparing the existing different combination methods to get fully integrated dynamic GPS / MU integrated navigation system best combination mode. 15 2. New inertial assistance technology of GPS tracking loop: The development trend of GPS / IMU integrated navigation system is to develop a fully integrated dynamic GPS / IMU integrated system, of which 'GPS receiver The code and carrier tracking loop are assisted by data; in the present invention, the latest] MU-assisted GPS tracking loop algorithm is developed to improve GPS measurement accuracy in tactical high dynamic environments. Interference ability 3. New inertial-assisted carrier phase fuzzy integer solution technology: High dynamic dynamic GPS navigation is limited by the ability to solve carrier phase fuzzy integer solution in real time; IMU-assisted wide-channel carrier phase fuzzy integer solution method can greatly reduce Search time and improvement of fuzzy integer solution in dynamic environment _9_ This paper is accurate (CNS) (21 () > < 297 public thin) II --------------------- Order- ----, line (please fill in the notes on the back of M Jing before filling out this page) 4483 0 Printed by A7 B7, Consumer Cooperatives of the Central Standards Bureau of the Ministry of Economic Affairs 5. The accuracy of the invention description (8), this method can also be used for Single-frequency dynamic GPS measurement Solution of wave phase fuzzy integers 4. Robust central combined Kalman filter: Develop a reliable, robust, adaptive Kalman filter that can run in a variety of dynamic environments, 5 in order to predict the performance of actual systems; The structure of this filter has many advantages over the usual Kalman filter, such as a large convergence area, a smooth transition process, and more conservative when certain states are frozen, such as when the clock and altitude are maintained In addition, the central filtering scheme of this dynamic GPS / IMU combination algorithm also avoids the instability problem of the filter-driven filter scheme.

5、 快速傳送對準:在發展新一代使用低成本tMU的 組合導航制導系統中,最富挑戰性的研究課題是發展一種 能用於高動態飛行環境中之全整合動態GPS/IMU組合導航 系統;全整合的含意是IMU和GPS可直接互相補償,IMU 15得出的速度和加速度信息能被用於輔助GPS接收機的碼和 載波鎖相環路,以便跟蹤具有都普勒(D叩pier)頻移的GPS 衛星信號;反過來,具有長期穩定性的高精度GPS位置和 速度信息又可用於補償和校正IMU傳感器的偏置和漂移誤 差’已有不同水平的硬體和軟體組合方法以滿足應用於不 20同場合的GPS/IMU組合的目的;依據傳統的分類方法,組 合系統的結構可分為兩類:鬆耦合和緊耦合系統;通常, 鬆耦合系統有對GPS和INS的明確定義和要求,例如:鬆耦 合系統需要有來自GPS和INS的獨立的導航參數;但是對於 緊耦合,從獲得GPS和IMU測量的觀點來説,常常易發生 -10- 本紙張尺度適用中國國家標準(CNS ) A4規格(21〇X297公釐) 813.10,000 ^^1- ^^^1 UK H— ^^^1 ^ HI ^^^1 ^^^1 ,-^eJnn ^^^1 I · (請先閲讀背面之注意事項再填寫本頁) “83 04 A7 B7 鯉濟部中夬棣率局貝工消費合作,杜印製 -11-5. Fast transmission alignment: In the development of a new generation of integrated navigation guidance systems using low-cost tMU, the most challenging research topic is to develop a fully integrated dynamic GPS / IMU integrated navigation system that can be used in high dynamic flight environments. ; The meaning of full integration is that the IMU and GPS can directly compensate each other. The speed and acceleration information obtained by IMU 15 can be used to assist the GPS receiver's code and carrier phase-locked loop in order to track the signal with Doppler (D 叩 pier ) Frequency-shifted GPS satellite signals; in turn, high-precision GPS position and speed information with long-term stability can be used to compensate and correct offset and drift errors of IMU sensors. 'There are different levels of hardware and software combination methods to Meet the purpose of GPS / IMU combination applied in 20 different occasions; according to the traditional classification method, the structure of the combined system can be divided into two categories: loosely coupled and tightly coupled systems; usually, loosely coupled systems have a clear definition of GPS and INS Definitions and requirements, for example: loosely coupled systems require independent navigation parameters from GPS and INS; but for tightly coupled, from the standpoint of obtaining GPS and IMU measurements, Often easy to happen-10- This paper size applies Chinese National Standard (CNS) A4 specification (21 × 297 mm) 813.10,000 ^^ 1- ^^^ 1 UK H— ^^^ 1 ^ HI ^^^ 1 ^ ^^ 1,-^ eJnn ^^^ 1 I · (Please read the precautions on the back before filling in this page) "83 04 A7 B7 Shellfish Consumer Co-operation with Zhongli rate Bureau of the Ministry of Carp Economics, Du printed -11-

五、發明説明(9 ) 混淆,例如:無論是將偽距還是載波相位融合進組合卡爾 曼濾波器,都會導致對GPS接收機之不同要求和不同的數 據處理算法,IMU和GPS接收機之間的信息流動依賴於 GPS/IMU之不同組合水平;因此,從信息融合的觀點,將 5 GPS/IMU組合系統分為五類 A: GPS/IMUP-V組合模式 傳統上’這種組合換式被稱為鬆福合結構;在這種結 構中,GPS和INS被任為是兩種獨立的導航系統,如第一圖 所示·’組合導肮參數是由一個分離的組合導航卡爾曼濾波 10器給出的,該濾波器直接利用GPS和INS分別得出的導航參 數(位置、速度、時間、姿態)’ GPS接收機的位置和速度 .可周期性地校正INS的導航參數;理論上,如果gps接收機 的軟體和硬體能被適當設計,IMU得出的V-A參數能辅助 GPS接收機的跟蹤環路,但是,實際上這種辅助是困難的 15 ’因為這種鬆耦合結構存在一個級聯(CascadedFilter)遽波 器的性能限制,以致組合卡爾曼濾波器不能為GPS跟蹤環 路提供高速的辅助數據;這種GPS/INSP-V組合系統的一個 缺點是,相關的量測數據會降低級聯卡爾曼濾波器的性能 ’設計必須是非常小心的,以便保證GPS濾波器输出的時 20間相關的數據,不會導致組合導航濾波器的不穩定;另外 一種缺陷是在載體經歷動態時,GPS濾波器常會出現大的 誤差,這種情況下,GPS接收機迫切需要來自INS的輔助, 這樣又會進一步使相關性問題更為嚴重,但是鬆耦合系統 的明顯優點是,能利用市場上現成的硬體和軟體,可以較 83,3,10,000 -----^--- I¢------1T----- -0 (請先S讀背面之注意事項再填寫本页) 么483 04 A7 B7 五、發明説明(1〇) 10 15 20 經濟部t央橾丰局貝工消費合作杜印t 為容易地組成一個組合系統。 B:無GPS跟蹤環路辅助的GPS/IMU(pMr + A0)組 合模式 在這種組合方式中,組合導航卡爾曼濾波器直接處理 來自GPS和IMU傳感器的原始測量數據,如GPS的偽距、 偽距率測量和IMU的加速度和角速率測量,因而中心導航 濾波器能給出系統唯一的導航參數,第二圖顯示出這種組 合模式的結構。 這種組合方式與鬆耦合方式相比,可大幅度地提高組 合導航系統的精度;但是這種組合不能增強GPS跟蹤環路 的動態跟蹤性能力,因為沒有進行GPS接收機跟蹤環路的 辅助’這種方法的主要優點是市場上幾乎所有的Gps接收 機,都可用於這種組合方式,不需要對GPS接收機有特殊 需求。 C:有GPS跟以環路辅助的GPS/IMUOMv + A Θ)組合模式 傳統上,這種組合方式被稱為緊耦合,這種組合方式 與B方式的最明顯的區別是信息融合的水平以及對接收機 的要求;這種組合模式要求GPS接收機必須可以從組合導 航卡爾曼濾波器中接收辅助信息,以便於輔助Gps接收機 的信號跟蹤環路’而且卡爾曼濾波器必須能輸出輸出高速 率的速度和加速度信息,以便GPS接收機可進行辅助處理 ,第三圖示出這種組合方式的結構。 這種組合方式以更加緊密的組合方式,更為有效地利 --------.—^------ΤΓ----- ▲ (請先閲讀背面之注^^項再填寫本頁) -12- 83.3.10,000 經濟部中央標準局貝工消費合作社印製 448304 A7 _B7 五、發明説明(11) 用GPS和IMU信息’來確定和補償系統誤差;它能在高動 態和干擾環境中下,提供更加精確的導航信息,因此,其 性能要優於前面的兩種組合系統,在這種組合方式中, GPS信號跟蹤環路的設計對GPS接收機之硬體和軟體均提 5出一定的要求,以便能從導航濾波器接收速度和加速度(V- A)辅助信息,這種組合方式的主要優點是提高了GPS接收 機的高動態跟蹤能力和抗干擾能力;從系統設計的觀點來 看,其難點在於GPS接收機的數位信號處理、跟蹤環路的 輔助設計以及數據交換及系統組合。 10 D:無GPS跟蹤環路輔助GPS/IMU的ρ ν + Λ Θ组合模式 這種組合模式類似於上述模式Β,如第四圖所示;區 別在於這種組合模式有一種新的信息融合方式,即利用動 態(Kmematic)GPS技術,以便提高GPS測量數據的精度。 15 GPS載波相位測量可獲得亞厘米(Sub-Centimeter)級的 測量精度;但是由於在载波相位测量中存在相位整數模糊 和周跳(Cycieslip),限制了使用載波相位獲得高精度定位數 據的能力,特別在高動態環境中,動態載波相位模糊求解 和周跳檢測很困難,一但相位模糊和周跳問題得已解決, 2〇這種組合方式要比上述其它系統能獲得更高的定位精度; 此外’這種組合方式,除要求GPS接收機能提供載波相位 量測外’並沒有其它特别的要求;這種組合方式的主要缺 點是不能提高GPS接收機的動態跟蹤能力。 E:有GPS跟蹤環路輔助的GPS/IMUp+孕/Λν + Λ -13- 本紙張尺变適用中國國家梯準(CNS ) Α4規格(210X297公釐) -----:--- 裝------訂----- ,線 (請先《读背面之注意事項再填窝本頁) Α7 Β7 經濟部中央梯準局貝工消費合作社印1. 五、發明説明(12) θ組合模式 我們稱造種組合模式為全整合模式,在這種模式中, GPS的所有能獲得之量測和MU量測在—中心導航卡爾曼 濾波器中被組合處理;組合之後得出的速度和加速度信息 5被用來辅助GPS接收機的碼和载波跟蹤環路,以便於提高 GPS接收機在高動態環境下的動態跟蹤能力和抗干擾能力 ,研制這樣的動態GPS/IMU組合導航系統是目前的技術難 點’這種組合方式會更大地提高組合導航系統的精度、可 靠性、動態能力以及抗干擾能力。 10 在過去,用於GPS/IMU的動態組合方式已有效地應用 在低動態環境和航空攝影方面;然而,在以上述方式£實 現的動態GPS/INS組合系統中,僅考慮了相位模糊求解和 周跳檢測問題,沒有進一步考慮IMU速度和加速度信息如 何用來輔助GPS接收機的跟蹤環路(延遲鎖定環路或瑪^ 15 /DLL和鎖相環路MX),但是,這種組合方式僅能在Gps信 號得到的情況下,可提高組合導航系統的精度,並對_P 誤差進行補償’不能提高GPS的動態跟蹤性能;在這種組 合方式中,IMU為GPS接收機提供估計的位置和速度,用 以降低相位模糊求解的搜索空間,一但GPS接收機對Gps 20信號失鎖,GPS接收機和IMU傳感器之間,就沒有進—步 的聯繫了。 ’ 根據相應的性能價格比、兩者的協作性以及系統實現 和柔性,上述每一種組合方式均有它的優點;但是,用在 現有組合系統中的量測主要是GPS的偽距和偽距率以及 -14- 本紙iiH制 t 關㉟準(CNS ) A4^· ( 210X297公釐) "~~~' --- 83.3.10,000 ^1- -I ^^1 H ^^1 i n^i ^^1 ^^1 I i-Ji i ^^1 ^ϋ· 11 ^^1 I. r (請先閲读背面之注意事項再填寫本頁) 4483 04 A7 B7_ 五、發明説明(U) — _的加速度和角速率信息,IMU得出的速度主要用來輔 助載波頻率跟蹤環路的頻率鎖定(在碼匹配之前,移去都普 勒頻移),以便於碼延時测量,並非是為了載波相位測量; 因而’測距精度受制於碼跟蹤環路的帶寬和分辨率,特別 5是在高動態的環境下,為捕獲GPS信號,GPS接收機的無 輔助的載波跟蹤環路的帶寬須足夠大,以便於適應由高動 態所引起的GPS信號頻率和相位的快速變化,如果沒有外 部輔助’要達這一目的是相當困難的,因為使用更寬的帶 寬’將會導致進入跟蹤環的干擾噪過大。 10 在本發明中,開發了一個完全整合動態GPS/IMU組合 導航算法(FCKGA),它利用了本發明中開發的獨特技術, 如魯棒的中心卡爾曼濾波器,MU輔助的動態寬道相位模 糊整數求解,IMUV-A辅助的跟蹤環路。 FCKGA的成功開發導致了 一個先進的導航系統,該系 15統具有以下特點: 1) 硬體水平的餘度 在全耦合組合方式,GPS接收機僅是組合導航系統其 中的一個傳感器(GPS陀螺和加速度運),對GPS導航計算來 説,至少跟蹤4顆衛星的要求被大大放寬了,通過容錯軟 20體(Fault-T〇lerant Software)的設計,硬體水平的餘度有助於 經濟部中央標準局員工消费合作社印製 增強整個系統的可靠性。 2) 使用低成本的IMU傳感器 在基於FCKGA的系統中,精確的定位結果可在空中對 IMU傳感器誤差進行校正,這樣在組合導航系統中,可使 -15- 83.3.10,000 本紙張尺度適用中國國家標率(CNS ) A4規格(2丨0X297公釐) 44B3 04 經濟部中央標準局員工消費合作社印製 A7 B7 五、發明説明(14 ) 用低成本的非慣性級的慣性傳感器。 3) 最小的跟蹤環路帶寬和高度的抗干擾性能 在完全整合模式下,組合導航濾波器的V-A參數被轉 换為沿組合導航系統到GPS衛星之視線方向的V-A信息, 5並將之高速率地反饋給GPS接收機的信號處理機,用以補 償高動態的影響;這樣跟蹤環路的帶寬可降到最小,以便 阻止不希望的干擾噪聲進入跟蹤環路。 4) 動態、快速的相位模糊求解和周跳檢測 該組合導航系統之精確的定位數據,可用來計算衛星 10和導航系統之間的距離,計算的距離與測量的距離相比較 ,其結果可用來檢測周跳以及降低相位模糊求解的搜索空 間。 5) 高的導航精度 該組合導航系統使用具有厘米測量精度的動態GPS技 15術,明顯地提高了導航精度’ 一旦大氣延遲,選擇可用性( 使用雙頻和授權的GPS接收機),以及相位模糊求解和周跳 問題被解決,則組合導航系統的導航誤差,僅依賴於_ 傳感器誤差的被補償的程度,組合導肮系統同時並執行 MU動態校正和對準,這樣,組合導航的输出數據率等於 20 INS的數據輸出率。 " 圖不説明: 第一圖:係GPS/INSP-V組合模式的結構。 第二圖:係無GPS跟蹤環路辅助之gps/IMU〇 /λ ϋ + Α Θ)組合模式的結構。 -16- 本紙張尺度適用中國國家標準(CNS ) A4規格(210X297公着) 83. 3.10,000 I---— ^—^1— -.^1 -------- ^ ----- (請先閲讀背面之注^^項再填寫本頁) 4483 04 A7 B7 五、發明説明(15) 10 15 第三圖:係有GPS跟蹤環路辅助之GPS/IMU(pMt; + △ β )組合模式的結構。 第四圖:係無GPS跟蹤環路輔助之GPS/IMU(p +0/Λ v + Λ Θ )組合模式的結構。 第五圖:係有GPS跟蹤環路輔助之GPS/IMU(p +0/Δ v + Δ 0 )組合模式的結構。 第六圖:係INS辅助之DPLL方塊圖。 第七圖:係IMU辅助的碼跟蹤環器之模型的方塊圖。 第八圖:係_辅助之動態相位模糊求解方塊圖。 第九圖:係慣性導航計算框圖。 第十圖:係組合卡爾曼濾波器之方塊圖。 第十一圖:係完全整合式定位系統之方塊圖。 圖號説明: 5-慣性測量裝置 10-GPS RF/IF模塊 20-載波和碼跟蹤環路 201、202、203、204-混合器 請 先 聞 之 注 ! 裝 訂 20 經濟部中央標準局員工消費合作社印裝 205、206-累加器 208-環路濾波器 2010-載波尺(:0 2012-DLL鑒相器 2014、2015-相加器 2017-碼產生器 40-導航解算 207-载波相位鑒相器 209-相加器 2011-相關器 2013-低通濾波器 20164|NCO 30-導航信息解碼 401-姿態矩陣計算模塊 402-姿態矩陣變換模塊403-姿態角計算模塊 -17- 本紙張尺度適用中國國家標準(CNS ) Α4规格(210父29:?公釐) 83. 3.10,000 線 4483 04 經濟部中央橾準局貝工消費合作社印裂 A7 ____B7______五、發明説明(16 ) 404-導航計算模塊 50-载波相位模糊整數求解 501- 電離層和對流層信號傳播模型和衛星時鐘模型 502- 衛星預測模塊 5〇3-多模式周跳檢測和修復模塊 5 504-多模式载波相位模糊整數求解模塊 60-組合卡爾曼濾波器601-指令 6〇2-數據 603-模式選擇模塊 604- 組合導航系統重構模塊 605- 導航求解的魯棒卡爾曼濾波器 10 606-導航結果的協方差分析 801- GPSRF 模塊(U0) 802- GPS數位信號處理模塊(υυ 803- 集中處理式導航卡爾曼濾波器^j2) 804- 接口模塊 805-定時信號合成模塊(U4) 15 S06-MU數據探樣模塊(U5) 本發明為空中、陸地和太空的運载體提供了一種完全 整合式定位方法和系統,它使用來自Gps和慣性测量儀之 量測信息,以便於提高導航性能。 請參閲第五圖所示,係本發明提供之一種全整合式定 20 位方法,包括下列步驟: 1) 從-慣性測量儀表接收運__速率和加速率信 息、或從其它外部傳感器接收運載體的位置、速度、姿態 測量,計算IMU導航算法的初始值: " 2) 接收GPS的RF(Radi〇 frequency)信號,導出⑽的偽 ^ιϋ^ιι!ι^ί— K m^—— -線 (請先閲讀背面之注f項再填寫本頁) -18- 本紙張从朝中關家鰣(CNS ) A4胁「21Qx297:^-~~~——~-3-31~〇-〇 αα83 04 Α7 Β7 五、發明説明(17 ) 10 15 20 經濟部央棣準局負工消費合作社印製 距、偽距率和载波相位測量; 3)接收來自燃測域的触率帅速度信息、求解 導航万程,得出慣性導航參數,如位置、速度、姿態等。 、4)混合GPS偽距、偽料、載波相健量、以及慣性 導航參數,獲得全整合式定位信息。 為了獲得更好的性能,在第2步隸中,Gps信號是由 GPS接收機籠波鎖树路和碼職環路跟蹤之接收 機的載波輸㈣《環路是由來自第4步驟的完全 整合式的定位信息進行辅助處理的。 為了獲得更好_能’絲3娜巾,紐導航參數 的誤差可由第4步财得㈣紐_錄録的最佳估 計進行誤差補償= 為了獲得更好的性能,在第2步驟進__步包含一個處 理f驟(fA) ’㈣缝擁_錄轉糊跳檢測,以 便能將焉精度的載波相位難,納入第4步驟的混合處理 0 為了獲得更好的性能,第2步驟進一步包含一個外理 步驟’即縣自第4步觀出之全整合的定健息輔助载 波相位模糊整數求解和周跳檢測處理。 為了獲得更好的性能,第4步驟可採用—卡爾曼滴波 器。 為了獲得更好的性能,第4步驟可探用一多摸式卡爾 曼濾波器。 為了獲得更好的性能,第4步驟可採用一個魯棒 t —^Itr11----,^- (請先聞讀背面之注意事項再填寫本頁) -19-V. Description of the invention (9) Confusion, for example: whether fusion of pseudorange or carrier phase into the combined Kalman filter will result in different requirements for GPS receivers and different data processing algorithms, between the IMU and the GPS receiver The flow of information depends on the different combined levels of GPS / IMU; therefore, from the perspective of information fusion, 5 GPS / IMU combined systems are divided into five categories A: GPS / IMUP-V combined mode is traditionally 'this combined conversion is It is called Songfuhe structure; in this structure, GPS and INS are regarded as two independent navigation systems, as shown in the first figure. 'The combined guidance parameter is a separate integrated navigation Kalman filter10 Given by the GPS receiver, the filter directly uses the navigation parameters (position, speed, time, attitude) derived from GPS and INS, respectively. The position and speed of the GPS receiver. The navigation parameters of INS can be corrected periodically; in theory, If the software and hardware of the GPS receiver can be properly designed, the VA parameters obtained by the IMU can assist the tracking loop of the GPS receiver. However, this assistance is actually difficult. 15 'Because of this loosely coupled structure, The performance limitation of Cascaded Filters makes the combined Kalman filter unable to provide high-speed auxiliary data for the GPS tracking loop. One disadvantage of this GPS / INSP-V combined system is that the related measurement data Will reduce the performance of the cascaded Kalman filter. 'The design must be very careful to ensure that the GPS filter's output data is not related to the instability of the integrated navigation filter. Another drawback is that the carrier experiences When dynamic, GPS filters often have large errors. In this case, the GPS receiver urgently needs the assistance from INS, which will further make the correlation problem more serious, but the obvious advantage of the loosely coupled system is that it can use Off-the-shelf hardware and software can be compared to 83,3,10,000 ----- ^ --- I ¢ ------ 1T ----- -0 (Please read the precautions on the back first (Fill in this page again) Mod 483 04 A7 B7 V. Description of the invention (10) 10 15 20 The Ministry of Economic Affairs, Central Bureau of Fengfeng, Shellfish Consumer Cooperation, Du Yint, to easily form a combined system. B: GPS / IMU (pMr + A0) combination mode without GPS tracking loop assistance In this combination, the integrated navigation Kalman filter directly processes the raw measurement data from GPS and IMU sensors, such as GPS pseudorange, Pseudorange rate measurement and IMU acceleration and angular rate measurement, so the center navigation filter can give the system only navigation parameters. The second figure shows the structure of this combined mode. Compared with the loose coupling method, this combination method can greatly improve the accuracy of the integrated navigation system; however, this combination cannot enhance the dynamic tracking ability of the GPS tracking loop, because there is no assistance of the GPS receiver tracking loop. The main advantage of this method is that almost all GPS receivers on the market can be used in this combination, and there is no special need for GPS receivers. C: There is a GPS / loop-assisted GPS / IMUOMv + A Θ) combination mode. Traditionally, this combination method is called tight coupling. The most obvious difference between this combination method and method B is the level of information fusion and Requirements for the receiver; this combined mode requires that the GPS receiver must be able to receive auxiliary information from the integrated navigation Kalman filter in order to assist the signal tracking loop of the GPS receiver 'and that the Kalman filter must be capable of outputting high output The velocity and acceleration information of the rate so that the GPS receiver can perform auxiliary processing. The third figure shows the structure of this combination. This combination method uses a more compact combination method, which is more effective --------.- ^ ------ ΤΓ ----- ▲ (Please read the note ^^ on the back first (Fill in this page) -12- 83.3.10,000 Printed by the Central Standards Bureau of the Ministry of Economic Affairs, Shellfish Consumer Cooperative, 448304 A7 _B7 V. Description of the invention (11) Use GPS and IMU information 'to determine and compensate for system errors; it can In the interference environment, it provides more accurate navigation information. Therefore, its performance is better than the previous two combined systems. In this combined method, the design of the GPS signal tracking loop has a significant impact on both the hardware and software of the GPS receiver. Put forward 5 certain requirements in order to be able to receive the speed and acceleration (V-A) auxiliary information from the navigation filter. The main advantage of this combination is to improve the high dynamic tracking ability and anti-interference ability of the GPS receiver. From a design point of view, the difficulty lies in the digital signal processing of the GPS receiver, the auxiliary design of the tracking loop, and the data exchange and system combination. 10 D: No GPS tracking loop assisted GPS / IMU ρ ν + Λ Θ combination mode This combination mode is similar to the above mode B, as shown in the fourth figure; the difference is that this combination mode has a new information fusion method That is, the use of Kmematic GPS technology in order to improve the accuracy of GPS measurement data. 15 GPS carrier phase measurement can obtain sub-centimeter (Sub-Centimeter) measurement accuracy; however, due to carrier integer phase ambiguity and cycle slip (Cycieslip), the ability to use carrier phase to obtain high-precision positioning data is limited. Especially in high dynamic environment, dynamic carrier phase ambiguity solution and cycle slip detection are very difficult. Once the phase ambiguity and cycle slip problems have been solved, this combination method can achieve higher positioning accuracy than other systems mentioned above; In addition, 'this combination method has no special requirements except that the GPS receiver can provide carrier phase measurement'; the main disadvantage of this combination method is that it cannot improve the dynamic tracking capability of the GPS receiver. E: GPS / IMUp + Pregnancy / Λν + Λ -13 with GPS tracking loop assistance This paper ruler becomes applicable to China National Ladder Standard (CNS) Α4 size (210X297 mm) -----: ---- ----- Order -----, line (please read "Notes on the back side and then fill in this page") Α7 Β7 Printed by the Central Laboratories Bureau of the Ministry of Economic Affairs, Shelley Consumer Cooperatives 1. V. Description of Invention (12) θ combination mode We call the combination mode a fully integrated mode. In this mode, all available measurements and MU measurements of GPS are combined and processed in the center navigation Kalman filter; The speed and acceleration information 5 is used to assist the GPS receiver's code and carrier tracking loop, in order to improve the GPS receiver's dynamic tracking ability and anti-interference ability in a high dynamic environment, and develop such a dynamic GPS / IMU integrated navigation system Is the current technical difficulty 'This combination will greatly improve the accuracy, reliability, dynamic capabilities and anti-jamming capabilities of integrated navigation systems. 10 In the past, the dynamic combination method for GPS / IMU has been effectively applied to low dynamic environments and aerial photography; however, in the dynamic GPS / INS combination system implemented in the above manner, only the phase blur solution and The cycle slip detection problem does not further consider how the IMU speed and acceleration information can be used to assist the tracking loop of the GPS receiver (delay locked loop or M ^ 15 / DLL and phase locked loop MX), however, this combination method only Under the condition that the GPS signal is obtained, the accuracy of the integrated navigation system can be improved, and the _P error compensation can't improve the dynamic tracking performance of GPS. In this combination, the IMU provides the estimated position and Speed, used to reduce the search space for phase ambiguity solution. Once the GPS receiver loses lock on the Gps 20 signal, there is no further connection between the GPS receiver and the IMU sensor. '' According to the corresponding performance-price ratio, the cooperation between the two, and the system implementation and flexibility, each of the above combination methods has its advantages; however, the measurement used in the existing combination system is mainly GPS pseudorange and pseudorange Rate and -14- this paper iiH system t related standard (CNS) A4 ^ · (210X297 mm) " ~~~ '--- 83.3.10,000 ^ 1- -I ^^ 1 H ^^ 1 in ^ i ^^ 1 ^^ 1 I i-Ji i ^^ 1 ^ ϋ · 11 ^^ 1 I. r (Please read the notes on the back before filling this page) 4483 04 A7 B7_ V. Description of the invention (U) — _ Acceleration and angular rate information. The speed obtained by the IMU is mainly used to assist the frequency lock of the carrier frequency tracking loop (before the code matching, remove the Doppler frequency shift) to facilitate the code delay measurement, not for the carrier. Phase measurement; therefore, the ranging accuracy is limited by the bandwidth and resolution of the code tracking loop, especially in a highly dynamic environment. To capture GPS signals, the bandwidth of the GPS receiver ’s unassisted carrier tracking loop must be sufficient Large in order to adapt to rapid changes in GPS signal frequency and phase caused by high dynamics, if there is no external assistance ' This object is reached quite difficult, since a wider bandwidth 'will cause interference into the tracking loop excessive noise. 10 In the present invention, a fully integrated dynamic GPS / IMU integrated navigation algorithm (FCKGA) is developed, which utilizes the unique technologies developed in the present invention, such as a robust central Kalman filter, MU-assisted dynamic wide-channel phase Fuzzy integer solution, IMUV-A assisted tracking loop. The successful development of FCKGA has led to an advanced navigation system. The 15 series of the system has the following characteristics: 1) The hardware level is in a fully coupled combination mode. The GPS receiver is only one of the sensors in the integrated navigation system (GPS gyro and GPS). Acceleration operation) For GPS navigation calculations, the requirement to track at least 4 satellites has been greatly relaxed. Through the design of Fault-Tolerant Software, the hardware level margin helps the Ministry of Economic Affairs. Printed by the Consumer Standards Cooperative of the Central Bureau of Standards to enhance the reliability of the entire system. 2) Use of low-cost IMU sensors In FCKGA-based systems, accurate positioning results can correct IMU sensor errors in the air, so that in integrated navigation systems, -15-83.3.10,000 This paper standard is applicable to China Standard rate (CNS) A4 specification (2 丨 0X297 mm) 44B3 04 Printed by the Consumers' Cooperative of the Central Bureau of Standards of the Ministry of Economic Affairs A7 B7 V. Description of the invention (14) Low-cost non-inertial-level inertial sensor. 3) Minimal tracking loop bandwidth and high anti-interference performance. In the fully integrated mode, the VA parameters of the integrated navigation filter are converted into VA information along the line of sight of the integrated navigation system to the GPS satellites. The ground is fed back to the signal processor of the GPS receiver to compensate for the high dynamic impact; thus the bandwidth of the tracking loop can be minimized in order to prevent unwanted interference noise from entering the tracking loop. 4) Dynamic and fast phase fuzzy solution and cycle slip detection The precise positioning data of the integrated navigation system can be used to calculate the distance between the satellite 10 and the navigation system. The calculated distance can be compared with the measured distance, and the result can be used to Detect cycle slip and reduce search space for phase ambiguity solution. 5) High navigation accuracy The integrated navigation system uses dynamic GPS technology with centimeter measurement accuracy, which significantly improves navigation accuracy. 'Once the atmosphere is delayed, select the availability (using dual-frequency and authorized GPS receivers), and phase blurring. When the solution and cycle slip problems are solved, the navigation error of the integrated navigation system depends only on the degree of compensation of the _ sensor error. The integrated guidance system simultaneously performs MU dynamic correction and alignment. In this way, the output data rate of the integrated navigation Data output rate equal to 20 INS. " The picture does not explain: The first picture: the structure of the GPS / INSP-V combined mode. The second picture: the structure of gps / IMU〇 / λ ϋ + Α Θ) combined mode without GPS tracking loop assistance. -16- The size of this paper applies to Chinese National Standard (CNS) A4 (210X297) 83. 3.10,000 I ----- ^-^ 1---. ^ 1 -------- ^- --- (Please read the note ^^ on the back before filling this page) 4483 04 A7 B7 V. Description of the invention (15) 10 15 Third picture: GPS / IMU (pMt; + with GPS tracking loop assist) Δ β) structure of combination mode. Figure 4: Structure of the combined GPS / IMU (p + 0 / Λ v + Λ Θ) mode without GPS tracking loop assistance. Fifth figure: The structure of the combined GPS / IMU (p + 0 / Δ v + Δ 0) mode with GPS tracking loop assistance. Figure 6: Block diagram of DPLL assisted by INS. Figure 7: A block diagram of a model of a code tracking loop assisted by the IMU. Figure 8: System_assisted block diagram of dynamic phase fuzzy solution. Figure 9: Block diagram of inertial navigation calculation. The tenth figure: is a block diagram of the combined Kalman filter. Figure 11: A block diagram of a fully integrated positioning system. Description of drawing number: 5-Inertial measurement device 10-GPS RF / IF module 20-Carrier and code tracking loop 201, 202, 203, 204-Mixer Please note first! Binding 20 Staff Consumer Cooperatives, Central Standards Bureau, Ministry of Economic Affairs Printed 205, 206-accumulator 208-loop filter 2010-carrier scale (: 0 2012-DLL phase detector 2014, 2015-adder 2017-code generator 40-navigation solver 207-carrier phase phase detector 209-adder 2011-correlator 2013-low-pass filter 20164 | NCO 30-navigation information decoding 401-attitude matrix calculation module 402-attitude matrix conversion module 403-attitude angle calculation module-17- This paper scale applies to China National Standard (CNS) Α4 specification (210 father 29:? Mm) 83. 3.10,000 line 4483 04 Printed by the Central Consumers' Bureau of the Ministry of Economic Affairs, Shellfish Consumer Cooperative, A7 ____B7______ 5. Description of the invention (16) 404-Navigation calculation Module 50-Carrier phase fuzzy integer solution 501-Ionospheric and tropospheric signal propagation model and satellite clock model 502-Satellite prediction module 50-Multi-mode cycle slip detection and repair module 5 504-Multi-mode carrier phase fuzzy integer solution module 60- Combined Kalman filter 601-instruction 6〇2-data 603-mode selection module 604- integrated navigation system reconstruction module 605- robust Kalman filter for navigation solution 10 606-covariance analysis of navigation results 801- GPSRF module (U0) 802- GPS digital signal processing module (υυ 803- Centralized processing navigation Kalman filter ^ j2) 804- Interface module 805- Timing signal synthesis module (U4) 15 S06-MU data sampling module (U5) The invention is air and land The space carrier provides a fully integrated positioning method and system that uses measurement information from GPS and inertial measuring instruments to improve navigation performance. Please refer to the fifth figure, which is provided by the present invention. A fully integrated 20-bit positioning method, including the following steps: 1) Receive the __ rate and acceleration information from the inertial measurement instrument, or receive the position, velocity, and attitude measurements of the carrier from other external sensors, and calculate the IMU navigation algorithm Initial value: " 2) Receive the RF (Radio frequency) signal of GPS and derive the pseudo ^ ιϋ ^ ιι! Ι ^ ί—K m ^ ——-line (please read the note f on the back before filling (This page) -18- This paper North Korea's Central Government House (CNS) A4 threatened "21Qx297: ^-~~~ —— ~ -3-31 ~ 〇-〇αα83 04 Α7 Β7 V. Description of the invention (17) 10 15 20 Printed range, pseudorange, and carrier phase measurements from industrial and consumer cooperatives; 3) Receive the velocity and velocity information from the fuel measurement domain, solve the navigation process, and obtain inertial navigation parameters, such as position, speed, and attitude. 4) Hybrid GPS pseudo-range, pseudo-material, carrier phase robustness, and inertial navigation parameters are obtained to obtain fully integrated positioning information. In order to obtain better performance, in the second step, the GPS signal is transmitted by the GPS receiver ’s cage-locked tree path and the carrier input of the loop tracking receiver. Integrated positioning information for auxiliary processing. In order to obtain better performance, the error of the navigation parameters of New Zealand can be compensated by the best estimate of the new financial record recorded in step 4 = In order to obtain better performance, enter __ in step 2 The step includes a process f step (fA) 'quilting support_record transfer paste jump detection, so that the carrier phase with high accuracy can be difficult to incorporate into the hybrid processing of step 4 In order to obtain better performance, step 2 further includes An external step 'is the county's fully-integrated fixed-assistance-assisted carrier phase fuzzy integer solution and cycle slip detection process as seen from step 4. In order to obtain better performance, the fourth step can be used-Kalman drop wave. In order to obtain better performance, the fourth step can use a multi-touch Kalman filter. In order to obtain better performance, a robust t — ^ Itr11 ----, ^-can be used in step 4 (please read the precautions on the back before filling this page) -19-

83-3.i0.000 4 〇 4 〇 經濟部中央梂準局貝工消費合作社印裝 A7 B7 五、發明説明(18 ) (Robust)卡爾曼濾波器。 來自慣性測量裝置5的機體角速率和加速度測量,在 導航解算40中進行處理,其結果被送入一組合卡爾曼濾波 器60,該組合卡爾曼濾波器60得出的慣性導航參數誤差的 5最佳估計被反饋給該導航解算40,以進行位置、速度、姿 態及慣性傳感器誤差的補償;GPS天線收到的GPS信號, 分別經由一GPSRF/IF模塊10、一載波和碼跟蹤環路2〇、一 載波相位模糊整數求解50、一導航信息解碼3〇處理’其結 果被送入該組合卡爾曼濾波器60 ;該組合卡爾曼濾波器6〇 10的最佳速度和加速度信息被反饋回載波和碼跟蹤迴路,用 以輔助GPS信號的跟蹤處理,導航求解模塊的位置、速度 、姿態被输入到該載波相位模糊整數求解50,用以輔助 GPS載波相位模糊整數求解。 在第一步驟中’動態GPS/IMU組合在進入正常工作之 15前,須經過一個IMU初始化過程,其中,初始位置、速度 和姿態信息需要被提供給該導航解算40的導肮方程;第— 步骤中,有三種IMU初始化方法。 (l-l)IMU的自主初始對準 這種方法只能用於地面靜止狀態;第1-1步驟需要的輸 20入信號是重力、地球旋轉角速率、經度;該慣性測量裝置 5的加速度計敏感的重力信號用來確定當地水平面,該慣 性測量裝置5的陀螺儀之地球旋轉角速率用來確定方位角 敏感,第1-1步騍輸出位置、速度、姿態、估計的慣性傳感 器誤差給該導航解算40的導航方程。 ~ -20- -------II------ΪΤ-----ά. (請先閲讀背面之注意事項再填寫本頁) 本紙承尺度適用中國固家標準(CNS)Α4規格(210x297公釐) 83· 3. !〇,〇〇〇 4483〇4 A7 '^^^^ __B7 五、發明説^"~~~~ -- (1-2)傳遞對準 如果IMU是裝在一個發射平台的戰術武器上,第】_2步 驟處理戰術武器和發射平台_的測量和導航參數,戰術 武器和發射平台之IMU的測量和導航參數被输出給一傳送 5對準處理模塊;在傳遞對準處理模塊中,傳遞對準濾波器 處理這些導航參數和測量參數,為戰術武器的IMU提供最 佳的初始化信息。 (1-3)GPS空中對準 如果GPS接收機被選為IMU初始化過程的一個外部傳 10感器’ GPS位置和速度以及一個不精確的姿態參數被首先 作為IMU導航方程的初值,之後GPS信號被用來對imu進 行連續的初始對準》 請參閲第五圖所示,第二步驟進一步包括下列步驟: 第2-1步驟:接收到的GPS信號被輸入到該GPSRF/IF 15模塊丨卜GPS RF(Radio frequency)信號被放大,下變頻到 IF(Intermediate Frequency)信號;GPS中頻信號被放大和低 通i慮波’並被轉換為GPS基帶(baseband)信號;類比 (analog)的GPS基帶信號在模擬一數位變换器內被採樣變换 為數位信號,並被输入給該載波和碼跟蹤環路20。 20 第2-2步騍:來自該GPSRF/IF模塊10的GPS數位信號 經濟部4-夬樣準局貝工消費合作社印製 (請先W讀背面之注意事項再填寫本頁) 和來自該組合卡爾曼濾波器60的速度和加速度辅助信號被 输入該載波和碼跟蹤環路20 ;該載波和碼跟蹤環路20包括 载波相位鎖定環路和早一遲數位延遲鎖定環路,以便跟蹤 GPS衛星信號。 -21- 本紙張尺度適用中國國家標率(CMS > A4規格(210X297^1 βΓΓΤόο^ 448304 鯉濟部中夬標準局員工消費合作社印製 A7 B7 五、發明説明(20) 該載波和碼跟蹤環路20輸出GPS偽距、偽距率以及載 波相位測量給該載波相位模糊整數求解50 ;該載波和碼跟 縱環路20恢復出來的載波和碼被輸出給該導航信息解碼3〇 c 5 請續參閲第五圖和第六圖所示,來自該GPSRF/IF模 塊10的第i節拍的GPS數位信號為: j(0 = 4ipca[{i + C)iTt- ξτί IcosK©, + > + ^〇]+ »(0 10 這裡: ρ:是信號功率, CA[]:是幅度為±1的prn碼,它的碼速率為R ,與GPS信號的發出時刻延遲了 r4Tc(Tc 為碼片寬度)。 15 —(=2rftTs)、〇d(=2rfdTs)分別是相應於基帶載波 頻率ft和都普勒頻移fd的探樣信號角頻率(1是採樣同 期), 0〇是當1=0時,信號载波相位初值 n(i)是基帶的輸入等效的帶限高斯噪聲; 20 碼速率R的於(1*KK這裡,是碼相應的都普勒 頻移;R〇是沒有都普勒頻移的碼速率》 來自該GPS RF/IF模塊10的GPS數位信號與來自一载波 NCO 2010的參考同相信號和正交信號,分別在一混合器 201與一混合器2〇3中相乘,該混合器201和該混合器203的 -22- 本紙張^^適用中國國家揉率(CNS ) Α4規格(210X297公釐) 83.3. !0,〇〇〇 — — II 1 ί* ^ ^1 ^1 ϋ ! 線 (請先閲讀背面之注^^項再填寫本頁) 經濟部中央棒準局貝工消費合作杜印製 4483 〇 Α7 __Β7 五、發明説明(21) 输出信號又與來自碼跟蹤環路的一碼產生器2017的準時 PRN(Psendo Random Noise)碼,分別在一混合器202和一混 合器204中相乘,以便於移去調制在载波頻率上的輸入的 PRN碼’追個過程被稱為解擴(Despreading Operation);移 5去偽隨機碼之後,GPS信號的SNR(signal-noisemtio)被增加 .了,這是由解擴操作的解擴增益帶來的,該混合器202的 输出被送入一累加器206,並被累加,該混合器2〇4的輸出 被送入一累加器205,並被累加,該累加器2〇6输出的同相 信號為·· 10 - f )sin c[(AdJd )t N / 2]cos^(jt)- Θ (Jt )J+ n,{k) 該信號被輸出給該載波相位鑒相器207 該累加器205输出的正交信號為: g(fe) = 4ΡΪΪκ{τ - f )sin c[(A<wrf \ N / 2]sin|0(i:)- B{k)]+ n〇 {k) 該信號被输出給該載波相位鑒相器207 15 這裡: 是第K節拍的都普勒頻移的估計誤差, 0¾)分別是輸入信號和本地NCO信號的相位 r^k)、nQ(k)分別是I(k)和Q(k)的相應的噪聲。 該載波相位蜜相器207以(fs/N)的速率輸出同相和正交信號 2〇的相關結果;這裡,fs是探樣速率,N是在每恤肌二相關 間隔的採樣數據之數目。 在該載波相位蜜相器207中的同相和正交信號進行反 正切(antangent)相位檢测處理,得出的相位誤差為: -23·83-3.i0.000 4 〇 4 〇 Printed by Shellfish Consumer Cooperative of Central Bureau of Standards of the Ministry of Economic Affairs A7 B7 V. Description of Invention (18) (Robust) Kalman Filter. The angular rate and acceleration measurements of the body from the inertial measurement device 5 are processed in the navigation solution 40, and the result is sent to a combined Kalman filter 60, which is based on the 5 The best estimate is fed back to the navigation solution 40 to compensate for position, speed, attitude, and inertial sensor errors; the GPS signals received by the GPS antenna pass through a GPSRF / IF module 10, a carrier, and a code tracking loop, respectively. Road 20, a carrier phase fuzzy integer solution 50, a navigation information decoding 30 process, and the result is sent to the combined Kalman filter 60; the optimal velocity and acceleration information of the combined Kalman filter 60 is The carrier and code tracking loop are fed back to assist the GPS signal tracking processing. The position, velocity, and attitude of the navigation solution module are input to the carrier phase fuzzy integer solution 50 to assist the GPS carrier phase fuzzy integer solution. In the first step, the dynamic GPS / IMU combination must go through an IMU initialization process before entering the normal working 15, where the initial position, speed and attitude information needs to be provided to the navigation equation 40 guide equations; — In the step, there are three IMU initialization methods. (ll) The method of autonomous initial alignment of the IMU can only be used on the ground stationary state; the input signals required in step 1-1 are gravity, earth rotation angular rate, and longitude; the accelerometer of the inertial measurement device 5 is sensitive The gravity signal is used to determine the local horizontal plane. The earth ’s rotational angular rate of the gyroscope of the inertial measurement device 5 is used to determine the azimuth sensitivity. Step 1-1: Output position, velocity, attitude, and estimated inertial sensor errors to the navigation. Solve 40 navigation equations. ~ -20- ------- II ------ ΪΤ ----- ά. (Please read the notes on the back before filling this page) This paper's bearing standards are applicable to the Chinese Standards (CNS) Α4 specification (210x297 mm) 83 · 3.! 〇, 〇〇〇4483〇4 A7 '^^^^ __B7 V. Invention ^ " ~~~~-(1-2) Pass alignment if IMU It is mounted on a tactical weapon of a launch platform. The measurement and navigation parameters of the tactical weapon and launch platform are processed in step _2. The measurement and navigation parameters of the IMU of the tactical weapon and launch platform are output to a transmission 5 alignment processing module. ; In the transfer alignment processing module, the transfer alignment filter processes these navigation parameters and measurement parameters to provide the optimal initialization information for the tactical weapon's IMU. (1-3) GPS aerial alignment If the GPS receiver is selected as an external sensor of the IMU initialization process, the GPS position and speed and an inaccurate attitude parameter are first used as the initial value of the IMU navigation equation, and then GPS The signal is used for continuous initial alignment of the IMU. Please refer to the fifth figure. The second step further includes the following steps: Step 2-1: The received GPS signal is input to the GPSRF / IF 15 module.丨 The GPS RF (Radio frequency) signal is amplified and down-converted to the IF (Intermediate Frequency) signal; the GPS intermediate frequency signal is amplified and low-pass filtered and converted to a GPS baseband signal; analog The GPS baseband signal is sampled and converted into a digital signal in an analog-to-digital converter, and is input to the carrier and code tracking loop 20. 20 Step 2-2 骒: Printed by the GPS Digital Signal Ministry of Economics, GPSRF / IF Module 10, 4-Sample Printed by Shellfish Consumer Cooperative (please read the precautions on the back before filling this page) and from The speed and acceleration assistance signals of the combined Kalman filter 60 are input to the carrier and code tracking loop 20; the carrier and code tracking loop 20 includes a carrier phase locked loop and a late digital delay locked loop to track the GPS satellite signal. -21- This paper size is applicable to China National Standards (CMS > A4 specifications (210X297 ^ 1 βΓΓΤόο ^ 448304 Printed by A7 B7 of the Consumer Cooperatives of the China Standards Bureau of the Ministry of Economics and Economics of the People's Republic of China) V. Description of the invention (20) The loop 20 outputs GPS pseudorange, pseudorange rate, and carrier phase measurement to solve the carrier phase fuzzy integer 50; the carrier and code and the carrier and code recovered by the vertical loop 20 are output to the navigation information decoding 3c 5 Please refer to the fifth and sixth figures, the GPS digital signal from the i-th beat of the GPSRF / IF module 10 is: j (0 = 4ipca [{i + C) iTt- ξτί IcosK ©, + & gt + ^ 〇] + »(0 10 Here: ρ: signal power, CA []: prn code with amplitude ± 1, its code rate is R, and it is delayed r4Tc (Tc is Chip width) 15 — (= 2rftTs), 〇d (= 2rfdTs) are the angular frequency of the sample signal corresponding to the baseband carrier frequency ft and Doppler frequency shift fd (1 is the sampling period), 0 is when When 1 = 0, the initial value of the signal carrier phase n (i) is the equivalent band-limited Gaussian noise of the input of the baseband; at 20 code rate R, (1 * KK here, is the code The corresponding Doppler frequency shift; R0 is the code rate without the Doppler frequency shift. "The GPS digital signal from the GPS RF / IF module 10 and the reference in-phase signal and quadrature signal from a carrier NCO 2010, respectively. Multiply in a mixer 201 and a mixer 203. The mixer 201 and the mixer 203 are -22- this paper ^^ Applicable to China National Kneading Rate (CNS) A4 size (210X297 mm) 83.3. ! 0, 〇〇〇— — II 1 ί * ^ ^ 1 ^ 1 ϋ! Line (please read the note ^^ on the back before filling out this page) Central Government Bureau of the Ministry of Economic Affairs Shellfish Consumer Cooperation Du printed 4483 〇 Α7 __Β7 V. Description of the invention (21) The output signal is multiplied with a punctual random noise (PN) code from a code generator 2017 of the code tracking loop 2017 in a mixer 202 and a mixer 204, respectively, so that The process of removing the input PRN code that is modulated on the carrier frequency is called the despreading operation; after removing the pseudo-random code by 5, the SNR (signal-noisemtio) of the GPS signal is increased. Is caused by the despreading gain of the despreading operation, the output of the mixer 202 is sent to an accumulator 206, and After being accumulated, the output of the mixer 204 is sent to an accumulator 205 and accumulated. The in-phase signal output by the accumulator 20 is ·· 10-f) sin c [(AdJd) t N / 2] cos ^ (jt)-Θ (Jt) J + n, {k) The signal is output to the carrier phase phase detector 207. The quadrature signal output by the accumulator 205 is: g (fe) = 4ΡΪΪκ {τ- f) sin c [(A < wrf \ N / 2] sin | 0 (i:)-B (k)] + n〇 {k) This signal is output to the carrier phase phase detector 207 15 Here: Yes No The estimated error of the Doppler frequency shift of K beats, 0¾) is the phase r ^ k of the input signal and the local NCO signal, respectively, and nQ (k) is the corresponding noise of I (k) and Q (k), respectively. The carrier phase honeyer 207 outputs the correlation results of the in-phase and quadrature signals 20 at a rate of (fs / N); here, fs is the sampling rate and N is the number of sampled data at two correlation intervals per muscle. The in-phase and quadrature signals in the carrier phase honeyer 207 are subjected to an inverse tangent (antangent) phase detection process, and the resulting phase error is: -23 ·

CNS ) A4^'( 21Q^iT 83.3.10,000 -------丨|------tr-----d. (請先閱婧背面之注意事項再填寫本頁) 448304 經濟部中央樣率局負工消費合作社印裝 A7 B7 五、發明説明(22 ) «(t)e [-π,+π-j 這裡: 5 g[]是相位鑒相器的特性函數 = ⑹是輸入信號無噪聲時的相位跟蹤誤差 〜(*)s (-π i[e⑽十冗-§[ε(ί:)])是由翰入信號中的噪聲引 起的相位擾動。 10這樣,該載波相位鑒相器207的特性曲線在之内是線性的 豕[ε ⑻]=s (A:)m〇d[-/γ,+τγ] 該載波相位鑒相器207輸出相位跟蹤誤差給一環路濾 波器208 ’該環路濾波器208是數位濾波器,通常以一階、 15二階、或三階方式實現;相位跟蹤誤差信號中的噪聲被該 環路濾波器208濾除,濾除噪聲之後的相位跟縱誤差被該 環路濾波器208输出給一相加器209。 來自該環路濾波器208的相位跟蹤誤差信號,被該相 加器209接收,並與來自該組合卡爾曼濾波器60的IMU輔 助信號相加,其結果被输出給該載波NCO(Numerically-Controlled Oscillator)2010。 為了進行GPS非相干(Non-Coherently)相關處理(在載波 相位捕獲中)和相干(Coherently)相關處理’該载波;NCO 2010使用输入的相位跟蹤誤差進行調整’以採樣速率為fs -24- 本紙張尺度適洧中躅固家標率(CNS ) A4%格(210X297公釐) 83. 3. !0,〇〇〇 —^------V------線’ (請先閲讀背面之注意事項再填寫本頁) 483 〇4 五 、發明説明(23 A7 B7 10 15 20 經濟部中央標準局貝工消費合作杜印裝 產生本地同相和正交參考信號; 該載波NCO 2010输出本地同相信號給該混合器201、 輪出本地正交信號給該混合器203、输出GPS偽距率和載波 相測量給該載波相位模糊整數求解50。 請參閲第七圖所示,早一遲數位鎖定環路(DDLL),與 载波相位鎖定環路協作,並受IMU數據輔助,用來實現以 下兩個目的: 1) 碼跟蹤環路提供輸入信號碼和接收機内部產生的準 時碼之間的最大時間漂移的估計值,該時延信息用來計算 用户到衛星之間距離估計,該距離估計被稱為偽距。 2) 從碼跟蹤處理得出的同步碼被用來解擴GPS信號, 解擴後的GPS信號被輸入接收機的載波跟蹤環路,以便於 進行载波跟縱和導航數據的解調(demodulation)。 典型的GPS接收機使用非相干延時鎖定環路(ncdll) 作為它的碼跟蹤環路,這種環路常被稱為“早一遲”延時 鎖定環路,它的提前碼和延時碼是由壓控振盪器產生的, 相千DLL也用於一些GPS接收機,它要求並行的載波相位 跟蹤(因此具有相干的特性)’·相干DLL的最大内在缺點是 當出現周跳和碼位誤差時,碼跟蹤環路將會失鎖,這是囡 為相干DLL只有為相位跟蹤成功時,才能正常工作,相干 DLL僅是用於一些要求相位跟縱的場合,因此,這裡僅給 出IMU輔助的NCDLL處理。 來自該混合器201和該混合器203的輸出以及來自芎礁 產生_7的“早”和“遲”本地碼被該相關 --------^丨裝------討-----^線 (請先Μ讀背面之注意事項再填寫本頁) -25- 各紙張尺度適用中國國家橾準(CNS ) A4規格(210X297公釐) 813.10,000 “48304 A7 B7 經濟部中夬標率局員工消費合作社印製 五、發明説明(24) ,並進行相關處理,其結果被输出給一DLL鑒相器2012。 來自該相關器2011的相關結果,是碼相位跟蹤誤差的 函數,並由該DLL鑒相器2012接收,用來提取碼相位跟蹤 誤差’得出的碼相位跟蹤誤差被輸出給該低通濾波器2〇13 5 ,以便濾除碼相位跟蹤信號中的噪聲。 由該DLL鑒相器2012得出的碼相位跟蹤誤差,受输入 噪聲的擾動’該低通濾波器2013對之進行濾波,經過濾波 的碼相位跟蹤誤差’被輸出給一相加器2014,該低通濾波 器2013是一數位濾波器,通常以一階、二階或三階方式實 10現。 來自該低通濾波器2013的碼跟蹤誤差與來自該組合卡 爾曼濾波器60的_輔助數據即都普勒輔助信號,在該相 加器2014中相加;該相加器2014的輸出信號與正常的碼速 率信號’在一相加器2015中相加,其結果被輸出到一碼 15 NCO2016 ;該碼NCO2016輸出PRN碼給該碼產生器2017 ,該碼產生器2017產生並輸出本地“早“、”遲“和準時 碼給該相關器20Π,產生並输出GPS偽距測量給該载波相 位模糊整數求解50。 經過載波相位鎖定環路和碼延時鎖定環路的處理,接 20收到之GPS信號的載波和碼已被恢復;來自該GTPSRF/IF模 塊10的GPS信號以及來自該載波和碼跟蹤環路2〇之恢復出 來的載波和碼被輸出給該導航信息解碼30,該導航信息解 碼30解調出GPS衛星的星曆數據,並輸出給該组合卡爾曼 滤波器60。 -26- 本紙張尺度逍用中國國家標率(CNS > Μ規格(210X297公釐) 83· 3.10,000 ^^^1- ^^^1 ^—^1 ^1 (讀先閱讀背面之注意事項再填寫本頁) 訂 線 經濟部中央揉準局貝工消費合作杜印装 4483〇4 A7 ----------- 五、發明説明(25 ) 請參閲第八圖所示,在第2A和2B步驟中,更高精度的 疋位結果是通過使用載波相位測量而不是僅使用偽距測量 獲得的;這是因為GPS衛星L1載波頻率為1575.42MH2 ,波 長為19cm,而C/A碼的一個周期約等於3〇〇m。使用Gps载 5波相位測量進行定位的 一個前提條件是已求解出相位整數模糊,載波相位測 量中的整數模糊本質上與接收機和衛星有關;如果在理想 條件下,即假定载波相位檢测沒有誤差並且精確知道接收 機和衛星的位置,則可通過一簡單數學運算,立即得出模 10糊整數;然而由於在碼跟蹤環路的距離測量中,存在衛星 星曆誤差、衛星時鐘偏置、大氣傳播延時、多徑效應、以 及接收機噪聲,我們僅能得到從接收機到衛星的不精確的 幾何距離,被稱之為偽距。 IMU輔助的相位模糊求解與周跳檢测的方法的傷 15 ,來自經過校正的INS的精確的載體之位置和速度,能^ 用來計算初始的模糊整數及其搜範圍;此外,ms辅助的 信號跟蹤也會增強接收機保持GPS信號的能力,降低信號 失鎖和出現周跳的概率。 GPS衛星魏之信號_波頻率可分為u帆2載波頻 20率,根據設計的不同,一個GpS接收機可接收GPS單頻,、 號或GPS雙頻信號;-多模·波相位模齡數求解模二 504包含下列模式: 1) 使用單頻數據求解模糊整數。 2) 使用雙頻數據求解模糊整數。 -27- 本紙張尺度適用中圃爾家橾率(CNS ) A4洗格(210X297公釐) 8 3- 3. !〇,〇〇〇 —t------1T-----威 (請先聞讀背面之注意事項再填寫本I) 4483 04 A7 B7 五、發明説明(26 ) 10 15 20 鋰濟部中央橾準局貝工消費合作衽印裂 3)使用混合雙頻數據和碼數據,以及來自GPS/imu組 合濾波器的辅助數據,求解模糊整數。 當不能獲得雙頻數據時,單頻數據以及用來自組合卡 爾曼濾波器60的數據和來自一衛星預測模塊502的數據用 來求解相位整數模糊;當雙頻數據可以得到時,寬道技術 被用來提取寬道相位模糊整數,使用!NS輔助,寬道相位 模糊整數可被快速確定。 請續參閲第八圖所示,來自電離層(Inonespheric)和對 流層(troposheric)信號傳播模型和衛星時鐘模型501的輸出 數據、來自該衛星預測模塊5〇2的輸出數據、來自該多模 式周跳檢測和修復模塊503的輸出數據、來自組合卡爾曼 濾波器60的輸出數據、該載波和碼跟蹤環路2〇的輸出數據 ,被多模式載波相位模糊整數求解模塊504接收,用以求 出載波相位模糊整數, 求出載波相位模糊整數之後,GPS偽距、偽距運 '載 波相位測量被該載波相位模糊整數求解5〇送入該組合卡爾 曼濾波器60 〇 導航彳§息解碼模塊得出的GPS衛星星曆被該衛星預測 模塊502接收,用來計算GPS衛星位置和速度,並將之輸入 該多模式载波相位模糊整數求解模塊504。 該電離層和對流層信號傳播模型和衛星時鐘模型5〇1 對GPS信號電離層和平流層傳播效應和Gps衛星時鐘誤差 進行建模;該電離層和對流層信號傳播模型和衛星時鐘模 型501計算GPS信號的電離層和對流層的傳播時延和Gps衛 家標準(CNS ) A娜 83. J. !〇,〇〇〇 ,丨裝 ~ 訂----— 線 (請先聞讀背面之注$項再填寫本頁) -28- ^33 04 經濟部中央樣率局員工消費合作杜印袈 Α7 Β7 五、發明説明(27) 星時鐘誤差’並將之輪出給該多模式載波相位模糊整數求 解模塊504。 來自該組合卡爾曼濾波器60的GPS接收機位置和GPS 衛星位置被該多模式載波相位模糊整數求解模塊5〇4接收 5 ,該模塊包括周跳檢測算法和修復算法;周跳檢測算法包 括一些檢驗算法,第一個檢驗算法是檢驗載波相位,這種 方法常會導致周跳檢測的失敗,這是由於載波相位受多個 時間獨立的誤差項擾動;第二個方法是雙頻相位混合,相 位/碼混合方法也用在多模式周跳檢測算法中;最後一種方 10法是利用來自該組合卡爾曼濾波器60的速度信息來檢測和 修復周跳’ 一旦該多模式载波相位模糊整數求解模塊504 檢測到周跳發生,則進一步確定周跳的大小和位置;修復 是通過使用一個固定值校正這個衛星的載波相位觀測量和 所有後續相位觀測量,修復之後,該多模式周跳檢測和修 復模塊5〇3输出修復好的載波相位給該多模式载波相位模 糊整數求解模塊504。 來自該組合卡爾曼濾波器60的GPS接收機的位置和速 度以及位置和速度誤差的方差,被送入該多模式載波相位 模糊整數求解模塊504和該多模式周跳檢測和修復模塊503 20 ’以便於提取衛星和GPS接收機之間的幾何距離,以及求 解模糊整數的搜索範圍。 來自該載波和碼跟蹤環路20的GPS的偽距、偽距運、 載波相位測量被輸入到該多模式载波相位模糊整數求解模 塊504。 -29- 表紙張从適财g國家揉率(CNS )从胁(21GX297公釐〉 83,3.10,000 --------1參------1Τ-----.^ (請先聞讀背面之注項再填寫本頁) 44 Q O U M-CNS) A4 ^ '(21Q ^ iT 83.3.10,000 ------- 丨 | ------ tr ----- d. (Please read the precautions on the back of Jing before filling this page) 448304 Printed by A7 B7 of the Consumer Cooperatives of the Central Sample Rate Bureau of the Ministry of Economic Affairs 5. Description of the invention (22) «(t) e [-π, + π-j Here: 5 g [] is the characteristic function of the phase phase detector = ⑹ Is the phase tracking error when the input signal is noisy ~ (*) s (-π i [e⑽ 十 ⑽-§ [ε (ί :)]) is the phase disturbance caused by the noise in the input signal. 10 Thus, this The characteristic curve of the carrier phase phase detector 207 is linear within 豕 [ε ⑻] = s (A:) m〇d [-/ γ, + τγ] The carrier phase phase detector 207 outputs a phase tracking error to a loop Circuit filter 208 'The loop filter 208 is a digital filter, usually implemented in a first-order, 15 second-order, or third-order manner; the noise in the phase tracking error signal is filtered by the loop filter 208 to remove noise The subsequent phase tracking error is output by the loop filter 208 to an adder 209. The phase tracking error signal from the loop filter 208 is received by the adder 209 and is combined with the combined Kalman filter IMU The auxiliary signals are added, and the result is output to the carrier NCO (Numerically-Controlled Oscillator) 2010. In order to perform GPS non-coherently correlation processing (in the carrier phase capture) and coherently correlation processing, the carrier ; NCO 2010 uses the input phase tracking error to make adjustments. 'Sampling rate is fs -24- This paper has a moderate standard (CNS) A4% grid (210X297 mm) 83. 3.! 0, 〇 〇〇 — ^ ------ V ------ line '(Please read the precautions on the back before filling out this page) 483 〇5. Description of the invention (23 A7 B7 10 15 20 Central Standard of the Ministry of Economic Affairs The local co-consumer Du Yinzhuang produces local in-phase and quadrature reference signals; the carrier NCO 2010 outputs local in-phase signals to the mixer 201, turns out local quadrature signals to the mixer 203, outputs GPS pseudorange rate and The carrier phase measurement solves the carrier phase fuzzy integer by 50. Please refer to the seventh figure, the early-late digital lock loop (DDLL), cooperates with the carrier phase lock loop, and is assisted by IMU data to achieve the following Two purposes: 1) The code tracking loop provides the input signal An estimate of the maximum time drift between the code and the punctual code generated internally by the receiver. This delay information is used to calculate the distance estimate between the user and the satellite. This distance estimate is called pseudorange. 2) Obtained from code tracking processing The generated synchronization code is used to despread the GPS signal, and the despread GPS signal is input to the carrier tracking loop of the receiver to facilitate the demodulation of the carrier tracking and navigation data. A typical GPS receiver uses a non-coherent delay-locked loop (ncdll) as its code tracking loop. This loop is often referred to as the "early-late" delay-locked loop. Its advance code and delay code are Generated by a voltage-controlled oscillator, the phase thousand DLL is also used in some GPS receivers. It requires parallel carrier phase tracking (so it has coherent characteristics). The biggest inherent disadvantage of a coherent DLL is when cycle slips and code bit errors occur. The code tracking loop will lose lock. This is because the coherent DLL can only work normally if the phase tracking is successful. The coherent DLL is only used in some situations that require phase and vertical. Therefore, IMU is only given here. NCDLL processing. The outputs from the mixer 201 and the mixer 203 and the "early" and "late" local codes from the reef generation _7 are correlated by this -------- ^ 丨 install ---- ----- ^ line (please read the notes on the back before filling in this page) -25- Each paper size is applicable to China National Standard (CNS) A4 (210X297 mm) 813.10,000 "48304 A7 B7 Economy The Ministry of Standards and Technology Bureau employee consumer cooperative printed five invention descriptions (24) and processed them, and the results were output to a DLL phase detector 2012. The correlation results from this correlator 2011 are code phase tracking errors The code phase tracking error received by the DLL phase detector 2012 is used to extract the code phase tracking error 'the code phase tracking error' is output to the low-pass filter 2103 5 in order to filter out the code phase tracking signal. Noise. The code phase tracking error obtained by the DLL phase detector 2012 is disturbed by the input noise 'the low-pass filter 2013 filters it, and the filtered code phase tracking error' is output to an adder 2014 The low-pass filter 2013 is a digital filter, usually a first-order, second-order or The third-order method is realized in 10. The code tracking error from the low-pass filter 2013 and the auxiliary data from the combined Kalman filter 60 are the Doppler auxiliary signals, which are added in the adder 2014; The output signal of the adder 2014 is added to the normal code rate signal 'in an adder 2015, and the result is output to a code 15 NCO2016; the code NCO2016 outputs a PRN code to the code generator 2017, and the code generator 2017 generates and outputs local "early", "late" and punctual codes to the correlator 20Π, generates and outputs GPS pseudo range measurements to the carrier phase fuzzy integer to solve 50. After the carrier phase locked loop and code delay locked loop Processing, the carrier and code of the GPS signal received at 20 have been recovered; the GPS signal from the GTPSRF / IF module 10 and the recovered carrier and code from the carrier and code tracking loop 20 are output to the navigation Information decoding 30, the navigation information decoding 30 demodulates the ephemeris data of the GPS satellites, and outputs it to the combined Kalman filter 60. -26- This paper is scaled to the Chinese national standard (CNS > Μ specifications (210X297 Mm) 8 3 · 3.10,000 ^^^ 1- ^^^ 1 ^ — ^ 1 ^ 1 (Read the precautions on the back before filling out this page) The Central Bureau of the Ministry of Economic Affairs, the Central Bureau of quasi-examination, consumer cooperation, printed materials, 4483. 4 A7 ----------- 5. Description of the invention (25) Please refer to the eighth figure. In steps 2A and 2B, the higher-precision positioning result is obtained by using carrier phase measurement. Instead of using only pseudo-range measurements; this is because the GPS satellite L1 carrier frequency is 1575.42MH2, the wavelength is 19cm, and one cycle of the C / A code is approximately 300m. A prerequisite for using GPS to carry 5-wave phase measurement for positioning is that the phase integer ambiguity has been solved. The integer ambiguity in carrier phase measurement is essentially related to the receiver and satellite; if under ideal conditions, it is assumed that the carrier phase detection does not have Error and accurately know the position of the receiver and satellite, then a simple mathematical operation can be used to immediately obtain the integer of 10; however, in the distance measurement of the code tracking loop, there are satellite ephemeris errors, satellite clock offsets, Atmospheric propagation delay, multipath effects, and receiver noise, we can only get inaccurate geometric distances from the receiver to the satellite, which is called pseudorange. IMU-assisted phase-fuzzy solution and cycle slip detection method15, the precise carrier position and velocity from the corrected INS can be used to calculate the initial fuzzy integer and its search range; in addition, ms-assisted Signal tracking will also enhance the receiver's ability to maintain GPS signals, reducing the probability of signal loss of lock and cycle slip. GPS satellite Wei Zhi signal_wave frequency can be divided into ufan 2 carrier frequency 20 rate, according to different design, a GpS receiver can receive GPS single frequency, signal, or GPS dual frequency signal; -multimode · wave phase mode age Digital Solving Module Two 504 contains the following modes: 1) Use single frequency data to solve fuzzy integers. 2) Use dual frequency data to solve fuzzy integers. -27- This paper size is suitable for CNP A4 washing (210X297mm) 8 3- 3.! 〇, 〇〇〇—t ------ 1T ----- wei (Please read the notes on the back before filling in this I) 4483 04 A7 B7 V. Description of the invention (26) 10 15 20 Lithium Ministry of Economy, Central Bureau of Standards, Bureau of Consumption and Cooperation of Shellfish Consumers 3) Use mixed dual-frequency data and Code data, and auxiliary data from the GPS / imu combined filter to solve fuzzy integers. When dual-frequency data cannot be obtained, the single-frequency data and the data from the combined Kalman filter 60 and the data from a satellite prediction module 502 are used to solve the phase integer ambiguity; when dual-frequency data is available, the wide-channel technique is used Used to extract wide-channel phase fuzzy integers. With the aid of! NS, wide-channel phase fuzzy integers can be quickly determined. Please refer to the eighth figure, the output data from the ionospheric and troposheric signal propagation model and the satellite clock model 501, the output data from the satellite prediction module 502, and the multi-mode cycle slip The output data of the detection and repair module 503, the output data from the combined Kalman filter 60, and the output data of the carrier and code tracking loop 20 are received by the multi-mode carrier phase fuzzy integer solution module 504 to obtain a carrier Phase fuzzy integer. After calculating the carrier phase fuzzy integer, the GPS pseudo-range and pseudo-range carrier phase measurements are solved by the carrier phase fuzzy integer 50 and sent to the combined Kalman filter 60. The navigation information is obtained by the decoding module. The GPS satellite ephemeris is received by the satellite prediction module 502, used to calculate the GPS satellite position and speed, and input it to the multi-mode carrier phase fuzzy integer solution module 504. The ionosphere and troposphere signal propagation model and satellite clock model 501 model the GPS signal ionosphere and stratosphere propagation effects and GPS satellite clock errors; the ionosphere and troposphere signal propagation model and satellite clock model 501 calculate the ionospheric and Tropospheric Propagation Delay and Gps Guardian Standard (CNS) A Na 83. J.! 〇, 〇〇〇, 丨 Install ~ Order ---- (Please read the note on the back before filling in this page ) -28- ^ 33 04 The consumer cooperation of the Central Sample Rate Bureau of the Ministry of Economic Affairs Du Yin 袈 Α7 Β7 V. Description of the invention (27) Star clock error 'and round it out to the multi-mode carrier phase fuzzy integer solution module 504. The GPS receiver position and GPS satellite position from the combined Kalman filter 60 are received by the multi-mode carrier phase fuzzy integer solution module 504, which includes a cycle slip detection algorithm and a repair algorithm; the cycle slip detection algorithm includes some Test algorithm. The first test algorithm is to check the carrier phase. This method often causes the failure of cycle slip detection. This is because the carrier phase is disturbed by multiple time-independent error terms. The second method is dual-frequency phase mixing. The code / code hybrid method is also used in the multi-mode cycle slip detection algorithm; the last method 10 is to use the speed information from the combined Kalman filter 60 to detect and repair the cycle slip 'Once the multi-mode carrier phase fuzzy integer solver module 504 If the cycle slip is detected, the size and location of cycle slip are further determined; the repair is to use a fixed value to correct the carrier phase view measurement and all subsequent phase view measurements of this satellite. After the repair, the multi-mode cycle slip detection and repair Module 503 outputs the repaired carrier phase to the multi-mode carrier phase fuzzy integer solution module 504.The position and speed of the GPS receiver from the combined Kalman filter 60 and the variance of the position and speed errors are sent to the multi-mode carrier phase fuzzy integer solution module 504 and the multi-mode cycle slip detection and repair module 503 20 ' In order to extract the geometric distance between the satellite and the GPS receiver, and to solve the search range of fuzzy integers. The GPS pseudorange, pseudorange, and carrier phase measurements from the carrier and code tracking loop 20 are input to the multi-mode carrier phase fuzzy integer solution module 504. -29- Table paper from the appropriate country g kneading rate (CNS) from the threat (21GX297 mm> 83,3.10,000 -------- 1 ref ----- 1T -----. ^ ( Please read the notes on the back before filling out this page) 44 QOU M-

發明説明(28) 經濟部中央標準局貝工消費合作社印製 請續參閱第九圖所示,在第3步驟中,來自該慣性溯 量裝置5的陀螺儀敏感的機體角速率,被輸入該姿態矩陣 計算模塊401 ;來自該慣性測量装置5的機體健率,來自 一導航計算模塊404的當地導航坐標系(n係)到慣性坐標系(ι 係)的旋轉向量,以及來自該組合卡爾曼遽波器6〇姿態誤差 估計,被該姿態矩陣計算模塊401接收,用以更新姿態矩 陣,並補償其誤差;更新姿態矩陣的方法包括尤拉法 (Eular),方向餘弦法(directioncosine),以及四元數方法。 姿態矩陣被該姿態矩陣計算模塊401輸出給一姿態角 计算模塊403,用以從姿態矩陣中提取俯仰角、模流角、 以及航向角,並作為INS導航输出參數的一部份。 來自該慣性測量裝置5的加速度計測量的加速度是表 達在機體坐標系的,它和來自該姿態矩陣計算模塊4〇1的 姿態矩陣被一姿態矩陣變換模塊402接收;輸入的表達在 機體坐標系中的加速度被該姿態矩陣變換模塊4〇2轉換為 表達在導航坐標系(η係)的加速度’並將之輸出給該導航計 算模塊404。 來自該姿態矩障變換模塊402的表達在導航坐標系的 加速度和來自組合卡爾曼濾波器的位置誤差和速度誤差的 20最佳估計被該導航計算模塊404接收,用以計算位置、速 度’並被補償位置和速度中的誤差,計算從當地導航坐標 系到慣性坐標系的旋轉向量;位置和速度作為INS導航參 數的一部份由該導航計算模塊404输出給該組合卡爾曼濾 波器60,從當地導航坐標系列慣性坐標系的旋轉向量被該 10 15 -30- 本紙張通用中®國家揉準(CNS > A4麟· ( 210X297公釐) 83.3.10,000 (請先聞讀背面之注意事項再填寫本頁) 裝. 訂 經濟部中央標率局員工消費合作社印製 483 04 A7 ------- -B7_ 五、發明説明(29) ~ "~ 導航計算模塊404输出到姿態矩陣計算模塊4〇卜 眾所皆知,實時卡爾曼濾波器能給出最佳的狀態估計 ’這些估計是無偏的,在最小無偏線性估計中,其^差^ 小;然後,只有假定的數位模型符合實際,其估計精度才 5能保證,任何模型的不準確,都可能導致估計結果的^效 ,因此,尋找一種新的方法,可檢證假定數位模型的有效 性是非常重要的,特別是在組合GPS/IMU導航係統中,實 時卡爾曼濾波器成功應用的關鍵是設計適當大小的漏波模 型用以預測系統的性能’同時能滿足外理機吞吐量的限制 10 ;在基於FCKGA的組合導航系統設計中,濾波器須足夠魯 棒’能運行在不同的動態環境中,因為基於FCKGA的組合 導航係將應於一大類軍用/民用的移動平台上,如戰術武器 ,無人飛行器,智能炸彈,精確打擊武器及其它航空電子 系統;如果動態變化激烈、或出現傳感器故障,如GP_ 15星信號故障、或慣性傳感器故障,濾波器必須能檢測、改 正、融離故障,最終重構(reconfigure)組合導航系統。 只管濾波器的完整性和魯棒性通常分開獨立研究,但 事實上它們是密不可分的.‘一個魯棒的卡爾曼濾波器能在 一大類系統和量測模型下,提供接近最佳的性能,標準的 20卡爾曼濾波器不是魯棒的,因為它僅能對某一特定的系統 和量测模型提供最佳的性能,如果濾波器不正確,則濾波 器的方差所報告的精度可能和它實際的精度大不相同;濾 波器完整性的目的,是保證其誤差方差陣預測的性能接近 實際的估計誤差的統計特性。 -31- 本纸張通用中圃國( CNS ) A4賴;(21〇χ297公釐) 83.110^000 --------.I裝----.--訂----- 線 (請先閎讀背面之注$項再填寫本頁) 448304 經濟部中央棣準局員工消費合作社印製 A7 B7 五、發明説明(30) 此外,濾波器的發散通常是由於系統模型和量測模型 的改變或傳感器誤差引起的;殘差檢測方法能有效地檢潮 硬和軟故障及濾波器的發散’殘差鑒測方法的優點之一是 當模型正確時,殘差序列的統計特性是已知的;這樣,較 5易實現使用量測殘差的統計分布檢驗進行量測編輯和發散 檢測,同樣的統計檢驗也能用來為檢測出濾波發散時輔助 遽波器調谐和方差大小的調整。 由於狀態誤差方差陣被投影進量測幾何關中進而影響 殘差的統計特性,因此為保證合理的誤警速率,誤差方差 10陣必須是精確的,至小是保守的,這要求所有已知的量測 誤差應當被適當地建模而且系統模型應當相當精確;—種 被稱為施密特 ^爾曼遽波器(Schnidt-Kalman)的降階遽波 器被考慮使用,它允許一些特定的狀態被考慮但不作出估 計,由於一些非線性效應能被包含在量測模型中,因而這 15種濾波器有較寬待收斂範圍。 在FCKGA中,開發魯棒的多模式組合導航卡爾曼濾波 器執行IMU空中對準、誤差校正、導航解算是關鍵的技術 核心,所有的原始測量,經過數據融合和故障檢測和融離 處理之後,和一些相應的指令被一起送入多模式組合卡爾 20曼濾波器,因而除多模式濾波器設計之外,好幾種預處理 過程應當首先實現,它們包括GPS/BMU故障檢測、識別、 隔離,以便於可靠的量測被送入多模式導肮濾波器,反過 來多模式導航濾波器的正確輸出又能用來得以進行正確的 故障分析。 -32· ( CNS ) ( 210X297^* ) --------Γ- 1^------1T-----0 (讀先聞讀背面之注項再填寫本頁) 經濟部中央標準局員工消費合作社印製 4483 04 A7 _____B7_ 五、發明説明(31) 請參閲第一圖所示,第4步驟中,魯棒統計和估計被 用於一導航結果的協方差分析6〇6的方差分析,以便於提 供P-V-A輔助信息,系統重構指令以及可靠的導航結果; 發展的故障分析算法能有效地檢測隔離、補償衛星信號故 5障和IMU傳感器故障,能使系統為戰術武器等載體的控制 系統提供滿足要求的導航和制導信號。 來自人機界面的模型選擇指令和濾波器參數被一指令 601接收和解釋,其結果被输出給一模式選擇模塊6〇3。 來自該載波相位模糊整數求解50的GPS量測、來自該 10導肮信息解碼30的GPS衛星星曆' 以及來自該導航解算40 的INS導航參數被該數據602接收並送入該模式選擇模塊 603。 基於接收到的模型選擇指令和濾波器參數以及GPS和 INS所有可獲得的量測,該模式選擇模塊6〇3作出當前全整 15合定位的處理模式,並將相應的系統模型和量測模型送入 一組合導航系統重構模塊604,模式選擇模塊可能選擇的 模式包括: 1) GPS/IMUP-V(位置和速度)組合模式 2) 無GPS跟蹤環路輔助的GPS/IMU(p/Δ t; + Δ Θ )(偽 20 距和偽距率)組合模式 3) 有GPS跟蹤環路輔助的GPS/MUO/δ ν + Δ Θ)(偽 距和偽距率)組合模式 4) 無GPS跟蹤環路輔助的GPS/MU(p +0/Δ r+△ Θ )(偽距,偽距率和載波相位)組合模式 -33- 本紙張尺度逍用中围固家襟準(CNS ) A4規格(210父297公釐_) 83. 3.10,000 I J 裝 ϋ ^ I "線 (請先閲讀背面之注意事項再填寫本頁) 經濟部中央標率局員工消費合作社印製 4B3 〇4 A7 ~^ -----B7_ 五、發明説明(32) 5)有GPS跟蹤環路輔助的GPS/IMU〇 + 0/Δ v + Δ θ )(偽距、偽距率和載波相位)組合模式 來自該模式選擇模塊603的系統模式和量測模式以及 遽波器的量測被該組合導航系統重構模塊604接收,並用 5來執行系統模型的離散化操作以及量測模型的線性化操作 :基於來自導航結果的協方差分析606之量測殘差檢測的 結果,該組合導航系統重構模塊604調整系統模型的協方 差矩陣,並將之送入導航求解的魯棒卡爾曼濾波器。 來自該組合導航系統重構模塊604之離散的系統模型 10和線性化的量測模型和調整之後的系統模型的協方差陣以 及形成的濾波器量測,被一導航求解的魯棒卡爾曼濾波器 605接收。 使用接收到的數據,該導航求解的魯棒卡爾曼濾波器 605作出慣性導航參數誤差、慣性傳感器誤差、以及GPS量 15測誤差的最佳估計,並將之送入該導航解算40,並輸出慣 性導航參數誤差和GPS測量誤差的最佳估計以及導航參數 給該载波相位模糊整數求解50 ;输出量測殘差和系統過程 的協方差陣給該導航結果的協方差分析606,輸出導航系 統的最佳輸出,給位置、速度、姿態和時間等;魯棒卡爾 20曼濾波器可以以全階卡爾曼濾波器實現,也可以降階卡爾 曼濾波器實現,如施密特一卡爾曼濾波器。 如果該導航求解的魯棒卡爾曼濾波器605被置於 GPS/IMUP-V組合模式,一個單獨的GPS導航求解模塊可 包含在該導航求解的魯棒卡爾曼濾波器605之中,以便能 •34- --------丨裝----^--訂----- 線 (請先閱讀背面之注意事項再填寫本頁) 本紙張尺度適用中國國家栋準((^ ) A4規格(210X297公釐) 83.3. !〇,〇〇〇 經濟部中央標準局員工消費合作社印製 A7 B7 五、發明説明(33 ) 獲得GPS量測導出的位置和速度,單獨的Gps導航求解模 塊可以是點解法(pointsolution)算法或是卡爾曼濾波算法。 來自該導航求解的魯棒卡爾曼濾波器605的濾波器量 測殘差和系統模型的協方差陣被該導航結果的協方差分析 5 606接收,用以執行濾波器發散檢驗;基於濾波器發散檢 驗的結果,該導航結果的協方差分析6〇6輸出系統摸型的 協方差陣的調整值給該組合導航系統重構模塊6〇4,以便 於保持系統的穩定。 請續參閲第十一圖所示,本發明「完全整合式導航定 10位方法和系統」包含以下器件: 1) 一個GPSRF模塊(U0)801,用以接收GPSRF信號; 2) —個GPS數位信號處理模塊(ui)802,用以外理接收 到的GPS信號,獲得GPS的量測; 3) —個IMU數據探樣模塊(U5)806,用以收集IMU的量 15 測數據; 4) 一個集中處理式導航卡爾曼濾波器(U2)803,用以接 收並處理IMU和GPS的量測; 5) —個接口模塊804,用以實現與其它航電系統的數據 和控制信息的通信; 20 6)—個定時信號合成模塊(U4)805,用以給其它器件提 供定時信號和本地參考信號,· 該GPSRF模塊(U0)801接收GPS衛星發射的RF信號, 將之放大並下變頻到正信號,該GPS數位信號處理模塊 (Ul)802)對模擬的IF信號進行數位化,並在一DSP(數位信 -35- --------- 1赛------’1T-----ί 0 (請先閲讀背面之注意事項再填寫本頁) 本紙張尺度適用中國國家樑準(CNS ) Α4規格(210XW7公釐) 83. 3.10,000 448304 經濟部中央標準局貝工消費合作杜中裝 A7 B7 五、發明説明(34) 號外理機)內執行外部]^^^辅助的DLL和PLL操作,以 及導航信息的解碼,輸出原始量測數據和導航信息;集中 處理式導航濾波器是組合導航系統的心臟,它使用魯棒卡 爾曼德波技術執行導航解算並動態校正誤差;此外, 5加速度和速度信息被反饋回GPS數位信號處理模塊802用以 輔助GPS接收機的碼和載波相位跟蹤環路,以便提高Gps 接收器件的動態性能;該定時信號合成模塊似4)805是一個 頻率參考器件,用以為GPSRP模塊提供本地參考信號,為 GPS數位信號處理模塊即)802和該娜數據採樣模塊 10 (U5)806提供同步控制頻率和信號;該數據探樣模塊 (U5)80(5是一個IMU數據探樣和變換模塊,該接口模塊8〇4 用以實現與其它航電系統的數據和控制信號的通信。 該GPSRF模塊(U0)801通過一個接口’如電纜、與 GPS數位信號處理模塊(Ul)802和該定時信號合成模塊 15 (U4)805相連,進一步包括下列组件: A: —個GPS無線和多個GPS天線,用以接收GPS衛星 發出的信號; B: RF-IF變頻器’它連接於GPS天線和該GPS數位信 號處理模塊(Ul)802之間’並與該定時信號合成模塊 20 (U4)805相連以便取得本地參考信號,κρ·]ρ變頻器將來自 GPS天線的GPSRF信號,下變頻到GPSIF信號,並將之輸 出到該GPS數位信號處理模塊(Ul)802。 一個放大器可以連接在GPS天線和RF-IF變頻器之間, 用以放大GPS信號,提高GPS信號的信號一噪聲比。 -36- 本紙張尺度適用中國國家標率(CMS ) Α4規格(210X297公釐) 83.3.10,000 -------1^-------iT----- 0 (請先Μ讀背面之注意事項再填寫本頁) 經濟部中央標準局貝工消費合作社印製 Α7 _..___Β7___ 五、發明説明(35 ) — "" 該GPS數位信號處理模塊(uimm連接在該Gps即模 塊_801和該集中處理式導航卡㈣顏器8()3之間,同 時也與該定時信號合成模塊8〇5相連,以便獲得定時信號 ;該61^數位信號處理模塊(ui)·進一步包括下列器件: 5 A: 一個A70轉换器,它連接在該GPSRF模塊(U0)801 的RF-正變頻器和一個DSP外理機之間’用來探樣來自該 GPSRF模塊(U0)801的RF-EF變頻器的(31>3正信號。 B: —DSP處理機’它連接在a/d轉換器和該集中處理 式導航卡爾曼濾波器(U2)803之間,用以跟蹤和外理GPS數 10位信號,以便獲得GPS量测’並將之輸出給該集中處理式 導航卡爾曼濾波器(U2)803。 一個IF—基帶變頻器可連接在該GPSRF模塊 (U0)801RF-IF變頻器和A/D轉換器之間,以便進一步將IF信 號下變頻至基帶信號,並將之輸出給A/D變換器; 15該集中處理式導航卡爾曼濾波器(U2)803是一微外理機,它 與該GPS數位信號處理模塊(Ul)802和該接口模塊8〇4、以 及該IMU數據探樣模塊(U5)806相連,以便處理來自GPS數 位信號處理模塊(Ul)802的GPS測量和來自該IMU數據採樣 模塊(U5)806的IMU測量。 20 該接口模塊804與該集中處理式導航卡爾曼濾波器 (U2)803相連,用以實現與其它航電系統的通信,它可能包 含以下幾種類型: 1)申行信號接口,包括同步通信接口和升步通信接口 ,諸如RS-232接口,或RS-422接口,RS-485接 口等; -37- 本紙張尺度適用中國國家標準(CNS ) A4規格(210X297公釐) ----------------ΐτ-----0 (請先閲讀背面之注$項再填寫本頁)Description of the invention (28) Printed by the Shellfish Consumer Cooperative of the Central Bureau of Standards of the Ministry of Economics Please continue to refer to the ninth figure. In the third step, the gyro-sensitive body angular velocity from the inertial tracking device 5 is input into the Attitude matrix calculation module 401; body health from the inertial measurement device 5, rotation vectors from a local navigation coordinate system (n system) to an inertial coordinate system (ι system) from a navigation calculation module 404, and from the combined Kalman The waver 60 attitude error estimation is received by the attitude matrix calculation module 401 to update the attitude matrix and compensate for its errors; methods for updating the attitude matrix include Eular, direction cosine, and Quaternion method. The attitude matrix is output by the attitude matrix calculation module 401 to an attitude angle calculation module 403, which is used for extracting the pitch angle, the die flow angle, and the heading angle from the attitude matrix as a part of the INS navigation output parameters. The acceleration measured by the accelerometer from the inertial measurement device 5 is expressed in the body coordinate system, and it and the attitude matrix from the attitude matrix calculation module 401 are received by an attitude matrix transformation module 402; the input expression is in the body coordinate system The acceleration in the image is converted into the acceleration expressed in the navigation coordinate system (n system) by the attitude matrix transformation module 402 and output to the navigation calculation module 404. The 20 best estimates of the acceleration from the attitude moment barrier transform module 402 in the navigation coordinate system and the position and velocity errors from the combined Kalman filter are received by the navigation calculation module 404 to calculate the position, velocity 'and The compensated position and velocity errors are used to calculate the rotation vector from the local navigation coordinate system to the inertial coordinate system; the position and velocity are part of the INS navigation parameters output by the navigation calculation module 404 to the combined Kalman filter 60, The rotation vector of the inertial coordinate system from the local navigation coordinate series is the 10 15 -30- This paper is universal ® National Standard (CNS > A4 Lin · (210X297 mm) 83.3.10,000 (Please read the notes on the back first (Fill in this page again.) Pack. Order printed by the Consumer Standards Cooperative of the Central Standards Bureau of the Ministry of Economic Affairs 483 04 A7 ------- -B7_ V. Description of the invention (29) ~ " ~ The navigation calculation module 404 outputs to the attitude matrix The calculation module 40 is well known that real-time Kalman filters can give the best state estimates. 'These estimates are unbiased, and in the smallest unbiased linear estimation, the difference is small; then, A hypothetical digital model is consistent with reality, and its estimation accuracy can only be guaranteed. Any inaccuracy of any model may lead to ineffective results. Therefore, it is very important to find a new method to verify the validity of the assumed digital model. Importantly, especially in the combined GPS / IMU navigation system, the key to the successful application of the real-time Kalman filter is to design a leaky wave model of appropriate size to predict the performance of the system 'while meeting the limits of external processor throughput10; In the design of FCKGA-based integrated navigation systems, the filters must be robust enough to run in different dynamic environments, because FCKGA-based integrated navigation systems will be applied to a large class of military / civilian mobile platforms, such as tactical weapons, Unmanned aerial vehicles, smart bombs, precision strike weapons, and other avionics systems; if the dynamic changes are severe, or a sensor failure occurs, such as a GP_15 star signal failure, or an inertial sensor failure, the filter must be able to detect, correct, and dissolve the failure, and eventually Reconfigure the integrated navigation system. Regardless of the filter's completeness and robustness are usually separated Research, but in fact they are inseparable. 'A robust Kalman filter can provide near-optimal performance under a large class of systems and measurement models. The standard 20 Kalman filter is not robust. Because it can only provide the best performance for a particular system and measurement model, if the filter is incorrect, the reported accuracy of the filter's variance may be very different from its actual accuracy; filter integrity The purpose is to ensure that the performance of its error variance matrix prediction is close to the statistical characteristics of the actual estimated error. -31- Common paper country (CNS) A4 Lai of this paper; (21〇χ297 mm) 83.110 ^ 000 --- -----. I install ----.-- order ----- line (please read the note $ on the back before filling this page) B7 V. Description of the invention (30) In addition, the divergence of the filter is usually caused by the change of the system model and the measurement model or the sensor error; the residual detection method can effectively detect the hard and soft faults of the tide and the divergence of the filter ' One of the advantages of the residual detection method is when the model is correct The statistical characteristics of the residual sequence are known; in this way, it is easier to implement measurement editing and divergence detection using the statistical distribution test of the measurement residual. The same statistical test can also be used to assist in detecting filtered divergence. Tuner tuning and adjustment of variance. Since the state error variance matrix is projected into the measurement geometry and affects the statistical characteristics of the residuals, in order to ensure a reasonable false alarm rate, the error variance 10 matrix must be accurate and at least conservative, which requires all known Measurement errors should be properly modeled and the system model should be fairly accurate; a reduced-order chirper called Schnidt-Kalman is considered for use, which allows some specific The state is considered but not estimated. Since some non-linear effects can be included in the measurement model, these 15 filters have a wide range of convergence. In FCKGA, the development of a robust multi-mode integrated navigation Kalman filter to perform IMU aerial alignment, error correction, and navigation calculation is the key technical core. All original measurements are processed after data fusion and fault detection and fusion. And some corresponding instructions are sent into the multi-mode combined Carl 20-man filter. Therefore, in addition to the multi-mode filter design, several pre-processing processes should be implemented first. They include GPS / BMU fault detection, identification, and isolation. So that the reliable measurement is sent to the multi-mode filter, the correct output of the multi-mode navigation filter can be used to perform the correct fault analysis. -32 · (CNS) (210X297 ^ *) -------- Γ- 1 ^ ------ 1T ----- 0 (Read the notes on the back and then fill out this page) Printed by the Employees' Cooperative of the Central Standards Bureau of the Ministry of Economic Affairs 4483 04 A7 _____B7_ V. Description of the Invention (31) Please refer to the first figure. In the fourth step, robust statistics and estimates are used for the covariance analysis of a navigation result. The analysis of variance of 606 is in order to provide PVA auxiliary information, system reconstruction instructions and reliable navigation results; the developed fault analysis algorithm can effectively detect and compensate for satellite signal faults and IMU sensor faults, which can make the system Tactical weapons and other carrier control systems provide the required navigation and guidance signals. The model selection instruction and filter parameters from the human-machine interface are received and interpreted by an instruction 601, and the result is output to a mode selection module 603. GPS measurements from the carrier phase fuzzy integer solution 50, GPS satellite ephemeris 30 from the 10-channel information decoding 30, and INS navigation parameters from the navigation solution 40 are received by the data 602 and sent to the mode selection module 603. Based on the received model selection instructions and filter parameters and all available measurements from GPS and INS, this mode selection module 603 makes the current full 15-position positioning processing mode, and applies the corresponding system model and measurement model It is sent to an integrated navigation system reconstruction module 604. The modes that the mode selection module may choose include: 1) GPS / IMUP-V (position and speed) combined mode 2) GPS / IMU (p / Δ without GPS tracking loop assistance) t; + Δ Θ) (pseudo 20-range and pseudo-range rate) combined mode 3) GPS / MUO / δ with GPS tracking loop assist (V + Δ Θ) (pseudo-range and pseudo-range rate) combined mode 4) no GPS Tracking loop-assisted GPS / MU (p + 0 / Δ r + △ Θ) (pseudorange, pseudorange rate, and carrier phase) combination mode (210 father 297 mm_) 83. 3.10,000 IJ decoration ^ I " line (please read the precautions on the back before filling this page) Printed by the Consumer Standards Cooperative of the Central Standards Bureau of the Ministry of Economic Affairs 4B3 〇4 A7 ~ ^ ----- B7_ V. Description of the invention (32) 5) GPS / IMU with GPS tracking loop assistance + 0 / Δ v + Δ θ) (pseudorange, pseudorange rate and carrier phase) The combined mode is the system mode and measurement mode from this mode selection module 603 and the measurement of the wave receiver is received by the integrated navigation system reconstruction module 604, and 5 is used to perform the discretization operation of the system model and the linearization of the measurement model Operation: Based on the measurement residual detection results from the covariance analysis 606 of the navigation results, the integrated navigation system reconstruction module 604 adjusts the covariance matrix of the system model and sends it to the robust Kalman filter of the navigation solution . The discrete system model 10 from the integrated navigation system reconstruction module 604, the linearized measurement model, the covariance matrix of the adjusted system model, and the formed filter are measured by a robust Kalman filter of a navigation solution Receiver 605. Using the received data, the robust Kalman filter 605 of the navigation solution makes the best estimation of inertial navigation parameter error, inertial sensor error, and GPS measurement error, and sends it to the navigation solution 40, and Output the best estimate of inertial navigation parameter error and GPS measurement error and the navigation parameter to solve the carrier phase fuzzy integer 50; output the measurement residual and the covariance matrix of the system process to the navigation result covariance analysis 606, and output the navigation system The best output is given by position, velocity, attitude, time, etc. The robust Kalman 20-man filter can be implemented by a full-order Kalman filter or a reduced-order Kalman filter, such as Schmidt-Kalman filter Device. If the navigation solution's robust Kalman filter 605 is placed in the GPS / IMUP-V combination mode, a separate GPS navigation solution module can be included in the navigation solution's robust Kalman filter 605 to enable • 34- -------- 丨 Installation ---- ^-Order ----- Thread (Please read the precautions on the back before filling this page) This paper size is applicable to China National Standard ((^ ) A4 specification (210X297 mm) 83.3.! 0.0, 〇〇〇 Printed by the Consumers' Cooperative of the Central Standards Bureau of the Ministry of Economic Affairs A7 B7 V. Description of the invention (33) Obtain the position and speed derived from GPS measurement, separate GPS navigation solution The module can be a point solution algorithm or a Kalman filter algorithm. The filter from the robust Kalman filter 605 of the navigation solution measures the residuals and the covariance matrix of the system model by the covariance analysis of the navigation result. 5 606 received to perform the filter divergence test; based on the results of the filter divergence test, the covariance analysis of the navigation result 606 outputs the adjusted value of the system's model covariance matrix to the integrated navigation system reconstruction module 6 〇4, in order to maintain the system Stable. Please refer to Figure 11 below. The "fully integrated navigation positioning and positioning method and system" of the present invention includes the following components: 1) a GPSRF module (U0) 801 for receiving GPSRF signals; 2) — A GPS digital signal processing module (ui) 802 to obtain GPS measurements using GPS signals received from external sources; 3) an IMU data sampling module (U5) 806 to collect IMU measurement data; 4) A centralized processing Kalman filter (U2) 803 for receiving and processing IMU and GPS measurements; 5) an interface module 804 for implementing data and control information with other avionics systems Communication; 20 6) A timing signal synthesis module (U4) 805, which is used to provide timing signals and local reference signals to other devices. The GPSRF module (U0) 801 receives RF signals transmitted by GPS satellites, amplifies them and downloads them. Frequency conversion to a positive signal, the GPS digital signal processing module (Ul) 802 digitizes the analog IF signal, and a DSP (digital signal -35- --------- 1 match ---- -'1T ----- ί 0 (Please read the notes on the back before filling out this page) This paper size applies to China National Beam (CNS) Α4 specification (210XW7mm) 83. 3.10,000 448304 Shellfish consumer cooperation of the Central Standards Bureau of the Ministry of Economic Affairs Du Zhongzhuang A7 B7 V. Description of the invention (External processing machine (34)) Internal and external] ^^^ auxiliary DLL and PLL operations, and decoding of navigation information, output of raw measurement data and navigation information; centralized processing navigation filter is the heart of the integrated navigation system, which uses robust Kalman wave technology to perform navigation solutions and dynamically correct errors In addition, the 5 acceleration and speed information is fed back to the GPS digital signal processing module 802 to assist the GPS receiver ’s code and carrier phase tracking loop in order to improve the dynamic performance of the GPS receiving device; the timing signal synthesis module looks like 4) 805 It is a frequency reference device used to provide local reference signals for the GPSRP module and GPS digital signal processing module (ie) 802 and Genna data sampling module 10 (U5) 806 to provide synchronous control frequency and signals; the data sampling module (U5) 80 (5) is an IMU data sampling and conversion module. The interface module 804 is used to implement data and control signal communication with other avionics systems. The GPSRF module (U0) 801 is connected to the GPS digital signal processing module (Ul) 802 and the timing signal synthesis module 15 (U4) 805 through an interface such as a cable, and further includes the following components: A: a GPS wireless and multiple GPS antennas for receiving signals from GPS satellites; B: RF-IF converter 'It is connected between the GPS antenna and the GPS digital signal processing module (Ul) 802' and is combined with the timing signal synthesis module 20 (U4 ) 805 is connected to obtain a local reference signal, and the κρ ·] ρ inverter down-converts the GPSRF signal from the GPS antenna to a GPSIF signal and outputs it to the GPS digital signal processing module (Ul) 802. An amplifier can be connected between the GPS antenna and the RF-IF inverter to amplify the GPS signal and improve the signal-to-noise ratio of the GPS signal. -36- This paper size applies to China National Standards Rate (CMS) Α4 specification (210X297 mm) 83.3.10,000 ------- 1 ^ ------- iT ----- 0 (please first (Please read the notes on the back and fill in this page) Printed by the Central Standards Bureau of the Ministry of Economic Affairs, Shellfish Consumer Cooperative, Α7 _..___ Β7 ___ V. Description of Invention (35) — " " The GPS digital signal processing module (uimm is connected to the Gps is between the module _801 and the centralized processing navigation card Yan 8 () 3, and is also connected to the timing signal synthesis module 805 to obtain timing signals; the 61 ^ digital signal processing module (ui) · Further includes the following devices: 5 A: An A70 converter, which is connected between the RF-positive frequency converter of the GPSRF module (U0) 801 and a DSP processor to probe samples from the GPSRF module (U0) (31 > 3 positive signal of 801 RF-EF inverter. B: —DSP processor 'It is connected between the a / d converter and the centralized processing navigation Kalman filter (U2) 803 for tracking And outside the GPS number of 10-bit signal in order to obtain GPS measurements' and output it to the centralized processing navigation Kalman filter (U2) 803. An IF-baseband variable The converter can be connected between the GPSRF module (U0) 801RF-IF inverter and the A / D converter, so as to further down-convert the IF signal to the baseband signal and output it to the A / D converter; 15 The centralized processing Kalman filter (U2) 803 is a micro processor, which is connected to the GPS digital signal processing module (Ul) 802 and the interface module 804, and the IMU data sampling module (U5) 806. In order to process GPS measurements from the GPS digital signal processing module (Ul) 802 and IMU measurements from the IMU data sampling module (U5) 806. 20 The interface module 804 is connected to the centralized processing navigation Kalman filter (U2) 803 , Used to achieve communication with other avionics systems, it may include the following types: 1) Application signal interface, including synchronous communication interface and step-up communication interface, such as RS-232 interface, or RS-422 interface, RS -485 interface, etc .; -37- This paper size applies to China National Standard (CNS) A4 specification (210X297 mm) ---------------- ΐτ ----- 0 (Please (Please read the note on the back before filling in this page)

、發明説明(36) 經濟部中央梯準局員工消費合作社印製 2) 並行數位信號接口; 3) 網路適配接口,給>JE2000適配卡; 4) 總線接口,如MIL-1553總線和ARIC429接口 該_數據探樣模塊(U5)806連接於該集中處理式導航 5卡爾曼濾波器(U2)803和該定時信號合成模塊(U4)805,它 可能有多種類型,包括: 1) 基於D/A轉換的IMU數據採樣模塊,用於適當應一 個具有模擬信號输出的IMU ; 2) 基於脈衝計數電路的IMU數據採樣模塊,用於適應 10 —個具有脈衝輸出信號的_ ; 3) 基於申行數位通信電路的_數據採樣模塊,用於 適應一個具有串行數位信號接口的_; 4) 基於並行數位信號通信電路的imu數據探樣模塊, 用於適應一個具有並行數位信號接口的Πνίυ ; 15 5)基於網路適配電路的IMU數據採樣模塊,用於適應 一個具有網路標準接口的IMU ;Description of the invention (36) Printed by the Consumer Cooperatives of the Central Ladder Bureau of the Ministry of Economic Affairs 2) Parallel digital signal interface; 3) Network adapter interface for JE2000 adapter card; 4) Bus interface, such as MIL-1553 bus Interface with ARIC429 The _data sampling module (U5) 806 is connected to the centralized processing navigation 5 Kalman filter (U2) 803 and the timing signal synthesis module (U4) 805. It may have multiple types, including: 1) IMU data sampling module based on D / A conversion, used to properly respond to an IMU with analog signal output; 2) IMU data sampling module based on pulse counting circuit, used to accommodate 10 _ with pulse output signals; 3) The _data sampling module based on the application digital communication circuit is used to adapt to a serial digital signal interface; 4) the imu data sampling module based on the parallel digital signal communication circuit is used to adapt to a parallel digital signal interface Πνίυ; 15 5) IMU data sampling module based on network adapter circuit, used to adapt to an IMU with network standard interface;

6)基於總線標準電路的MU數據探樣模塊,用於適應 一個具有標準總線接口的IMU 結果該GPS數位信號處理模塊(U丨)802或該集中處理式 20導航卡爾曼濾波器(U2)803的微外理機具有足夠的速度和容 量,則可取消集中處理式導航卡爾曼濾、波器的微處理機或 該GPS數位信號處理模塊(Ul)8〇2的微處理機,將該集中處 理式導航卡爾曼濾波器(U2)803的操作任務配置給該GPS數 位is號處理模塊(Ul)802的微處理機,或將該(^^數位信號 -38- 本紙張又度適用中國國家標準(CNS ) Α4规格(2ωχ297公嫠) 83.3.10,000 1^------ΐτ----- 0 ί請先閲讀背面之注$項再15^本頁) 448304 A7 £7_____ 五、發明説明(37) 處理模塊(Ul)802的處理任務配置給該集中處理式導航卡爾 曼濾波器(U2)803的微處理機。 正在發展中的先進IMU中,微外理機被嵌入MU的電 子電路中,以便於提高IMU的性能和適應新型慣性傳感器 5 ;進而,如果IMU的微外理機的速度和容量足夠大,則集 中處理式導航卡爾曼濾波器(U2)803的外理任務可被配置給 IMU的微外理機。 該GPS數位信號處理模塊(Ul)8〇2,該集中處理式導航 卡爾曼濾波器(U2)803,該接口模塊804該IMU數據採樣模 10塊(U5)8〇0,以及該定時信號合成模塊(U4)805之間的連接 方式,可探用以下方式: 1) 基於總線設計的連接方式 2) 基於通信口設計的連接方式 3) 基於網路的連接方式 ----------^-----—1T-----0 (請先閑讀背面之注$項再填寫本頁} 經濟部中央揉準局貞工消費合作社印製 -39- ^依尺度遑用中國困家搞率(CNS ) A4規格(21〇><297公着) 83- 3-10,0006) MU data sampling module based on the bus standard circuit, used to adapt an IMU with a standard bus interface. The GPS digital signal processing module (U 丨) 802 or the centralized processing 20 navigation Kalman filter (U2) 803. If the micro processor has sufficient speed and capacity, the centralized processing navigation Kalman filter, wave processor microprocessor or the GPS digital signal processing module (Ul) 802 microprocessor can be eliminated. The operation task of the processing navigation Kalman filter (U2) 803 is configured to the microprocessor of the GPS digital is processing module (Ul) 802, or the (^^ digital signal -38- this paper is again suitable for China Standard (CNS) Α4 specification (2ωχ297 public 嫠) 83.3.10,000 1 ^ ---------- τ ----- 0 ί Please read the note on the back of the page and then 15 ^ this page) 448304 A7 £ 7 _____ V. Description of the invention (37) The processing tasks of the processing module (Ul) 802 are allocated to the microprocessor of the centralized processing navigation Kalman filter (U2) 803. In the advanced IMU under development, the micro processor is embedded in the electronic circuit of the MU in order to improve the performance of the IMU and adapt to the new inertial sensor 5; further, if the speed and capacity of the micro processor of the IMU are large enough, then The external processing task of the centralized processing navigation Kalman filter (U2) 803 can be configured to the micro processor of the IMU. The GPS digital signal processing module (Ul) 802, the centralized processing navigation Kalman filter (U2) 803, the interface module 804, the IMU data sampling module 10 blocks (U5) 800, and the timing signal synthesis The connection methods between modules (U4) 805 can be explored as follows: 1) connection method based on bus design 2) connection method based on communication port design 3) network connection method -------- -^ -----— 1T ----- 0 (please read the note $ on the back side first and then fill out this page) Printed by Zhengong Consumer Cooperative, Central Bureau of the Ministry of Economic Affairs -39- ^ Depending on the standard 遑Engaged in China ’s poor families (CNS) A4 specification (21〇 < 297) by 83- 3-10,000

Claims (1)

4 ΰ 3 8 ABCD 經濟部中央梂準局負工消费合作社印製 六、申請專利範圍 1. -種用於運載麟「完全整合式導航錄方法和系統」 ,包含以下步驟: (a)接收來自一慣性測量儀_刀的該運載體的角速率和 加速度測量,為該慣性測量儀的導航方程計算一初始值 5 ; (b) 接收全球定位系統(GPS)無線電信號,提取該Gps 偽距(pseudorange)偽距率(deltarange)和載波相位 (carrierphase)測量值, (c) 接收該慣性測量儀的角速率和加速度信息,求解該 10導航方程,得出慣性導航信息,包括位置、速度、姿態等 > (d) 混合該GPS偽距,偽距率和载波相位量測以及該慣 性導航信息,以便獲得完全整合式定位結果者。 2. 如申請專利範圍第丨項所述之r完全整合式導航定位方法 15和系統」,其中,在第0)步驟,進一步包含一處理步驟, 即從至少一個外部傳感器中接收該運載體的位置、速度、 姿態測量者。 3. 如申請專利範圍第2項所述之「完全整合式導航定位方法 和系統」,其中,第(a)步驟中,該慣性測量儀是一安裝在 2〇戰術武器上的慣性測量儀,該戰術武器安裝在一發射平台 上,該戰術武器的慣性测量儀和該發射平台的慣性测量儀 的測量或導航參數被一對準濾波器處理,以便為該慣性測 量儀的導航方程提供最佳的初始信息者。 4. 如申請專利範圍第2項所述之「完全整合式導航定位方法 本紙張用中_家揉準(CNS ) A4雜(2獻297公羡) 11 ^1 ϋ 1 n 裝 I I n ^ 111 ί I 線 (請先《讀背面之注$項再填寫本頁) a 4483 0 • A8 B8 C8 D84 ΰ 3 8 Printed by ABCD Consumers' Cooperatives, Central Bureau of Standards, Ministry of Economic Affairs 6. Application for Patent Scope 1.-A method and system for carrying a fully integrated navigation record, including the following steps: (a) Receive from An inertial measuring instrument_knife measurement of the angular velocity and acceleration of the carrier, calculate an initial value of 5 for the navigation equation of the inertial measuring instrument; (b) receive a global positioning system (GPS) radio signal, and extract the GPS pseudorange ( (pseudorange) and deltarange and carrierphase measurements, (c) receive the angular rate and acceleration information of the inertial measurement instrument, solve the 10 navigation equations, and obtain the inertial navigation information, including position, speed, and attitude Etc. (d) Mix the GPS pseudorange, pseudorange rate and carrier phase measurement with the inertial navigation information in order to obtain a fully integrated positioning result. 2. The fully integrated navigation and positioning method 15 and system as described in item 丨 of the patent application, wherein step 0) further includes a processing step of receiving the carrier from at least one external sensor. Position, speed, attitude measurer. 3. The "fully integrated navigation and positioning method and system" as described in item 2 of the scope of the patent application, wherein in step (a), the inertial measurement instrument is an inertial measurement instrument installed on a 20 tactical weapon, The tactical weapon is mounted on a launching platform. The measurement or navigation parameters of the tactical weapon's inertial measurement instrument and the launching platform's inertial measurement instrument are processed by an alignment filter in order to provide the best navigation equations for the inertial measurement instrument. The original informant. 4. As described in item 2 of the scope of the patent application, "Completely Integrated Navigation and Positioning Method Used in the Paper _ Home Rubbing (CNS) A4 Miscellaneous (2 offers 297 public envy) 11 ^ 1 ϋ 1 n installed II n ^ 111 ί I line (please read "Note $ on the back side before filling out this page) a 4483 0 • A8 B8 C8 D8 、申請專利範圍 經濟部中央橾车局貝工消费合作社印製 2系統」,其中,在第0)步驟中,該外部傳感器是—全球 疋位系統接收機,其中,來自該全球定位系統接收機的位 置和速度,和—不精確的姿態信息被首先作為該慣性溯量 儀的導航方程的初值,然後再用該全球定位係統的信號 5該慣性測量進行精對準者。 14 5. 如申請專利範圍第4項所述之「完全整合式導航定位方法 和系統」,其中,在第(b)步驟,該全球定位系統信號是由 該全球定位系統接收機的一载波相位鎖定環路和一碼跟蹤 環路進行跟蹤處理的,在該载波相位鎖定環路和該碼跟蹤 10環路中,該跟蹤處理是由來自第(d)步驟的該完全整合式定 位信息進行輔助者。 6. 如申請專利範圍第5項所述之「完全整合式導航定位方法 和系統」,其中,在第(c)步驟中,該慣性導航結果的誤差 由來自第(d)步驟的該慣性導航參數誤差的最佳估計進行補 15償者。 7. 如申請專利範圍第6項所述之「完全整合式導航定位方法 和系統」,在第(b)步驟之後,進一步包含一附加步驟,即 執行載波相位模糊整數求解和周跳檢测,以便該Gps載波 相位测量可被用於第(d)步驟者。 20 8.如申請專利範圍第7項所述之「完全整合式導航定位方法 和系統」,其中,在第(b)步驟之後,進一步包含一附加步 驟’即用來自身(d)步驟的該完全整合式定位信息輔助該載 波相位模糊整數求解和周跳檢測處理者。 9.如申請專利範圍第1項所述之「完全整合式導航定位方法 -41- 本紙張尺度速用中® S家標半(CNS ) A4洗格(210X297公釐) 裝 Itr·線 (請先聞讀背面之注意事項再填寫本頁) - 經濟部中央揉率局貝工消費合作社印製 44δ3 〇4 >Α8 ?88 *______________D8_______ 申請專利範圍 和系統」,其中,在第(d)步驟中,該GPS偽距、偽距率和 載波相位量測以及該慣性導航信息由一組合卡爾曼濾波器 混合者。 10-如申請專利範圍第8項所述之「完全整合式導航定位方 5法和系統」,其中,在第(d)步驟中,該GPS偽距、偽距率 和載波相位量測以及該慣性導航信息由一組合卡爾曼濾波 器混合者。 1L如申請專利範圍第1項所述之「完全整合式導航定位方 法和系統」,其中,在第(d)步驟中’該GPS偽距、偽距率 10和載波相位量測以及該慣性導肮信息,由一多模式魯棒卡 爾叉遽波器(Muiti-modekdmanfilter)進行混合,該一多模式 魯棒卡爾曼濾波器至少包含下列之一的操作模式: 一 GPS/IMUP-V(位置和速度)組合模式; 一無GPS跟蹤環路辅助的GPS/IMUO /△ v + Α θ )(偽 ^ 距和偽距率)組合模式; 一有GPS跟蹤環路辅助的GPS/IMU(pM v + Λ Θ)(偽 距和偽距率)組合模式; 一無GPS跟蹤環路輔助的GPS/IMU(p -f 0/Δ υ + Δ θ )(偽距,偽距率和載波相位)組合模式; 20 —有GPS跟蹤環路輔助的GPS/IMU〇 + 0/Δ r+ △ 0 )(’偽距率和載波相位)組合模式者。 12.如申請專利範圍第K)項所述之「完全整合式導航定位方 法和系統」,其中,在第(d)步骤中,該GPS偽距、偽距率 和載波相位量測以及該慣性導航信息,由一多模式魯棒卡 42- 本紙張尺度適用中國國家標準(CNS > A4規格(210X297公釐) --------r--丨裝----^--訂------線 (請先聞讀背面之注意事項再填寫本頁) 4483〇42. The scope of application for patents is 2 systems printed by the Central Bureau of Vehicles of the Ministry of Economic Affairs of the Bayong Consumer Cooperative. In which, in step 0), the external sensor is a global positioning system receiver, of which the GPS receiver The position and velocity, and the inaccurate attitude information are first used as the initial values of the navigation equation of the inertial tracer, and then the signals from the global positioning system are used to fine-align the inertial measurements. 14 5. The "fully integrated navigation and positioning method and system" as described in item 4 of the scope of patent application, wherein, in step (b), the GPS signal is a carrier phase of the GPS receiver Locking loop and a code tracking loop for tracking processing. In the carrier phase locked loop and the code tracking 10 loop, the tracking processing is assisted by the fully integrated positioning information from step (d). By. 6. The "fully integrated navigation and positioning method and system" as described in item 5 of the scope of patent application, wherein in step (c), the error of the inertial navigation result is caused by the inertial navigation from step (d). The best estimate of the parameter error is made up for 15 compensation. 7. According to the "fully integrated navigation and positioning method and system" described in item 6 of the scope of the patent application, after step (b), it further includes an additional step, that is, performing carrier phase fuzzy integer solution and cycle slip detection, So that the Gps carrier phase measurement can be used for step (d). 20 8. The "fully integrated navigation and positioning method and system" as described in item 7 of the scope of patent application, wherein after step (b), it further includes an additional step 'that is, the step used in step (d) itself. The fully integrated positioning information assists the carrier phase fuzzy integer solution and cycle slip detection processor. 9. As described in item 1 of the scope of patent application, "Fully Integrated Navigation and Positioning Method-41- This Paper Standard Quick Use ® S House Standard Half (CNS) A4 Washer (210X297 mm)) Itr · line (please First read the notes on the back and then fill out this page)-44δ3 〇4 > Α8? 88 printed by the Shellfish Consumer Cooperative of the Central Rubbing Bureau of the Ministry of Economic Affairs, "______________D8_______ Patent Application Scope and System", where step (d) In the GPS pseudorange, pseudorange rate and carrier phase measurement, and the inertial navigation information are mixed by a combined Kalman filter. 10- The "fully integrated navigation and positioning method and method 5" as described in item 8 of the scope of patent application, wherein, in step (d), the GPS pseudorange, pseudorange rate and carrier phase measurement and the The inertial navigation information is mixed by a combined Kalman filter. 1L The "fully integrated navigation and positioning method and system" as described in item 1 of the scope of the patent application, wherein in step (d) 'the GPS pseudorange, pseudorange rate 10 and carrier phase measurement, and the inertial guidance The dirty information is mixed by a multi-mode robust Kalman chirp filter (Muiti-modekdman filter). The multi-mode robust Kalman filter includes at least one of the following operation modes: a GPS / IMUP-V (location and Speed) combined mode; a GPS / IMUO / △ v + Α θ (pseudo-range and pseudo-range rate) combined mode without GPS tracking loop assistance; a GPS / IMU (pM v + Λ Θ) (pseudorange and pseudorange rate) combined mode; a GPS / IMU (p -f 0 / Δ υ + Δ θ) (pseudorange, pseudorange rate, and carrier phase) combined mode without GPS tracking loop assistance 20 — Those with GPS / IMU0 + 0 / Δr + Δ0) ('pseudorange rate and carrier phase) combined mode with GPS tracking loop assistance. 12. The "fully integrated navigation and positioning method and system" as described in item K) of the patent application scope, wherein in step (d), the GPS pseudorange, pseudorange rate and carrier phase measurement and the inertia Navigation information, by a multi-mode robust card 42- This paper size applies to Chinese national standards (CNS > A4 size (210X297 mm) -------- r-- 丨 installation ---- ^- Order ------ line (please read the precautions on the back before filling in this page) 4483〇4 經濟部中央梯準局—工消费合作社印裝 爾曼遽波器(Multi-modekalmanfilter)進行混合,該一多模式 魯棒卡爾曼濾波器至少包含下列之一的操作模式: 一 GPS/IMUP-V(位置和速度)组合模式; —無GPS跟蹤環路輔助的GpS/]MU(p Μ V十Δ Θ )(偽 5 距和偽距率)組合模式; —有GpS跟蹤環路辅助的GPS/MU(/> /Δ ν + Α Θ )(偽 距和偽距率)組合模式; 一無GPS跟蹤環路輔助的GPS/IMU(p +必/δ υ + Δ Θ X偽距’偽距率和載波相位)組合模式; 10 —有GPS跟蹤環路輔助的GPS/IMU(p + 0/δ ν + Δ Θ )(偽距,偽距率和載波相位)組合模式者。 13. 如申請專利範圍第1〇項所述之「完全整合式導航定位方 法和系統」,其中,來自該慣性测量儀的該機體角速率和 加速度信息,在該慣性導航求解模塊中被進一步處理,其 15結果被送入該組合卡爾受濾波器,該組合卡爾曼濾波器提 供的誤差估計,被反饋回該慣性導航求解模塊,用以補償 位置誤差、速度誤差以及傳感器誤差者。 14. 如申請專利範圍第13項所述之「完全整合式導航定位方 法和系統」,其中,該GPSRF信號被一GPS天線接收,然 2〇後經該GPSRP/IF模塊、該载波和碼跟蹤環路、該载波相位 模糊求解模塊、以及該信息解碼模塊外理之後,被送入該 組合卡爾曼濾波器,同時來自該組合卡爾曼濾波器的最佳 速度和加速度信息被反镄回該載波和碼跟蹤迴路,輔助載 波和碼跟蹤外理,來自該慣性導航求解模塊的位置、速度 -43- 本紙張尺度逍用中國«家揉半(CNS ) A4規格(2〗0X297公釐} ----------------^-----.捧 (請先閲讀背面之注^^項再填寫本頁) 4483〇/ '申請專利範圍 AS B8 C8 D8 10 15 20 經濟部中央梯準局貞工消費合作社印裝 、姿態信息驗人誠倾糊轉題,醜輔助求 GPS载波相位模糊整數者。 15. -種腿韻H之「完全整合轉航定财法和系統, ,包含以下部件: 」 -全球錄紐(GPS)鱗雖F)信號機,用以接收 GPS RF信號放大該GPS RF信號,並將該鹏站信號 下變頻到中頻(正)信號; ;l* 、—信號處理模塊,用以探樣該Gps JP信號, 並提取出GPS偽距、偽距率和載波相位測量; 一IMU數據採樣模塊,用收集來自一慣性测量組件 (IMU)的角速率和加速度信號; 一集中處理式導航卡爾曼濾波器,用以接收和處理該 GPS偽距、偽距率和载波相位測量,以及來自該_的角 速率和加速度測量; 至少一個接口模塊’用以實現和其它航電系統的數據 和控制信息的通信; 一定時信號合成模塊,用以為上述部件提供定時信號 和本地參考信號者。 16. 如申請專利範圍第15項所述之「完全整合式導航定位方 法和系統」,其中,該接口模塊,連接於該集中處理式導 航卡爾曼濾波器,用於實現與其它肮電系統的通信,該接 口模塊是一串行信號接口,包括同步通信接口和異步通信 接口者。 Π.如申請專利範圍第I5項所述之「完全整合式導航定位方 -44- —----r--------iT-----ά. (請先《讀背面之注意事項再填寫本頁) 本紙張尺度適用中國困家揲率(CNS ) Μ坑格U10X297公釐) ο 3 8 4 4The Multi-modekalman filter is printed by the Central Elevator Bureau of the Ministry of Economic Affairs-Industrial and Consumer Cooperatives. The multi-mode robust Kalman filter includes at least one of the following operation modes: a GPS / IMUP-V (Position and speed) combined mode;-GpS /] MU (p MV V Δ Θ) (pseudo 5 range and pseudo range rate) combined mode without GPS tracking loop assistance;-GPS / GpS tracking loop assisted GPS / MU (/ > / Δ ν + Α Θ) (pseudo-range and pseudo-range rate) combined mode; GPS / IMU without GPS tracking loop assistance (p + must / δ υ + Δ Θ X pseudo-range 'pseudo-range Rate and carrier phase) combined mode; 10 — Those with GPS / IMU (p + 0 / δ ν + Δ Θ) (pseudorange, pseudorange rate and carrier phase) combined mode with GPS tracking loop assistance. 13. The "fully integrated navigation and positioning method and system" as described in item 10 of the scope of patent application, wherein the body angular velocity and acceleration information from the inertial measurement instrument is further processed in the inertial navigation solution module The 15 results are sent to the combined Kalman filter, and the error estimate provided by the combined Kalman filter is fed back to the inertial navigation solution module to compensate for position error, speed error, and sensor error. 14. The "fully integrated navigation and positioning method and system" as described in item 13 of the scope of the patent application, wherein the GPSRF signal is received by a GPS antenna and then tracked by the GPSRP / IF module, the carrier and code after 20 After the loop, the carrier phase fuzzy solution module, and the information decoding module are processed, they are sent to the combined Kalman filter, and the best speed and acceleration information from the combined Kalman filter is returned to the carrier. And code tracking loop, auxiliary carrier and code tracking external principle, the position and speed from the inertial navigation solution module -43- This paper is scaled by Chinese «Home Kneading (CNS) A4 Specification (2〗 0X297 mm})- -------------- ^ -----. (Please read the note on the back ^^ before filling this page) 4483〇 / 'Application for patent scope AS B8 C8 D8 10 15 20 Printed by the Central Working Group of the Ministry of Economic Affairs, Zhengong Consumer Cooperatives, and the attitude information can be used as a veritable question, and it can help to find the fuzzy integer of the carrier phase of GPS. 15. And system, including the following components: "-Global Records (GPS) scale F) letter Machine for receiving GPS RF signals, amplifying the GPS RF signals, and down-converting the Peng station signals to intermediate frequency (positive) signals; l *, a signal processing module for detecting the GPS JP signal and extracting it GPS pseudorange, pseudorange rate and carrier phase measurement; an IMU data sampling module to collect angular rate and acceleration signals from an inertial measurement unit (IMU); a centralized processing navigation Kalman filter for receiving and Process the GPS pseudorange, pseudorange rate, and carrier phase measurements, as well as angular rate and acceleration measurements from the _; at least one interface module 'to achieve communication of data and control information with other avionics systems; signal synthesis at a certain time Module for providing timing signals and local reference signals for the above components. 16. The "fully integrated navigation and positioning method and system" as described in item 15 of the scope of patent application, wherein the interface module is connected to the centralized processing navigation Kalman filter and is used to implement Communication, the interface module is a serial signal interface, including a synchronous communication interface and an asynchronous communication interface. Π. As described in item I5 of the scope of patent application, "Fully Integrated Navigation and Positioning Party-44- —---- r -------- iT ----- ά. (Please read the back Please fill in this page for the matters needing attention) This paper size is applicable to China ’s poor household rate (CNS) Μ pit grid U10X297 mm) ο 3 8 4 4 8888 ABCD 經濟部中央揉率局貝工消費合作社印装 法和系統」,其中,該接口模塊,連接於該集中處理式導 航卡爾曼濾波器,用於實現與其它航電系統的通信,該接 13模塊是一並行數位信號接口者。 18. 如申請專利範圍第15項所述之「完全整合式導航定位方 5法和系統」,其中,該接口模塊,連接於該集中處理式導 航卡爾曼濾波器,用於實現與其它航電系統的通信,該接 口才吴塊是一網路適配器(adapter)者》 19. 如申請專利範圍第15項所述之「完全整合式導航定位方 法和系統」,其中,該接口模塊,連接於該集中處理式導 10航卡爾曼濾波器,用於實現與其它航電系統的通信,該接 口模塊是一總線接口者。 20. 如申請專利範圍第15項所述之「完全整合式導航定位方 法和系統」,其中,該IMU數據探集模塊,連接於該集中 處理式導航卡爾曼濾波器和該定時信號合成器,是—基於 15脈衝計數電路的模塊,以便適應具有脈衝信號輸出的該 IMU 者。 21. 如申請專利範圍第μ項所述之「完全整合式導航定位方 法和系統」,其中,該]MU數據探集模塊,連接於該集中 處理式導航卡爾曼濾波器和該定時信號合成器,是一基於 20串行數位信號通信電路的模塊,以便適應具有串行數位信 號輸出接口的該IMCJ者。 22‘如申請專利範圍第17項所述之「完全整合式導航定位方 法和系統」,其中,該IMU數據探集模塊,連接於該集中 處理式導航卡爾曼濾波器和該定時信號合成器,是一基於 -45- 本紙張纽朝t S目家衝^^叫八4胁(210父297公釐) -----^--I裝------訂------0 (請先閣讀背面之注意事項再填寫本頁) 448304 經濟部中央揉準局員工消費合作社印製 六、申請專利範圍 並行數位信號通信電路的模塊,以便適應具有並行數位信 號輸出接口的該IMU者。 23. 如申請專利範圍第18項所述之「完全整合式導航定位 方法和系統」,其中,該IMU數據探集模塊,連接於該集 5中處理式導航卡爾曼濾波器和該定時信號合成器,是一基 於網路適配電路的模式,以便於適應具有網路標準輸出的 該IMU者。 24. 如申請專利範圍第15項所述之「完全整合式導航定位 方法和系統」,其中,該IMU數據採集模塊,連接於該集 10中處理式導航卡爾曼濾波器和該定時信號合成器,是一基 方a/d轉換的mu數據採樣模堍,以疋於適夾兵也總線標準 總嗥輸出的該IMU老。 25. 如由請專利範述之「完^整合式淳航.专位 方法和系統」,其中,該IMU數據探集模塊,連接於該集 15中處理式導航卡爾曼濾波器和該定時信號合成器,是一基 於總線標準的模塊,以便於適應具有總線標準總線輸出的 該IMU者。 26. 如申請專利範圍第15項所述之「完全整合式導航定位 方法和系統」,其中,該GPS數位信號處理模塊、該集中 2〇處理式導航卡爾曼濾波器、該接口模塊、該mu數據採樣 電路以及該定時信號合成模塊之間的連接是基於總線的連 接結構者。 27. 如申請專利範圍第15項所述之「完全整合式導航定位 方法和系統」,其中,該GPS數位信號處理模塊、該集中 (請先閲讀背面之注意事項再填寫本頁) -46- 本紙張尺度適用中國國家標率(CNS ) A4規格(210X297公釐) 4483 04 A8 B8 C8 D8 六、申請專利範圍 處理式導航卡爾曼濾波器該接口模塊、該IMU數據採樣電 路以及該定時信號合成模塊之間的連接是基於通信口的連 接結構者。 28.如申請專利範圍第15項所述之「完全整合式導航定位 5 方法和系統」,其中1該GPS數位信號處理模塊、該集中 處理式導航卡爾曼濾波器、該接口模塊、該IMU數據採樣 電路以及該定時信號合成模塊之間的連接是基於網路的連 接結構者。 (請先閲讀背面之注意事項再填寫本頁) 經濟部中央標準局勇工消t合作社印製 -47- 本紙張尺度適用肀圉ϋ家標準(CNS ) A4*^· ( 210X297公釐)8888 ABCD Printed Method and System for the Shellfish Consumer Cooperative of the Central Rubbing Bureau of the Ministry of Economic Affairs ", where the interface module is connected to the centralized processing navigation Kalman filter for communication with other avionics systems. The 13 module is a parallel digital signal interface. 18. The "fully integrated navigation and positioning method and method" described in item 15 of the scope of the patent application, wherein the interface module is connected to the centralized processing navigation Kalman filter and is used to implement other avionics The communication of the system, the interface is only a network adapter (adapter). 19. The "fully integrated navigation and positioning method and system" as described in item 15 of the scope of patent application, wherein the interface module is connected to The centralized processing navigational Kalman filter is used for communication with other avionics systems. The interface module is a bus interface. 20. The "fully integrated navigation and positioning method and system" as described in item 15 of the scope of patent application, wherein the IMU data acquisition module is connected to the centralized processing navigation Kalman filter and the timing signal synthesizer, Yes—A module based on a 15-pulse counting circuit to accommodate this IMU with a pulse signal output. 21. The "fully integrated navigation and positioning method and system" as described in the patent application No. μ, wherein the] MU data acquisition module is connected to the centralized processing navigation Kalman filter and the timing signal synthesizer , Is a module based on a 20 serial digital signal communication circuit in order to adapt to the IMCJ with a serial digital signal output interface. 22 'The "fully integrated navigation and positioning method and system" as described in item 17 of the scope of patent application, wherein the IMU data acquisition module is connected to the centralized processing navigation Kalman filter and the timing signal synthesizer, It's based on -45- This paper New Chao t S Muji Chong ^^ called eight 4 threats (210 father 297 mm) ----- ^-I installed ------ Order ----- -0 (Please read the notes on the back before filling in this page) 448304 Printed by the Central Consumers Bureau of the Ministry of Economic Affairs, Consumer Cooperatives 6. The module for parallel digital signal communication circuit for patent application, in order to adapt to the digital signal output interface with parallel digital signal output interface The IMU. 23. The "fully integrated navigation positioning method and system" as described in item 18 of the scope of patent application, wherein the IMU data acquisition module is connected to the processing navigation Kalman filter in the episode 5 and the timing signal synthesis The device is a mode based on the network adaptation circuit, so as to adapt to the IMU with network standard output. 24. The "fully integrated navigation and positioning method and system" as described in item 15 of the scope of the patent application, wherein the IMU data acquisition module is connected to the processing navigation Kalman filter in the episode 10 and the timing signal synthesizer , Is a base-side a / d conversion mu data sampling module, which is suitable for the IMU output that is compatible with the standard bus. 25. For example, please refer to the "Complete Integrated Integrated Aircraft. Special Method and System" in the patent specification, where the IMU data acquisition module is connected to the processing navigation Kalman filter in the episode 15 and the timing signal. The synthesizer is a module based on the bus standard, so as to adapt to the IMU with the bus output of the bus standard. 26. The "fully integrated navigation positioning method and system" as described in item 15 of the scope of patent application, wherein the GPS digital signal processing module, the centralized 20-processing navigation Kalman filter, the interface module, the mu The connection between the data sampling circuit and the timing signal synthesis module is based on a bus connection structure. 27. The "fully integrated navigation and positioning method and system" as described in item 15 of the scope of patent application, in which the GPS digital signal processing module and the centralized (please read the precautions on the back before filling this page) -46- This paper scale is applicable to China National Standards (CNS) A4 specifications (210X297 mm) 4483 04 A8 B8 C8 D8 6. Application for patent scope Processing navigation Kalman filter The interface module, the IMU data sampling circuit and the timing signal synthesis The connection between the modules is based on the connection structure of the communication port. 28. The "fully integrated navigation and positioning 5 method and system" as described in item 15 of the scope of patent application, wherein 1 the GPS digital signal processing module, the centralized processing navigation Kalman filter, the interface module, the IMU data The connection between the sampling circuit and the timing signal synthesis module is based on a network connection structure. (Please read the precautions on the reverse side before filling out this page) Printed by Yonggong Consumer Cooperative, Central Bureau of Standards, Ministry of Economic Affairs -47- This paper size is applicable to family standards (CNS) A4 * ^ · (210X297 mm)
TW88106585A 1999-04-22 1999-04-22 Fully-coupled positioning process and system TW448304B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
TW88106585A TW448304B (en) 1999-04-22 1999-04-22 Fully-coupled positioning process and system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW88106585A TW448304B (en) 1999-04-22 1999-04-22 Fully-coupled positioning process and system

Publications (1)

Publication Number Publication Date
TW448304B true TW448304B (en) 2001-08-01

Family

ID=21640411

Family Applications (1)

Application Number Title Priority Date Filing Date
TW88106585A TW448304B (en) 1999-04-22 1999-04-22 Fully-coupled positioning process and system

Country Status (1)

Country Link
TW (1) TW448304B (en)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8467434B2 (en) 2008-02-04 2013-06-18 Mediatek Inc. GNSS receiver and method for GNSS memory code generation
US8972166B2 (en) 2012-07-17 2015-03-03 Lockheed Martin Corporation Proactive mitigation of navigational uncertainty
US9074897B2 (en) 2009-06-15 2015-07-07 Qualcomm Incorporated Real-time data with post-processing
US9354321B2 (en) 2006-03-06 2016-05-31 Qualcomm Incorporated Method for position determination with measurement stitching
CN108873034A (en) * 2018-03-30 2018-11-23 广州海格通信集团股份有限公司 A kind of implementation method of inertial navigation subcarrier ambiguity resolution
US10247828B2 (en) 2010-06-02 2019-04-02 Qualcomm Incorporated Position determination using measurements from past and present epochs
CN110988950A (en) * 2018-10-03 2020-04-10 古野电气株式会社 Navigation device, method for generating navigation assistance information, and storage medium
CN112406861A (en) * 2019-08-19 2021-02-26 通用汽车环球科技运作有限责任公司 Method and device for Kalman filter parameter selection by using map data
CN113758373A (en) * 2021-09-07 2021-12-07 重庆天箭惯性科技股份有限公司 Method, device and equipment for improving positioning and speed measurement precision of missile-borne receiver

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9354321B2 (en) 2006-03-06 2016-05-31 Qualcomm Incorporated Method for position determination with measurement stitching
US8467434B2 (en) 2008-02-04 2013-06-18 Mediatek Inc. GNSS receiver and method for GNSS memory code generation
US9074897B2 (en) 2009-06-15 2015-07-07 Qualcomm Incorporated Real-time data with post-processing
US10247828B2 (en) 2010-06-02 2019-04-02 Qualcomm Incorporated Position determination using measurements from past and present epochs
US8972166B2 (en) 2012-07-17 2015-03-03 Lockheed Martin Corporation Proactive mitigation of navigational uncertainty
CN108873034A (en) * 2018-03-30 2018-11-23 广州海格通信集团股份有限公司 A kind of implementation method of inertial navigation subcarrier ambiguity resolution
CN110988950A (en) * 2018-10-03 2020-04-10 古野电气株式会社 Navigation device, method for generating navigation assistance information, and storage medium
CN112406861A (en) * 2019-08-19 2021-02-26 通用汽车环球科技运作有限责任公司 Method and device for Kalman filter parameter selection by using map data
CN112406861B (en) * 2019-08-19 2024-03-22 通用汽车环球科技运作有限责任公司 Method and device for carrying out Kalman filter parameter selection by using map data
CN113758373A (en) * 2021-09-07 2021-12-07 重庆天箭惯性科技股份有限公司 Method, device and equipment for improving positioning and speed measurement precision of missile-borne receiver
CN113758373B (en) * 2021-09-07 2023-01-10 重庆天箭惯性科技股份有限公司 Method, device and equipment for improving positioning and speed measurement precision of missile-borne receiver

Similar Documents

Publication Publication Date Title
US6240367B1 (en) Full fusion positioning method for vehicle
US6278945B1 (en) Fully-coupled positioning process and system thereof
US6449559B2 (en) Fully-coupled positioning process and system thereof
US6311129B1 (en) Positioning process and system thereof
EP2064568B1 (en) Highly integrated gps, galileo and inertial navigation system
US7274504B2 (en) System and method for advanced tight coupling of GPS and inertial navigation sensors
US6167347A (en) Vehicle positioning method and system thereof
US8164514B1 (en) Method and apparatus for fusing referenced and self-contained displacement measurements for positioning and navigation
Alban Design and performance of a robust GPS/INS attitude system for automobile applications
US6246960B1 (en) Enhanced integrated positioning method and system thereof for vehicle
CN104280746B (en) Inertia-assisting GPS deep-integration semi-physical simulation method
US7680221B2 (en) Ultratight navigation observation lock detector
CN107656300B (en) Satellite/inertia ultra-tight combination method based on Beidou/GPS dual-mode software receiver
Sun et al. Ultratight GPS/reduced-IMU integration for land vehicle navigation
CA2721257A1 (en) Satellite-based positioning receiver
Bahrami et al. Instantaneous Doppler-aided RTK positioning with single frequency receivers
Groves et al. Combining inertially-aided extended coherent integration (supercorrelation) with 3D-mapping-aided GNSS
WO1998029755A1 (en) Gps multipath detection method and system
CN108196288A (en) Method for relocating based on micro- inertia, chip atomic clock auxiliary Beidou receiver
Soloviev et al. Deeply Integrated GPS/Low‐Cost IMU for Low CNR Signal Processing: Concept Description and In‐Flight Demonstration
TW448304B (en) Fully-coupled positioning process and system
JP2009222438A (en) Positioning device for movable body
Mathews et al. SCP enabled navigation using signals of opportunity in GPS obstructed environments
Babu et al. Analysis of ultra-tight GPS/INS integrated system for navigation performance
Chiang et al. Kalman filter tracking of limb scan signal using a bank of correlators

Legal Events

Date Code Title Description
GD4A Issue of patent certificate for granted invention patent
MM4A Annulment or lapse of patent due to non-payment of fees