[go: up one dir, main page]

TW454095B - Positioning and ground proximity warning method and system thereof for vehicle - Google Patents

Positioning and ground proximity warning method and system thereof for vehicle Download PDF

Info

Publication number
TW454095B
TW454095B TW88103653A TW88103653A TW454095B TW 454095 B TW454095 B TW 454095B TW 88103653 A TW88103653 A TW 88103653A TW 88103653 A TW88103653 A TW 88103653A TW 454095 B TW454095 B TW 454095B
Authority
TW
Taiwan
Prior art keywords
aircraft
terrain
measurement
ground
error
Prior art date
Application number
TW88103653A
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
Priority claimed from US09/241,164 external-priority patent/US6157891A/en
Application filed by Lin Ching Fang filed Critical Lin Ching Fang
Application granted granted Critical
Publication of TW454095B publication Critical patent/TW454095B/en

Links

Landscapes

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

Abstract

A positioning and ground proximity warning method for vehicle includes the steps of outputting global positioning system signals to an integrated positioning/ground proximity warning system processor; outputting an inertial navigation solution to an integrated positioning/ground proximity warning processor; measuring air pressure, and computing barometric measurements which is output to the integrated positioning/ground proximity warning processor; measuring time delay between transmission and reception a radio signal from a terrain surface, and computing radio altitude measurement which is output to the integrated positioning/ground proximity warning processor; accessing a terrain database for obtaining current vehicle position and surrounding terrain height data which is output to the integrated positioning/ground proximity warning processor; and receiving the position, velocity and time information or said pseudorange and delta range measurements of said global positioning system, the inertial navigation solution, the radio altitude measurement, the radio altitude measurement, and the current vehicle position and surrounding terrain height data, and computing optimal positioning solution data and optimal ground proximity warning solution data.

Description

454 09 5 五、發明說明(1) 本發明係與飛行器之综合定位和地面鄰警 (Integrated Positioning and Ground Proximity454 09 5 V. Description of the invention (1) The present invention relates to the integrated positioning and ground proximity of the aircraft (Integrated Positioning and Ground Proximity)

Warning)之方法和系統有關’特別是指一種融合了為定位 和地面,警系統所配置的感應器之信息,以便獲得更好的 系統性能和更低成本即便是無裝置任何定位裝置的飛行器 亦可使用者。 商用 用價值和 車輛係指 各種政府 另外一個 技術中, 網絡,以 交通動量 從本 和應用智 路運輸的 能公路車 系統大致 系統。 的低成本運動平臺之 市場,商 救護車輛 公務車輛 應用領域 以將車輛 便於單獨 和增加運 世紀8 0年 能两速公 效率,增 輛系統在 可涵.蓋.發 用車輛跟蹤 、救火車輛 等,而智能 ’它應用於 和公路結合 車輛的行駛 輸能力。. 代後期以來 路系統,以 加安全性減 世界上尚未 展中的智能 定位和跟縱系統有很大的應 即是其中之一,這裡的商用 '警用車輛、運輸車輛以及 車輛高速公路系統是該技術 計算機通信、定位、控制等 為一個互相密切關聯的信息 以及在整個公路系統内優化 ,世界各地都在致力於發展 便減少堵塞,提高車輛及公 小耗能,保護環境,盡管智 有統一的分類,但以下六大 公路車輛系統的主要關鍵子 先進交通管理系統 擴展到整個城市的交通 系統要求有關交通情況 網絡中傳播,並作為裝 ’係將單個交通交口的信號管理, 信號定時的實時計算機優化,而該 的信息以實時數據庫之方式在整個 有s亥系統的車輛的動態路徑導引的(Warning) method and system related 'especially refers to a combination of information about sensors configured for positioning and ground and police systems, in order to obtain better system performance and lower costs even for aircraft without any positioning device Available users. Commercial use value and vehicles refer to various government technologies. In another technology, the network is based on traffic momentum, and the road vehicle system of intelligent road transportation is roughly a system. Market for low-cost sports platforms, commercial ambulance vehicles, business vehicle applications, to make vehicles easier to separate and increase the two-speed public efficiency in 1980s, and increase the number of vehicles in the system. And smart, it is used to combine the driving capacity of vehicles with highways. Since the late generation, road systems have increased safety and reduced intelligent positioning and tracking systems that have not yet been unveiled in the world. This is one of them. Commercial 'police vehicles, transport vehicles, and vehicle highway systems are used here. It is this technology that computer communication, positioning, control, etc. are closely related information and optimized in the entire highway system. Everywhere in the world is committed to development, it will reduce congestion, increase vehicle and public energy consumption, and protect the environment. Unified classification, but the following six major key sub-roads of the road vehicle system: the advanced traffic management system is extended to the entire city ’s transportation system, which requires the communication of traffic conditions in the network, and is used as a signal system to manage individual traffic intersection signals Real-time computer optimization, and the information is guided by a real-time database throughout the dynamic path of the vehicle

! 454095 五、發明說明(2) 信息源 先進旅行信息系統, 的地的導航信息以及其它服=駛員提供他的位置信息、目 站,維修服務,醫院^,生務信息,如住宿,飯館,加油 設備與先進旅行信息系統,行信息系統要求車輛上的 徑、交通備用方式等數據,ς =換有關交通狀況、-轉向路 為車輛駕駛員開發的,但紅官先進旅行信息系統最初是 的手持系統和多模式系統。的系統概念也包含用于行人 商用車輛運作系統,包 它用於提高商業和急救車輛”跟蹤和編隊管理系統, 技術,如車輛分類、運動稱曰政率和安全性,它包括很多 以便減少行駛在不同行政轄【内二m站::的通信, 先進車輛控制系統採用另車次數。 車輛,通過輔助駕駛員,加強*,術來榀測路障和鄰近 ill -Hr -te- * - ^ 強對車輛的控制,先進車麵;^ 制技術為向速行駛車輛提供了士 W无進皁輛技 量,該系統最終將同先進交理丄:便:加公路容 輛的自動操作。 ^理糸統互相配合,達到車 除了上述智能車輛高速公路系统之, 八丑六 系統更加強調用戶接口 ,例如車進Λ,、父通 & Ν , ^ . 早上,貞不(如下一站,交通 IS息)、公共車站的實時顯示、智 先進鄉村交通系統,著重 Μ。 .,,'^ _ 者董於將智能車輛公路高速公路 ===間交通的問題,主要是智能車輛高速公路系 統的緊〜、通"fg和安全技術的應用.。 智此車輛回速公路系統仍處於早期發展階段,盡管正454095 V. Description of the invention (2) Information source Advanced travel information system, navigation information and other services of the place = the driver provides his location information, destinations, maintenance services, hospitals ^, life information, such as accommodation, restaurants, Refueling equipment and advanced travel information system. The travel information system requires data on the vehicle's path, traffic backup methods, etc. ς = change of traffic conditions,-turning roads developed for vehicle drivers, but Hongguan advanced travel information system was originally Handheld system and multi-mode system. The system concept also includes a system for pedestrian commercial vehicle operation, including it for improving commercial and emergency vehicles. Tracking and formation management systems, technologies such as vehicle classification, sports rating and safety, it includes many to reduce driving In different administrative jurisdictions [inside two stations :: communication, the advanced vehicle control system uses another number of vehicles. The vehicle, by assisting the driver, strengthen *, to detect roadblocks and neighboring ill -Hr -te- *-^ strong Control of the vehicle, advanced vehicle surface; ^ system technology to provide vehicles with speed and speed of vehicles without soap into the vehicle, the system will eventually deal with advanced technology: convenient: automatic operation of vehicles on the highway. ^ Management 糸In addition to the above-mentioned intelligent vehicle highway systems, the eight systems are more focused on the user interface, such as the car entering Λ, the parent link & Ν, ^. In the morning, Zhenbu (the next stop, traffic IS information ), Real-time display of public stations, intelligent advanced rural transportation system, focusing on M.. ,, '^ _ Zhe Dong Yu will be intelligent vehicle highway highway === inter-vehicle problem, mainly smart vehicle height - tight system of road, pass " fg and security technology applications .. wisdom of this vehicle back to the highway system is still in an early stage of development, although the positive

五、發明說明(3) 在進行各種試驗,還沒有智能車輛高速公路系統技術的實 際應用。 .對於飛行器,目前,已有獨立運行的定位系統和地面 鄰警系統,定位系統甩來給飛行器上其它航電系統,如飛 行控制和管理系統,提供位置、速度、姿態 '姿態速率等 信息,地面鄰警系統用來給飛行員提供飛行器接近地面時 的告警信號,以便防止飛行器在無意情況下與地面或水面 相撞。 傳統的飛行器定位設備一般是慣性導航.系統 (Inertial Navigation System, INS )和一些無線電導 航系統,如遠程導航系統(L ο n g R a n g e N a v i g a t i ο η System, LOR AN )、甚高頻全向測距儀 (Very-High-Frequency Omnidirectional Ranging , VOR) ' 測距儀(Distance Measurement Equipment, ME )、戰術空中導航系統(Tact ical Air Navigation, TACAN) ’以及最新的全球定位系統(Global Positioning System,GPS ) ’ 近年來,組合GPS/慣性導 航系統正在逐步代替傳統的導航系統,成為軍用和民用飛 行器的主要導航設備。 一般來說’一個慣性導航系統包括一個慣性測量組 件、處理機以及嵌入的軟體,定位信息是通過使用慣性傳 感器測量的飛行器比力(s p e c i f i c f 〇 r c e s)和旋轉角速 率’數值求解牛頓(N e w t ο η)運動方程得出的,慣性測量 組件包括慣性傳感器和相應的硬體和電子線路,慣性傳感V. Description of the invention (3) There are no practical applications of the intelligent vehicle highway system technology in various tests. For aircraft, currently there are independent positioning systems and ground adjacent police systems. The positioning system is used to provide other avionics systems on the aircraft, such as flight control and management systems, to provide position, speed, attitude, and attitude information. The adjacent ground police system is used to provide pilots with a warning signal when the aircraft is approaching the ground, in order to prevent the aircraft from colliding with the ground or the water surface unintentionally. Traditional aircraft positioning equipment is generally inertial navigation system (Inertial Navigation System, INS) and some radio navigation systems, such as long-range navigation system (L ng R ange N avigati η System, LOR AN), VHF omnidirectional rangefinder (Very-High-Frequency Omnidirectional Ranging (VOR) 'Distance Measurement Equipment (ME), Tactical Air Navigation (TACAN)' and the latest Global Positioning System (GPS) ' In recent years, the combined GPS / inertial navigation system is gradually replacing the traditional navigation system and has become the main navigation equipment for military and civilian aircraft. In general, 'an inertial navigation system includes an inertial measurement component, a processor, and embedded software. The positioning information is obtained by using the inertial sensors to measure the specific force of the aircraft (specific f rces) and the rotational angle rate. η) According to the equation of motion, the inertial measurement component includes inertial sensors and corresponding hardware and electronic circuits, and inertial sensing

五、發明說明(4) ^~ 〇° 匕括陀—(Gyro)和加速度計(Accelerometer)。 慣性導航系統可以編排為框架式或捷聯式的,在框架 J 貫性導航系統(Gimbaled Inertial Navigation y^te m )中’陀螺和加速度計安聢在一框架平台上,以 的角運動,1將傳感器的測量和導航計算保持 n ®航坐標系内’可選擇的導航坐標系包括與地心 ,慣性坐標系、與地心固聯的地球系、當地水平 ^坐標系(North, East,Down)(當然可以是,東北東 航系二天、當地水平游移方位坐標系),在捷聯慣性導 (strapdown Inertial Navigati〇n 巧以㈣)中, 用% t =性固連於機體坐標系内’-個坐標變換矩陣 (解於ί達在機體坐標系内的加速度轉換到導航坐標李 3析:台),以便在-個穩定的導航坐標系内進!;ί航 ^生=慣性導航系統要承受高動態的飛行環境,這要 速二ί有相當的性能,然、而’隨著新型陀螺和加 ,,扁排方式,這是由于捷聯慣性導航系呈 芏要 性高的特點9 予、,先具有成本低、可靠 主地輸出位置、速度、姿態數赭 ^ 7曰’、、可 主的優點,慣性導航系統也具有輸出備:航=全自 的頻帶等優點,然卜償性導航系統航2 = 時間漂移,它的這種誤差特性主要是由於它的慣性傳^ =原理來說’慣性導航系統是完全自主的,在給定 位置和執打一個初始對準過裎之後, 全自φ从駱山从思、ώ 1 4 Μ . ^員庇#航糸統可以V. Description of the invention (4) ^ ~ 〇 ° Gyro and Accelerometer. The inertial navigation system can be arranged as a frame or strapdown. In the frame J continuous navigation system (Gimbaled Inertial Navigation system), the gyro and accelerometer are mounted on a frame platform with angular motion. Keep the sensor's measurement and navigation calculations within the n ® aeronautical coordinate system. 'Selectable navigation coordinate systems include the geocentric, inertial coordinate system, earth system fixed to the geocentric, local horizontal ^ coordinate system (North, East, Down ) (Of course, it can be the Northeast China Eastern Airlines two-day, local horizontal migration azimuth coordinate system). In strapdown inertial navigation (smartly), use% t = sexually fixed in the body coordinate system'- Coordinate transformation matrices (solved in the analysis of the acceleration in the body coordinate system converted to the navigation coordinate system), so as to advance in a stable navigation coordinate system !; Hang Hang = inertial navigation system to bear High dynamic flight environment, this requires the second speed to have considerable performance. However, with the new type of gyro and Canada, the flat row method, this is because strapdown inertial navigation system is highly characteristic 9 Yu, , With Low cost, reliable main land output position, speed, attitude number 赭 ^ 7 said, can be mastered, the inertial navigation system also has the advantages of output preparation: navigation = full self-frequency band, etc., but compensation navigation system navigation 2 = Time drift, its error characteristic is mainly due to its inertial transmission ^ = In principle, 'inertial navigation system is completely autonomous, after a given position and an initial alignment is performed, the total Luoshan Congsi, Free 1 4 Μ. ^ 员 protect # 航 糸 统 可以

C:\ProgramFiles\Patent\k322p002.ptd 第 9 頁C: \ ProgramFiles \ Patent \ k322p002.ptd page 9

454095 五、發明說明(5) 誤差引起的,如陀螺渔你 等。 、’、 '加速度計偏置、刻度系數誤差 一般來說,提高丨僧& #上 是採用高精度的慣性航糸統的精度有兩中方法,-行補償。 傳感盗,二是使用外部傳感器數據進 開發和製造慣性傳感· 太 此 加,隨著新型慣性傳成本隨它的精度要求而增 發出了低成本的慣技術的最新發展,已經開 器是借助於已有的半導體6η:〇Γ ),#機電慣性傳感 感器和執行部#在石夕片上製造出微小的傳 傳統的慣性傳感H,但在成14傳⑨器的精度可能要低於 帶宦曾方ft至愿执油—成本、尺寸、重量、熱穩定性、 ▼寬4方面要優於傳統的慣性傳感器。 因此’没計一個似占士一 μ* — ^ ^ m «低成本同精度的飛行器定位系統的最 慣性莲妒έ.Κ 。卩傳感态數據補.償的低成本捷聯 價性導知糸統,全球定位454095 V. Description of the invention (5) Error caused by gyro fishing, etc. There are two ways to improve the accuracy of the inertial navigation system using the high-precision inertial navigation system.-Compensation. Sensor theft, the second is to use external sensor data to develop and manufacture inertial sensors. Too much, as the new inertial transmission cost increases with its accuracy requirements, the latest development of low-cost inertial technology has been released. With the help of the existing semiconductor 6η: 〇Γ), the #mechanical inertial sensing sensor and the execution section #have produced a tiny traditional inertial sensor H on the Shi Xi film, but the accuracy of the 14-passer may be required. Lower than Zengfang ft to be willing to perform oil—cost, size, weight, thermal stability, and width 4 are better than traditional inertial sensors. Therefore, ‘not counting one ’s like James’ μ * — ^ ^ m «The most inertia of the aircraft positioning system with low cost and accuracy.卩 Sensor state data compensation. Low cost strapdown Valuation guidance system, global positioning

System,GPS)接收機是 ^HUbal P〇siti〇ning 的外部傳感器個輔助慣性導航系統的最理想 經過20多年的發展,表I+.十, , , r m . 展全球疋位糸統已是一個基於太空 ...L , A候破動式定位和授時系統,該系統 =初的設計目,標是給無限量的、裝有接收設備的空中、 :卜、太空的授權用戶和非授權民用用戶提供精確的位 置、速度 '和時間信息。 全球疋位糸統有三個主要部分:System (GPS) receiver is the external sensor of HUbal P0sitioning. It is the ideal for auxiliary inertial navigation system. After more than 20 years of development, Table I + .ten Space ... L, A waiting-for-moving positioning and timing system, this system = initial design purpose, the target is for an unlimited number of airborne, receiving equipment, authorized users and unauthorized civilian users Provide accurate position, speed 'and time information. The global niches have three main components:

C:\Program Files\Patent\k322p002.ptd 第 10 頁 4 54 09 5 五、發明說明(6) 太空部分:包括繞地球半同步軌道的2 1顆導航衛星和 3顆備用衛星。 地面控制部分:包?括一個主控站和數個分布全球的' 位置精確已知的監控站。 用戶部分:包括各種全球定位系統的接收設嬙。 顯示· 、速 全球定位系統的接收設備包括:天線、接收機, 器等’它接收GPS導航衛星發出的信號,求解出位置 度、時間信息。 GPS能給授權用戶提供精密定位服務(PreciseC: \ Program Files \ Patent \ k322p002.ptd Page 10 4 54 09 5 V. Description of the invention (6) Space part: Including 21 navigation satellites and 3 spare satellites that orbit the earth semi-synchronously. Ground control section: Includes a master control station and several globally distributed monitoring stations with precisely known locations. User section: Includes various GPS receiver settings. Display, GPS receivers include: antennas, receivers, receivers, etc. It receives signals from GPS navigation satellites and solves position and time information. GPS can provide precise positioning services to authorized users (Precise

Positioning Service,PPS ),精度在15 米(圓概率誤 差 ’Spherical Error Probability, SEP)之内,也可以 給民用用戶提供標準定位服務(Standard PositioningSystem,SPS),精度約在 1 0 0 ( 95% 概率),它 包括了多種誤差源,如大氣電離層和平流層效應、GPS的Positioning Service (PPS), accuracy is within 15 meters (Spherical Error Probability, SEP), and can also provide standard positioning service (SPS) for civilian users, accuracy is about 1 0 0 (95% probability ), Which includes a variety of error sources, such as the atmospheric ionosphere and stratospheric effect, GPS

人為 5吳差.選擇可用.性(Selective Availaaability,SA GPS的工作是基於測距三角測量原理,如果用戶能從 衛星星歷中取得GPS衛星的精確位置,就能夠接收Gps衛星 發出的信號,並確定信號的傳播時間,由於信號是以光速 傳播的,因此用戶可計算出用戶到衛星的距離,由於用戶 的時鐘與GPS系統的參考時間存在偏差,實際得出的距 離,包含有誤差,稱之為偽距(Pseud〇 Range ),由于 GPS衛星使用精密的原子鐘,因此它的誤差大大小於用戶 時鐘的誤i,為得出=_置和用戶時鐘,需要至少4顆The artificial 5 Wu difference. Selective availability (Selective Availaaability, SA GPS work is based on the principle of ranging triangulation, if the user can obtain the precise position of the GPS satellite from the satellite ephemeris, can receive signals from GPS satellites, and Determine the propagation time of the signal. Because the signal propagates at the speed of light, the user can calculate the distance between the user and the satellite. Because the user's clock is deviated from the reference time of the GPS system, the actual distance includes errors. Pseud0Range, because GPS satellites use precise atomic clocks, its error is much smaller than the user clock's error i. In order to get = _ and user clock, at least 4

C:\Program Files\Patent\k322p002. ptd 第 11 頁 454095 五、發明說明(7) 衛星的偽距測量佶 這些方法主要可以用不同的方法得出用戶的速度, 測量。 疋基於在兩次偽距測量之間,偽距的變化值 如同任何—彻、.日,丨曰< 號傳播誤差、衛星嘴^系 '统,GPS包含有一些誤差’如信 距誤差包括了 ’包括選擇可用性⑽),用戶測 具有長期的穩二C衛星的所有gps誤差’ gps誤差 被干擾或欺編’當飛信號可以被有意或無意地 遮擋,另外,者丁 D姿恝機動時’ GPS天線有可能被 比( Signal仃器高機動飛行或GPS信號的信號噪聲 失現象。 Γ a t i 0 )較低時’ G P S信號會發生丟 G P S和慣性道“ < GPS或慣性導航系^有的誤差特性表明,獨立使用 要求低成本 '長、期的古一些要求較高的使用條件下,如 擾和高動態能力等,;二;足^的導航輸出、高度抗干 在GPS和慣性導航系統組/ ° 下,慣性導航系統短期的高精产yrnp\egratl〇n)的情況 直接互補,GPS相举於處,彳θV"和GPS的長期的高精度可 有低的噪聲和高的Y據輸-輸出速率低,慣性導航系統 互補的誤差特性表明據=情=差隨時間增加,這種 統相組合,利用兩者的優點, 和慣性導航系 息,這是兩個系統單獨使用不=優的連續導航信 GPS與慣性導航系統組合所 '跃 為: α,、有的潛在的優點可概括C: \ Program Files \ Patent \ k322p002. Ptd Page 11 454095 V. Description of the invention (7) Pseudo-range measurement of satellites These methods can mainly use different methods to obtain the user's speed and measurement.疋 Based on the difference between the two pseudo-range measurements, the pseudo-range changes are like any—To,. ,,, &#; propagation error, satellite mouth system, GPS contains some errors, such as signal distance error includes In order to include 'availability selection'), users can measure all GPS errors with long-term stability of C satellites. GPS errors are disturbed or deceived. When the flying signal can be obscured intentionally or unintentionally. In addition, when D is moving 'The GPS antenna may be lower than (Signal 仃 high maneuvering or GPS signal noise loss phenomenon. Γ ati 0) is lower' GPS signals will lose GPS and inertial track "< GPS or inertial navigation system ^ Yes The error characteristics indicate that independent use requires low-cost, long-term and ancient requirements for high-use conditions, such as disturbance and high dynamic capabilities; Second, full navigation output, high resistance to GPS and inertial navigation In the system group / °, the short-term high-precision production of the inertial navigation system (yrnp \ egratl0n) is directly complementary, and GPS is in place. 彳 θV " and GPS's long-term high accuracy can have low noise and high Y Data input-output rate is low The complementary error characteristics of the inertial navigation system indicate that data = sentiment = difference increases with time. This combination of systems uses the advantages of the two and the inertial navigation system. This is the continuous navigation information that the two systems use separately. The combination of GPS and inertial navigation system is: α, some potential advantages can be summarized

C:\ProgramFiles\Patent\k322p002.ptd 第 12 頁 4 5 4 09 5 --- ^ 五、發明說明(8) ~~ ---:---- r時(:i Ξ ϊ : : :GPS的隨機誤差部分,當能收到GPS信 说夺償ί生導艘糸統的導貌參數誤 段時==供更精確的位置、速度、姿態信息。 )f貝,導航系統可對Gps信號跟蹤提 ,:這樣:減少環路的有效帶寬,提高其在噪聲:境供下輔的 ϋ當,在GPS接牲其在動態環境的跟蹤能力。 通吊在GPS接收機的跟蹤環路設計中,有一個 態跟跺能力,間的折衷問題:輸入的噪聲隨帶寬的增加 增〇,而動態跟縱誤差隨帶寬的增加而減少,組合J 性¥航糸統可緩解這個沖突的信號跟蹤貝 由於可用慣性導航系統的數 扪罟欠坆疋 ⑴慣性導航系統不::路。 失之後再次捕獲所需的搜索時間。 現舌 斤斜2 通過載,體機動為慣性導航系統提供空中飛 1; ί二=:取消常規的慣性導航系統在工作之前的 初:對準’從而提高了慣性導航系統 的 然而,傳統的組合GPS/慣性導在不H 特別是: 廿仳二不足之處, (1 )較低的垂直定位赭谇 6 τ 密進場、著陸_,以及在擁擠的又匕月:滿足飛仃器的精 求。 擠的空域飛行巾,防撞的精度要 (2 )可靠性問題’當低持 , • 3又.的慣性導般系統與GPS衾且C: \ ProgramFiles \ Patent \ k322p002.ptd Page 12 4 5 4 09 5 --- ^ V. Description of the invention (8) ~~ ---: ---- rhr (: i Ξ ϊ:: GPS Part of the random error, when the GPS signal can be received to compensate for the misleading segment of the navigation system parameter == for more accurate position, speed, and attitude information.) F, the navigation system can respond to the GPS signal Tracking: This: Reduces the effective bandwidth of the loop and improves its effectiveness in noise: environment, and GPS tracking capability in dynamic environments. In the tracking loop design of the GPS receiver, there is a state-following capability. The trade-off problem is that the input noise increases as the bandwidth increases, while the dynamic tracking error decreases as the bandwidth increases. The navigation system can alleviate this conflicting signal tracking due to the number of available inertial navigation systems. The inertial navigation system does not :: Road. The search time required to capture again after a loss. It is now oblique 2 to provide aerial flight for the inertial navigation system by carrying, body maneuvering; ί ==: cancel the initial inertial navigation system before work: alignment, thereby improving the inertial navigation system. However, the traditional combination The GPS / inertial guidance is especially important: (2) the shortcomings of the second, (1) the lower vertical positioning, (6) τ close approach, landing, and in the crowded and crescent moon: meet the precision of the aircraft begging. Squeezed airspace flight towel, the accuracy of collision avoidance should be (2) reliability issues ’When low holding, • 3 and. Inertial guidance system and GPS 衾

C:\Prograra Files\Patent\k322p002. ptd 第.13 頁 45 4 09 5 五、發明說明(9) 合時,長期的定位精度主要依賴GPS,如果GPS信號丟失時 間過長’或出現衛星信號本身的故障,則導航精度很快^ 化,甚至無法使用。 、 因此,非常有必要克服這些困難,以便增強飛行的安 全。 隨著航空市場的不斷擴大’航空的安全性日益成為了 非常重要的問題。通常飛機的重大事故可分為以下幾類. (1) 受控制的飛機與地.面相撞(Controlled Flight into Terrain, GFIT) (2) 飛機失控(由於飛機設備失靈原因) (3 )飛機失控(由於機組人員操作失誤原因) (4 )飛機結構或系統失效 (5 )空中相撞 (6 )冰或雪原因 (7 )油料耗盡 (8)飛機失靈(由於其他原因) (9 )跑道_被侵佔 從人類的有動力飛行以來 又彳工飛機與地面相撞 飛行事故,已成為了一個世界範圍的重要的一類飛 故,在這些飛行事故中,由完全合格勝任的機組人員 的、功能正常的飛機常在雲霧或黑暗的氣象條 貝$ 任何告知的情況下’與地面、水面或其他障礙物相撞, 發生這類事故時,沒有冰,也無風切變(Wind 也沒有和其他飛機相撞,飛機處於適當的^制中。C: \ Prograra Files \ Patent \ k322p002. Ptd p.13 45 45 09 5 5. Description of the invention (9) At the same time, the long-term positioning accuracy mainly depends on GPS. If the GPS signal is lost for too long, or the satellite signal itself Failure, navigation accuracy quickly becomes unavailable. Therefore, it is very necessary to overcome these difficulties in order to enhance flight safety. With the continuous expansion of the aviation market, the safety of aviation has become a very important issue. Major aircraft accidents can generally be classified into the following categories. (1) Controlled Flight into Terrain (GFIT) (2) The aircraft is out of control (due to aircraft equipment failure) (3) The aircraft is out of control (Due to crew error) (4) Aircraft structure or system failure (5) Air collision (6) Ice or snow (7) Fuel exhaustion (8) Aircraft failure (due to other reasons) (9) Runway_ Occupied, since the human powered flight and the collision of a handcrafted aircraft with the ground, it has become an important class of accidents worldwide. In these flight accidents, the function of fully qualified crew members is normal Of aircraft are often in the presence of clouds or dark weather. Any notification 'collised with ground, water or other obstacles. In such accidents, there was no ice and no wind shear (Wind did not The plane was in proper control.

C:\Program Files\Patent\k322p002.ptd 第 14 頁 454095 五、發明說明(ίο) 本世紀7 0年代以來,受控飛機與地面相撞事故,收到 了普遍關注和廣泛地研究,自從1 9 74年,美國聯邦航空管 理局(Federal Aviation Administration, FAA)要求在 美國空域飛行的,超過10人以上的商業渦輪喷氣式或渦輪 推進式飛機,安裝一個獨立的地面鄰警系統(GroundC: \ Program Files \ Patent \ k322p002.ptd Page 14 454095 V. Description of the invention (ίο) Since the 1970s, controlled aircraft collisions with the ground have received widespread attention and extensive research, since 1 9 In 1974, the Federal Aviation Administration (FAA) required that a commercial turbojet or turboprop aircraft with more than 10 people flying in U.S. airspace install an independent ground adjacent police system (Ground

Proximity Warning System,GPWS)以來 ’GPWS 已大幅度 地降低了CFIT飛行事故的數量,GPWS通過使用無線電高度 表’來監測飛機與地面的高度。從丨985年以來,平均每年 僅有1到2次飛機CFIT事故’而在FAA頒布GPWS之前,平均 每年約7〜18次CF IT事故。 GPWS計算機跟蹤無線電高度表的指示值,當飛機的飛 行狀況處於下列狀態時,GPWS可為機組人員提供聽覺 '視 覺 '清晰的告警信息: ' (1)當飛機低高度飛行時過分的下降速率;. (2 )過为的接近地面速率(飛機下降太快或飛向較高的 地形) (3 )飛機起飛之後,過分的下降速率; (4 )飛機起飛之後,不慎的下降; (5)不足的淨空(Terrain Clearance)高度; (6 )飛機不是處于進場和著陸的飛行階段時,飛機飛機 飛得太低, 盡管傳統的GPWS已經拯救了成千上萬人的生命,但 GPWS不可能避免所有的CFIT|行事故,傳統的⑶”不^;能 真正地告訴機組人員飛機前方的地形情況,Gpws只能下Since the Proximity Warning System (GPWS), GPWS has significantly reduced the number of CFIT flight accidents. GPWS uses radio altimeters to monitor the altitude of aircraft and the ground. Since 985, there have been only one or two aircraft CFIT accidents per year ’, and before the FAA promulgated the GPWS, there were about 7 to 18 CF IT accidents per year on average. The GPWS computer tracks the radio altimeter indications. When the aircraft's flight conditions are in the following states, the GPWS can provide the crew with audible 'visual' clear warning information: '(1) Excessive descent rate when the aircraft is flying at low altitude; (2) Excessive approaching ground speed (airplane descending too fast or flying to higher terrain) (3) Excessive descent rate after takeoff; (4) Inadvertent descent after takeoff; (5) Insufficient clearance (Terrain Clearance); (6) When the aircraft is not in the approach phase of landing and landing, the aircraft flies too low. Although the traditional GPWS has saved thousands of lives, it is impossible for the GPWS To avoid all CFIT | accidents, the traditional ⑶ "No ^; can really tell the crew the terrain situation in front of the aircraft, Gpws can only download

C:\Program Files\Patent\k322p002. ptd 第 15 頁 1 454 09 5 五、發明說明(11) 視’通過使用一無線電高度表測出地形的高度,將之投影 進將來的各個方向的地形高度,從而預測是否存在有潛在 的CF IT情況’當飛機沿著斜坡型地形飛行時,gpm可告罄 飛行員’但對於一些特殊的情況,如前方是懸崖絕壁或非 常陡峭的地形,則GPWS不可能及時警告,此外,Gpws在一 些特殊情況下,須適當"減小靈敏度11 .,以便減少虛馨 (nuisance warning),例如,當飛行員放出襟翼孝:起落 架’有意使飛機飛向地面時’ GPWS須"減小靈敏度"以避免 不必要的告警。 又 現有的改進的GPWS,被稱為加強型地面鄰警系統 (Enhanced Ground Proximity Warning System,'EGPWS ),是進一步努力避免CFIT飛行事故的產物。EGpw用 全球地形數據庫。此外,EGPWS在下列兩個 僂 統的GPWS : j得 (1 )提供了一個類似地圖的飛機周圍地带顯厂、. (2)它能在飛機接近地面之前約卜分鐘/發不覺止 而傳統的GPWS只能在接近地面幾秒到3〇和奴33 L赏0 s , 1 5秒内警告,EGPWS使用來自機載導妒/之間,平均1 0 ~ 的信息’也使用了飛機的性能和布局:和▲地,數據庫 前進方向的飛行包絡,並與地形數據$ ’計算出沿飛機 EGPWS可顯示飛機周圍地形,飛行員#目比較。由於 續地飛向地面、 丁員4乎不易於使飛機連 現有的定位系統和進地防揸系統的 統和GPWS是兩個分離的獨立系統,敬不十’疋位糸 必須要求.一個外部C: \ Program Files \ Patent \ k322p002. Ptd Page 15 1 454 09 5 V. Description of the invention (11) Vision 'Measure the height of the terrain by using a radio altimeter and project it into the future terrain height in all directions , Thereby predicting the existence of a potential CF IT situation 'gpm can run out of pilots when the aircraft is flying along sloped terrain', but for some special cases, such as cliff cliffs or very steep terrain ahead, GPWS cannot be timely Warning, in addition, in some special cases, Gpws must appropriately reduce the sensitivity11 in order to reduce the nuisance warning, for example, when the pilot releases the flaps: the landing gear 'when the aircraft is intentionally flying to the ground' GPWS must "reduce sensitivity" to avoid unnecessary alerts. The existing improved GPWS, called the Enhanced Ground Proximity Warning System (EGPWS), is the product of further efforts to avoid CFIT flight accidents. EGpw uses a global terrain database. In addition, EGPWS provides a map-like display of the area around the aircraft in the following two general GPWS: (1) It can be used to estimate the minute / time before the aircraft approaches the ground. GPWS can only approach the ground for a few seconds to 30 and slave 33 L reward 0 s, warning in 15 seconds, EGPWS uses information from the airborne jealousy / between, an average of 10 ~ 'also used the aircraft's performance And layout: and ▲ ground, the flight envelope of the database in the forward direction, and calculated with the terrain data $ 'along the aircraft EGPWS can display the terrain around the aircraft, pilot # head comparison. Due to the continuous flight to the ground, the crew cannot easily connect the aircraft with the existing positioning system and ground-entry anti-failure system and GPWS are two separate and independent systems, which must be required. An external

454095 五'發明說明(12) 的定位系統,以便為其提供其定位數據。 如上所述,傳統的組合GPS/慣性導航系統組合了來自 慣性測量組件和GPS接收機的信息,用於提供其性能,現 有的GPWS使用了來自組合GPS/慣性導航系統或單獨的GPS 接收機或單獨的慣性導航系統的定位數據、無線電高度表 和氣壓高度表的高度信息、以及地形數據庫的地形數據, 用以解決地面鄰警問題。無論是組合GPS/慣性導航系統, 還是GPWS都是在微處理機内以軟體方式實現的,隨著微處 理機的速度和容量的不斷提高,有可能實現一個組合的定 位和地面鄰警系統,而且組合定位和地面鄰警系統要比單 獨的定位系統和單獨的地面鄰警系統有更好的性能,這是 因為現有的GPWS使用的無線電高度表、氣壓高度信息、地 形數據庫有潛力提高現有的定位系統的性能和可靠性,而 提高後的定位信息又會進一步提高近地告警的能力。 與現有的分離的數據處理為特徵的定位系統和地面鄰 警系統相比,本發明的主要目的在於提供一組合定位和地 面鄰警方法和系統,以便獲得進一步提高的性能,如更高 精度的導航數據、高水平的對GPS信號信號丟失的容忍 性、GPS的完善性監測、更加精確可靠的地面鄰警信息 等,以便飛行器在日益繁忙的空域進行空中飛行,變得更 加安全,本發明具有以下特點: (1 )組合定位和地面鄰警系統的性能要優於兩個分離 的系統。 (2 )本發明的定位精度要優於現有的組合GPS/慣性導454095 Five 'invention description (12) of the positioning system in order to provide it with its positioning data. As mentioned above, traditional integrated GPS / inertial navigation systems combine information from inertial measurement components and GPS receivers to provide their performance. Existing GPWSs use either integrated GPS / inertial navigation systems or separate GPS receivers or The positioning data of separate inertial navigation systems, the altitude information of radio altimeters and barometric altimeters, and the terrain data of the terrain database are used to solve the problem of adjacent ground police. Both the integrated GPS / inertial navigation system and the GPWS are implemented in software in the microprocessor. With the continuous increase in the speed and capacity of the microprocessor, it is possible to implement a combined positioning and ground proximity police system, and The combined positioning and ground adjacent police system has better performance than the single positioning system and separate ground adjacent police system. This is because the radio altimeter, barometric altitude information, and terrain database used by the existing GPWS have the potential to improve the existing positioning. The performance and reliability of the system, and the improved positioning information will further improve the ability of near-Earth alerting. Compared with the existing positioning system and ground neighboring police system characterized by separate data processing, the main purpose of the present invention is to provide a combined positioning and ground neighboring police method and system in order to obtain further improved performance, such as higher accuracy Navigation data, high level of tolerance for GPS signal loss, soundness monitoring of GPS, more accurate and reliable ground neighbor information, etc., in order to make the aircraft fly in increasingly busy airspace and become more secure. The invention has The following features: (1) The performance of the combined positioning and ground adjacent police system is better than two separate systems. (2) The positioning accuracy of the present invention is better than the existing combined GPS / inertial guidance

C:\ProgramFiles\Patent\k322p002.ptd 第 17 頁 454 09 5 五、發明說明(13) 航系統。 故障(ϋί绎明有能力檢測GPS的衛星故障或其發出之有 發明以】二、精確的地面鄰警信息,這是由於本 ^明獲付的更同的定位精度帶來的。 了近= = ί高精度的定位信息’從而降低 *有(二相比,本發明不需 說,能滿足低成本、=能=:商業用的飛行器來 一目的在於提供組合定位和地面鄰罄方法 :糸、.充’與現有獨立求解的定位和 ; ΐ傳r二 =自所有為導航定位和地面;=以 便獲得更好的精|,而且本發明能用 於叹有疋位,又備的飛行器,系統成本較低者。 “ί發:ί再一目的在於提供組合定位和地面鄰警方法 可用來更新慣性導航系統的水 ::糸, :號丢失之後’系統可繼續提供高精度的水平位 “ ί發1月广目的在於提供組合定位和地面鄰馨方法 :糸,’…形數據庫和無線電高度表及慣性;航= 的=并:用來更新慣性導航系統的高度測便^ …精密進場、t陸以及在繁忙空域飛行的更C: \ ProgramFiles \ Patent \ k322p002.ptd Page 17 454 09 5 V. Description of the invention (13) Navigation system. Faults (ϋί 明明 capable of detecting GPS satellite failures or inventions issued by them) Second, accurate ground neighboring police information, which is due to the same positioning accuracy paid by Ben Ming. Near = = ίHigh-precision positioning information ', which reduces * Yes (Compared with the present invention, it is not necessary to say that it can meet the low cost, = can =: commercial aircraft for one purpose is to provide a combination of positioning and ground proximity method: 糸,. Charge 'and the existing independent solution of the positioning sum; ΐ Bi r = = since all are for navigation and positioning and ground; = in order to obtain better precision |, and the invention can be used to sigh and have a prepared aircraft, The system cost is lower. "Ί 发: ί Another purpose is to provide a combination of positioning and ground proximity police methods that can be used to update the water of the inertial navigation system :: 糸,: After the number is lost, the system can continue to provide high-precision horizontal bits" The purpose of the January issue is to provide a combination of positioning and ground neighbor methods: 糸, '... shape database and radio altimeter and inertia; Hang = = = and: used to update the altitude measurement of the inertial navigation system ^ ... precision approach , T 陆, and in Traditional Airspace more

11

surface

II C:\ProgramFiles\Patent\k322p002.ptd 第 18 頁 454 〇s i 五二發明說明(u) 冋精度的高度信息者。 和系統發月j:之m::供組合定位和地面鄰警方法 行處;,以便數據,進 和系ΐ發明么另-目的在於提供組== 據庫、慣性導航系統的信息,;^電间度表、地形數 完善性監測者^ 進订處理,以便進行GPS的 和系铳發】:另一目的在於提供組合定位和地面鄰警方法 收機、’用…中’得出的最優定位導航參數被反饋回GPS接 古2用以辅助GPS信號跟蹤環路,以便提高它對干擾和 阿動態的容忍能力者。 矛本發明之另一目的在於提供組合·定位和地面鄰婆方法 :糸統,其中,得出的最優導航參數被反饋回GPS接°收 為,用以输助GPS信號的捕獲和信號丟失之後的再捕獲處 以便降低GPS的第一次定位時間和信號丢.失之後再次 捕獲的時間者。 本發明之另一目的在於提供組合定位和地面鄰擎方法 和系統,其中,提高精度的導航信息,用來獲得及時的地 面鄰警信息者。 本發明之另一目的在於提供組合定位和地面鄰警方法 和系統’其中’提高精度的導航信息,用來獲得更加精 確、可靠的地面鄰警信息者。 本發明之另一目的在於提供組合定位和地面鄰警方法II C: \ ProgramFiles \ Patent \ k322p002.ptd Page 18 454 〇s i May 2nd invention description (u) High accuracy information. And system development month j: 之 m :: For combined positioning and ground adjacent police method; in order to facilitate the data, the system is invented. Another purpose is to provide information of the group == database, inertial navigation system, ^ Electricity meter, topographical integrity monitor ^ order processing for GPS and system development]: Another purpose is to provide a combination of positioning and ground adjacent police methods, the most The optimal positioning and navigation parameters are fed back to the GPS receiver 2 to assist the GPS signal tracking loop in order to improve its tolerance to interference and dynamics. Another object of the present invention is to provide a combination of positioning and ground neighbor methods: the system, in which the optimal navigation parameters obtained are fed back to the GPS receiver and used to aid the acquisition of GPS signals and signal loss. The subsequent re-acquisition is to reduce the GPS's first positioning time and signal loss. The time of re-acquisition after the loss. Another object of the present invention is to provide a method and a system for combined positioning and ground neighbors, in which navigation information with improved accuracy is used to obtain timely ground neighbor information. It is another object of the present invention to provide a method and a system for combining positioning and ground neighbor police, in which, the navigation information with improved accuracy is used to obtain more accurate and reliable ground neighbor police information. Another object of the present invention is to provide a combined positioning and ground neighbor police method.

C:\Prograra Files\Patent\k322p002. ptd 第 19 頁 4 54 09 5 五、發明說明(15) 和系統,其中’ ~合成視覺系統用以顯示地面鄰警信息’ 以便給飛行員提供周圍地形環境的擴展視野者, 統,其中, 警信息者。 圖示說明: 第一圖 程圖。 第二圖 圖。 第三圖 程圖。 第四圖 程圖。 第五圖 程圖。 第六圖 程圖。 第七圖 第八圖 第九圖 圖號說明: 本發明之另一目的在於提供組合定位和地面鄰警方法和系 一語音系統用以給飛行員提供聽得見的地面鄰 之流 係顯示組合定位和地面鄰警方法和系統之流 係顯示組合定位和地面鄰警處理機之流程 係顯示導航解算模塊實現方式之6 ( a )之流 係顯示導航解算模塊實現方式之6 ( b )之流 係顯示導航解算模塊實現方式之6 ( c )之流 係顯示導航解算模塊實現方式之6 ( d 係顯示地面鄰警模塊之信息流程圖 係顯示GPS接收機之方框圖。 係顯示慣性導銳系統之方框圖。 電路 採樣及A/D變換器 C:\ProgramFiles\Patent\k322p002.ptd 第 2〇 頁 454 09 5 五 '發明說明(16) 16- —信號處理機17-振蕩器 20-慣性導航系統 2 2 -慣性導航處理機 2 4 -變換矩陣計算模塊 2 6-地球和載體角速率計算模塊 27-姿態位置速度計算模塊 40 -無線電向度表 組合定位及地面鄰警處理機 1 8-導航處理機 2卜慣性測量組件 2 3 -傳感器誤差補償模塊 2 5 -坐標變換計算模塊 30-氣壓高度表 5 0 -地形數據庫 60 62-導航求解模塊 6 202 -濾波/估計模塊 6 2 1 2 - T A IN S子濾波模塊 61-輪入輸出模塊 6 2 0 1 -相關/匹配模塊 6 211 -相關/匹配模塊 6213- INSGPS子濾波器 6214- 主濾波器模塊 6 2 2卜單點地形淨空計算模塊 622 2-濾波/估計模塊 6 2 3 1 -單點地形淨空計算模塊 6 2 3 3 - INSGPS子濾波器 6 3 -地面鄰警求解模塊 63 2-飛行軌跡預測模塊 623 2 - TAINS子濾波器模塊 6234-主遽波器模塊 6 3 1 -查詢參數計算模塊 6 3 3 -告警決策模塊 6 34-飛行轨跡計劃輔助模塊 6 35—合成視覺處理模塊 6 3 6 -語音處理模塊 7 0 -合成視覺系統 8 0 -語音系統 9 0 -機載飛行控制和管理系統 本發明為空中飛行器,如飛機,提供了 一組合定位和C: \ Prograra Files \ Patent \ k322p002. Ptd page 19 4 54 09 5 V. Description of the invention (15) and system, in which '~ synthetic vision system is used to display ground police information' in order to provide pilots with the surrounding terrain environment. Extending the field of vision, system, among them, the police information. Graphic description: First diagram. The second figure Figure. Third chart. The fourth diagram. Fifth chart process chart. The sixth chart. The seventh figure, the eighth figure, and the ninth figure illustrate the figure: Another object of the present invention is to provide a combined positioning and ground neighbor police method and a voice system for providing pilots with audible ground neighbor current system display combined positioning The flow of the method and system with the ground adjacent police system is shown in the combination of the positioning and the ground adjacent police processor. The flow of the display navigation solution module implementation method 6 (a) is the flow of the display navigation solution module implementation method 6 (b). Stream display navigation solution module implementation method 6 (c) Stream display navigation solution module implementation method 6 (d) Display information flow chart of the ground adjacent police module is a block diagram showing a GPS receiver. Display inertial guidance Block diagram of the sharp system. Circuit sampling and A / D converter C: \ ProgramFiles \ Patent \ k322p002.ptd Page 20 454 09 5 Five 'invention description (16) 16- —signal processor 17-oscillator 20-inertia Navigation system 2 2-Inertial navigation processor 2 4-Transform matrix calculation module 2 6-Earth and carrier angular rate calculation module 27-Attitude position speed calculation module 40-Radio directional table combined positioning and ground adjacent police 1 8-navigation processor 2 inertial measurement module 2 3-sensor error compensation module 2 5-coordinate transformation calculation module 30-barometric altimeter 5 0-terrain database 60 62-navigation solution module 6 202-filtering / estimation module 6 2 1 2-TA IN S sub-filter module 61-round input output module 6 2 0 1-correlation / matching module 6 211-correlation / matching module 6213-INSGPS sub-filter 6214-main filter module 6 2 2 single point Terrain Clearance Calculation Module 622 2-Filter / Estimation Module 6 2 3 1 -Single Point Terrain Clearance Calculation Module 6 2 3 3-INSGPS Sub Filter 6 3 -Ground Adjacent Police Solving Module 63 2-Flight Trajectory Prediction Module 623 2-TAINS Sub-filter module 6234-Main wave filter module 6 3 1-Query parameter calculation module 6 3 3-Alarm decision module 6 34-Flight trajectory planning auxiliary module 6 35-Synthetic vision processing module 6 3 6-Speech processing module 7 0-Synthetic vision system 8 0-Speech system 9 0-Airborne flight control and management system The present invention provides a combined positioning and

C:\ProgramFiles\Patent\k322p002.ptd 第 21 頁 ^54095 五、發明說明(17) 地面鄰警方法和系統,它融合了來自Gps接收機、 航糸統、氣壓尚度表、無線電高度表、地形數 行 控制和管理系統的信息。 據庫#飛们· 請參閱第一圖所示,組合定位和地面鄰警系統包括 GPS接收機10、慣性導航系統20、氣壓高度表3〇、、、’·盔線電 雨度表40、地形數據庫5G、組合定位及地面 處 60,其中,GPS接收機10係接收GPS信號,算出Gps的位 置、速度和時間信息或偽距、偽距率測量。 慣性導航系統20 ’係使用来自一慣性測量組件測出的 飛行器角速率和比力信息,求解導航方程,獲得慣性導航 數值。 ' 氣壓高度表3 0 ’係提供氣壓高度測量。 無線電高度表4 0 ’係提供無線電高度測量。 地形數據庫50,係存儲全球地形數據,可獲得飛行器 現在位置和周圍的地形高度數據。 組合定位及地面鄰警處理機60,係接收Gps接收機 10、慣性導航糸統2 0、氣壓尚度表3 〇、無線電高度表4 〇、 地形數據庫5 0 ;該組合定位及地面鄰警處理機6 〇也從接收 機載飛行控制和.管理糸統9 0的數據,處理這些數據,獲得 最優的位置、速度、姿態等導航信息’以及最優的地面鄰 警.4s息’而該G P S接收機1 0、慣性導航系統2 〇、氣壓高度· 表3 0、無線電高度表4 0、地形數據庫5 〇均與組合定位及地 面鄰警處理機6 0相連。 一合成視覺系統7 0與組合定位及地面鄰警處理機6 〇相C: \ ProgramFiles \ Patent \ k322p002.ptd Page 21 ^ 54095 V. Description of the invention (17) The ground neighbor police method and system, which combines GPS receiver, aeronautical system, barometer, radio altimeter, Terrain number line control and management system information. Data library # Please refer to the first figure. The combined positioning and ground proximity alarm system includes GPS receiver 10, inertial navigation system 20, barometric altimeter 30, and, '· helmet electric rain gauge 40, Terrain database 5G, combined positioning and ground location 60. Among them, the GPS receiver 10 receives GPS signals and calculates GPS position, speed, and time information, or pseudorange and pseudorange rate measurements. The inertial navigation system 20 'uses the angular velocity and specific force information of the aircraft measured from an inertial measurement component to solve the navigation equation and obtain the inertial navigation value. 'The barometric altimeter 3 0 ′ provides barometric altitude measurement. The radio altimeter 40 'provides radio altitude measurements. The terrain database 50 stores global terrain data, and can obtain the current position of the aircraft and surrounding terrain altitude data. The combined positioning and ground neighboring police processing unit 60 receives the GPS receiver 10, the inertial navigation system 20, the barometric pressure table 3 〇, the radio altimeter 4 〇, and the terrain database 50 0; the combined positioning and ground neighboring police processing The aircraft 6 also carries the flight control and management system data from the receiver, processes these data, and obtains the optimal navigation information such as position, speed, and attitude, as well as the optimal ground neighbor police information. GPS receiver 10, inertial navigation system 2 0, barometric altitude table 3 0, radio altimeter 40, and terrain database 5 0 are all connected to the integrated positioning and ground adjacent police processor 60. A synthetic vision system 70 and combined positioning and ground adjacent police processor 600

C:\ProgramFiles\Patent\k322p002.ptd 第 22 頁 454095 五 '發明說明(18) ~~—- 連’用以給飛行員提供地面鄰警信息的視覺顯示。 一語音系統80與組合定位及地面鄰警處理機6〇相連,用以 給飛行員提供語音地面鄰警信息》 該GPS接收機1〇可以選為:差分Gps接收機 (Differential GPS)或多天線GPS接收機或帶有.廣域增 強(Wide Area Augmentat ion )方式的GPS 接收機。 曰 地形數據庫50可以選為一機載地形數據庫,或—置於地面 站的地形數據庫,它可通過一數據鏈(Data Unk )方 式,供飛行器查詢0 如第一圖所示’ GPS接收機10、慣性導航系統2〇、氣 壓高度表30、無線電高度表4〇、地形數據庫5〇、組合定位 及地面鄰警處理機60、合成視覺系統7〇、語音系統8〇以 及飛行控制和管理系統9 〇之間的連接方式可以是以下之 (1 )基於總線的連接方式,如内部總線、MIL 一 1553 、 ARIC429 。 (2 )基於通# 口的連接方式..,包括同步通信接口、異 步通信接口、如RS — 232 ' RS - 422RS — 4 8 5。 (3 )基於網絡的連接方式,如NE2〇〇〇。 如第一圖及第八圖所示,GPS接收機連接於組合定 位及地面鄰警處理機60,包括一導航處理機18,該導航處 理機1 8可給組合定位及地面鄰警處理機6 〇提供: (1 )飛行器的位置、速度、時間信息。 (2 ) GPS接收機的原始測量值:偽距、偽距率,以及C: \ ProgramFiles \ Patent \ k322p002.ptd Page 22 454095 5 'Explanation of the invention (18) ~~ —- even' is used to provide the pilot with a visual display of the neighbor's ground police information. A voice system 80 is connected to the combined positioning and ground neighboring police processor 60 to provide the pilot with ground ground warning information. The GPS receiver 10 can be selected as: Differential GPS receiver (Differential GPS) or multi-antenna GPS Receiver or GPS receiver with Wide Area Augmentation method. The terrain database 50 can be selected as an on-board terrain database, or a terrain database placed on the ground station, which can be used by the aircraft to query through a data link (Data Unk) method. As shown in the first figure, 'GPS receiver 10 , Inertial navigation system 20, barometric altimeter 30, radio altimeter 40, terrain database 50, combined positioning and ground adjacent police processor 60, synthetic vision system 70, voice system 80, and flight control and management system 9 The connection between 〇 can be one of the following (1) based on the bus connection, such as internal bus, MIL-1553, ARIC429. (2) Connection method based on port # .. Including synchronous communication interface, asynchronous communication interface, such as RS — 232 'RS-422RS — 4 8 5. (3) Network-based connection mode, such as NE2000. As shown in the first and eighth figures, the GPS receiver is connected to the integrated positioning and ground neighboring police processor 60, and includes a navigation processor 18, which can provide the combined positioning and ground neighboring police processor 6 〇 Provide: (1) Position, speed and time information of the aircraft. (2) the raw measurements of the GPS receiver: pseudorange, pseudorange rate, and

C:\ProgramFiles\Patent\k322p002.ptd 第 23 頁 454095 五、發明說明(19) ~~~ 衛星星歷。 一信號處理機1 6接收來自組合定位及地面鄰警處理機 60的最優位置、速度 '姿態信息,用來辅助Gps信號的捕 獲、跟蹤、再捕獲處理。 GPS接收機1〇進一步包括一連接於一預放大電路12的 GPS 天線 11,GPS 天線 11 接收GpS 射頻(Radi〇 Frequence, RF) 5虎,並將信號饋如.預放大電路I?。 預放大電路12連接於GPS天線11和一下變頻電路13之 間,放大GPS RF信號,以便提高其信號噪聲比,放大後 的信號被饋入下變頻電路1 3。 下變頻電路13連接于預放大電路12和一帶通濾波器14 間,將輸入的GPS RF信號下變頻為GPS中頻 (Intermediate Frequence, IF)信號,並將GPS IF 信 號饋入帶通濾波器14。 帶通遽波器14連接與下變頻電路13和一 IF採樣及A/]) 變換器1 5之間’濾除輸入的I f信號中的噪聲,以便提高其 信说α眾聲比’並將濾除噪聲後的丨F信號饋入丨F採樣及A/D 變換器15。 IF採樣及A/D變換器15連接於帶通濾波器14和一信號 處理器1 6之間,對輪入的模擬if信號進行採樣,並將產 生的數.子I ( In-phase )、Q〈Quadraphase ).信號饋入信 號處理機1 6。 信號處理機1 6連接於IF採樣及A / D變換器1 5和一導航 處理機18之間,接收來自IF採樣及A/])變換器15的數字I、C: \ ProgramFiles \ Patent \ k322p002.ptd Page 23 454095 V. Description of the invention (19) ~~~ Satellite ephemeris. A signal processor 16 receives the optimal position, velocity, and attitude information from the combined positioning and ground neighboring police processor 60 to assist in the capture, tracking, and recapture processing of the GPS signals. The GPS receiver 10 further includes a GPS antenna 11 connected to a pre-amplification circuit 12. The GPS antenna 11 receives a GpS radio frequency (Radio Frequence, RF) 5 tiger, and feeds the signal to the pre-amplification circuit I ?. The pre-amplification circuit 12 is connected between the GPS antenna 11 and the down-conversion circuit 13 to amplify the GPS RF signal so as to improve its signal-to-noise ratio. The amplified signal is fed to the down-conversion circuit 13. The down-conversion circuit 13 is connected between the pre-amplification circuit 12 and a band-pass filter 14. It down-converts the input GPS RF signal to a GPS intermediate frequency (IF) signal and feeds the GPS IF signal to the band-pass filter 14. . The band-pass chirper 14 is connected to the down-conversion circuit 13 and an IF sampling and A /]) converter 15 to 'filter out the noise in the input I f signal in order to increase its signal-to-alpha sound ratio' and The filtered F signal is fed to the F sampling and A / D converter 15. The IF sampling and A / D converter 15 is connected between the band-pass filter 14 and a signal processor 16 to sample the round-robin analog if signal and generate the numbers. Sub-I (In-phase), Q <Quadraphase). The signal is fed into the signal processor 16. The signal processor 16 is connected between the IF sampling and A / D converter 15 and a navigation processor 18, and receives the digital I,

C:\Program Files\Patent\k322p002.ptd 第 24 頁 454095 五、發明說明(20)C: \ Program Files \ Patent \ k322p002.ptd Page 24 454095 V. Description of the invention (20)

Q信號,來自組合定位及地面鄰警處理機6 〇的最優位 速度' 姿態信息’執行來自組合定位及地面鄰警處置、 數據輔助的GPS信號的捕獲 '跟蹤、再捕獲處理 機6〇 偽距、偽距率以及衛星星歷給導航處理機i 8。 則出 導航處理機1 8連接於信號處理機1 6,使用來.自 處理機16偽距' 偽距率以及衛星星歷,求解導航方 出下列兩類數據給組合定位及地面鄰警處理機6〇 : 信鞔 &amp; *輪 (1 )飛行器的位置、速度、時間信息1 (2 ) GPS接收機的原始測量值:偽距、偽距率,、 衛星星歷。 以及 一振蕩器17與下變頻電路13、IF採樣及A/D變換器 1 5、k號處理機1 6相連,提高本地參考信號。 ° 如第一圖及第九圖所示’慣性導航系統2〇連接於組人 定位及地面鄰警處理機60 ’接收來自組合定位及地面鄰二 處理機6 0的慣性導航參數和傳感器誤差的最優估計,輸^ 慣性導航參數,如位置、速度、姿態等,給組合定」 面鄰警處理機60。 慣性導航系統20進一步包括一慣性測量組件21和一慣 性導航處理機2 2 ’慣性測量組件2 1連接於慣性導航處理機 22 ’並提供其測量的機體角速率、比力數據,慣性導 處理機2 2進一步包括下列模塊: ' 一傳感器§吳差補償模塊2 3接收來自慣性測量組件2 1 的 機體肖速率、比力和來自組合定位及地面鄰警處理機6〇的 傳感器誤差的最優估計,補償輸入的機體角速率、比力數Q signal, from the optimal positioning speed of the integrated positioning and ground adjacent police processor 60. 'Attitude information' performs the acquisition of the GPS signal from the combined positioning and ground adjacent police processing, data-assisted tracking, re-acquisition processor 60 false range , Pseudorange rate and satellite ephemeris to the navigation processor i 8. Then the navigation processor 18 is connected to the signal processor 16 and used. Since the processor 16 pseudorange 'pseudorange rate and satellite ephemeris, solve the navigation side to produce the following two types of data for the combined positioning and ground neighbor police processor 60: Signal &amp; wheel (1) Position, speed, and time information of the aircraft 1 (2) Raw measurements of the GPS receiver: pseudorange, pseudorange rate, satellite ephemeris. And an oscillator 17 is connected to the down conversion circuit 13, the IF sampling and A / D converter 15 and the k processor 16 to improve the local reference signal. ° As shown in the first and ninth pictures, 'Inertial navigation system 20 is connected to the group positioning and ground adjacent police processor 60' receives the inertial navigation parameters and sensor errors from the integrated positioning and ground adjacent second processor 60. The best estimate is to input the inertial navigation parameters, such as position, speed, attitude, etc., given the combination of the neighboring police processor 60. The inertial navigation system 20 further includes an inertial measurement module 21 and an inertial navigation processor 2 2 'The inertial measurement module 21 is connected to the inertial navigation processor 22' and provides its measured body angular velocity and specific force data, and an inertial navigation processor 2 2 further includes the following modules: 'One sensor§ Wu difference compensation module 2 3 Receives the body's Shaw rate, specific force from the inertial measurement component 21, and the optimal estimation of the sensor error from the integrated positioning and ground adjacent police processor 60. , Compensated input body angular rate and specific force number

454 09 5 五、發明說明(21) 據中的誤差,機體角速率、比力分別是由慣性測量組件2 1 的陀螺和加速度計測量的,傳感器誤差補償模塊2 3輸出補 償後的機體角速率給變換矩陣計算模塊2 4,輸出補償後的 比力給坐標變換計算模塊2 5。 變換矩陣計算模塊24接收來自誤差補償模塊23補償後 的機體角速率、來自地球和載體角速率計算模塊26的當 地導航坐標系(n系)到慣性坐標系(i系)的旋轉矢量、 來自組合定位及地面鄰警處理機6〇的慣性導航計算的姿態 的誤差的最優估計,更新從機體系(b系)到導航系的的 方向矩陣’益補償其誤差,更新從機體系到導航系的的方 向變換矩陣的方法有歐拉法、直接方向余弦法和四元數 法’變換矩陣計算模塊24輸出從機體系到導航系的的方向 •變換矩陣給坐標變換計算模塊2 5和姿態位置速度計算模塊 27。 、^坐標變換計算模塊25接收來自傳感器誤差補償模塊23 補償後的比力、來自變換矩陣計算模塊24的方向變換矩 陣’輪入的比力是表達在機體坐標系中的,坐標變換計算 模塊2 5將其轉換為表達在導航坐標系中的比力,並將其輸 出到姿態位置速度計算模塊2 7。 ,姿癌位置速度計算模塊27接收來自坐標變換計算模塊 2 5幻表達在導舭坐標系中的比力、來自變換矩陣計算模塊 24的從機體系到導航系的的方向變換矩陣、來自组合定位 ,地面鄰警處理機60的慣性導航參數誤差的最優估計,計 位置、速度、姿態’並補償其誤差,姿態位置速度計454 09 5 V. Description of the invention (21) According to the errors in the body, the angular rate and specific force of the body are measured by the gyro and accelerometer of the inertial measurement module 21, and the sensor error compensation module 23 outputs the angular rate of the body after compensation. The transformation matrix calculation module 24 is provided, and the compensated specific force is output to the coordinate transformation calculation module 25. The transformation matrix calculation module 24 receives the body angular rate after compensation from the error compensation module 23, the rotation vector from the local navigation coordinate system (n system) to the inertial coordinate system (i system) from the earth and the carrier angular rate calculation module 26, and from the combination The optimal estimation of the attitude error calculated by the inertial navigation of the positioning and ground adjacent police processor 60, updating the orientation matrix from the aircraft system (B system) to the navigation system 'will compensate its error, and update the aircraft system to the navigation system. The methods of the direction transformation matrix are Euler's method, direct direction cosine method and quaternion method. The transformation matrix calculation module 24 outputs the direction from the machine system to the navigation system. The transformation matrix gives the coordinate transformation calculation module 25 and the attitude position. Speed calculation module 27. The ^ coordinate transformation calculation module 25 receives the specific force after compensation from the sensor error compensation module 23, and the direction transformation matrix 'rounded specific force from the transformation matrix calculation module 24 is expressed in the body coordinate system. The coordinate transformation calculation module 2 5 Convert it into the specific force expressed in the navigation coordinate system and output it to the attitude position speed calculation module 27. The posture cancer position and speed calculation module 27 receives the specific force from the coordinate transformation calculation module 25 in the guided coordinate system, the direction transformation matrix from the machine system to the navigation system from the transformation matrix calculation module 24, and the combined positioning. , The optimal estimation of the inertial navigation parameter error of the ground adjacent police processor 60, calculate the position, speed, and attitude 'and compensate for its error, the attitude position speed meter

C:\ProgramFiles\Patent\k322p002.ptd % 26 頁 454 09 5 五、發明說明(22) 算模塊2 7 .輸出更新導航參數給來自地球和栽體角速率計算 模塊2 6和組合定位及地面鄰警處理機6 〇。 、 地球和載體角速率計算模塊26接收來自姿態位置速度 計算模塊2 7的慣性導航參數,計算當地導航坐慣性 坐標系的旋轉矢量,並將其輸出給變換矩陣叶^模塊24。 如第一圖所示,氣壓高度表30連接於組合定位及地面鄰警 處理獅,敏感空氣壓力,計算氣壓高度測量,並將其 輸出給組合定位及地面鄰警處理機6 如第-圖所示’無線電高度表3〇連接於組合定位及地 面鄰警處理機60 ’輻射無線電信冑,並接收地面的回波, 1 =間I,並將時間差轉換無線電高度測 【:輸出‘、、、線電向度測量給組合定位及地面鄰警處理機 如第一圖所示,地形數據庫5〇連接於组人. 士 鄰警處理機60,收來自組合定位及地 逖:疋位及地面 姑庙左化会叙V l 彳及地面鄰警處理機6 0的數 據庫查s旬參數,輸出氣行器現在位置和周圍的地 _勃 據給組合定位及地面鄰警處理機6 〇。 '冋又數 如第一圖所不’組合定位月士品 列模塊: 及地面鄰警處理機60包括下 一輸入輸出模塊61管理與其他器件和 管理系統的數據輸入和輸出。 載氣订控制和 一導航求解模塊62連接於輸入輪出模塊&amp; !解模塊63,融合來自本發明的所有傳感器的信自 取優導航參數’並將其輪出給機載飛行控制和管理C: \ ProgramFiles \ Patent \ k322p002.ptd% 26 Page 454 09 5 V. Description of the invention (22) Calculation module 2 7. Output updated navigation parameters to the earth and plant angular rate calculation module 26 and combined positioning and ground neighbor Alarm handler 6 〇. The earth and carrier angular rate calculation module 26 receives the inertial navigation parameters from the attitude position speed calculation module 27, calculates the rotation vector of the local navigation sitting inertia coordinate system, and outputs it to the transformation matrix leaf module 24. As shown in the first figure, the barometric altimeter 30 is connected to the combined positioning and ground neighboring police processing lion, sensitive air pressure, calculates the pressure altitude measurement, and outputs it to the combined positioning and ground neighboring police processing machine 6 as shown in Figure- Show 'The radio altimeter 30 is connected to the combined positioning and ground adjacent police processor 60' to radiate radio signals and receive ground echoes, 1 = interval I, and convert the time difference to radio altimetry [: output ',,,, The line direction measurement is given to the combined positioning and ground adjacent police processor as shown in the first picture, and the terrain database 50 is connected to the group of people. The Shilin police processor 60 is received from the combined positioning and location: the location and the ground The database of the temple left and the V l 彳 and the ground neighboring police processing unit 60 check the parameters of the tenth, and output the current position of the air mover and the surrounding ground _ data according to the combined positioning and ground neighboring police processing unit 60. '冋 又 数 As shown in the first figure', the combined positioning module: and the ground adjacent police processor 60 includes a next input / output module 61 which manages data input and output with other devices and management systems. The carrier gas order control and a navigation solution module 62 are connected to the input wheel output module &amp; solution module 63, which integrates the information from all sensors of the present invention to optimize the navigation parameters' and turns it out for onboard flight control and management.

C:\Program Files\Patent\k322p002.p1;d 第 27C: \ Program Files \ Patent \ k322p002.p1; d page 27

頁 4 54 09 5 I五、發明說明(23) 90、地面坪警求解模塊63 ' GPS接收機10,輪出慣性導航 參數和傳感器誤差的最優估計給慣性導航系統2 0。 為獲得本發明的不同系統性能’導航求解模塊6 2可以 有以下實現方式: /(a):如圖3所示,一相關/匹配模塊6211通過輪入輪 出,塊接收來自無線電高度表40的無線電高度測量、來 自氣壓,度表30的氣壓高度測量、來自地形數據庫50的地 2數據,使&amp;用收集到的無線電高度測量和氣壓高度測 量’在二給定的時間窗口内,創建—個測量的地形包絡, 使用地,數據庫的地形數據,形成多個參考的地形包絡, 比較、I量的地开々包絡和參考地形包絡,一旦找到匹配的地 形匕、,各輸出匹配的地形包絡的地理位置給一濾波/估叶 模塊62 0 2。 Μ K 1 〇Τ 古# f* ί,相關/匹配模塊62 0 1將無線電高度測量與地形 I :卢目斿罢並與慣性高度或混合氣壓慣性高度相比較,形 成” t差,將其輸出給渡波/估計模塊6 2 0 2。 慣性塊6202對來自GPS接收機10的測量信息、 ί貝=航糸統20的,償性導航參數、來關/配 6 2 0 1的匹配的地形包絡推:上配模塊 性導航參數誤差、GPS接收機進 最優估計。最優的定性傳感器誤差的 得出:航參數可以通過以下兩種方式 . . ........ ... .... 6 ( a ) - 1濾波/估計橋堍9 n 9杜m β ^ ^ t ^ ^ ^ ^,fi 貫性導航系統2〇的慣性導航參Page 4 54 09 5 I. Explanation of the invention (23) 90. Ground floor police solution module 63 'GPS receiver 10, the optimal estimation of inertial navigation parameters and sensor errors is given to the inertial navigation system 20. In order to obtain different system performances of the present invention, the navigation solution module 62 can have the following implementation methods: / (a): As shown in FIG. 3, a correlation / matching module 6211 is turned in and out, and the block receives the radio altimeter 40 Radio altitude measurement, barometric altitude measurement from barometric pressure, degree table 30, and ground 2 data from terrain database 50, &amp; using the collected radio altitude measurement and barometric altitude measurement 'within two given time windows, create A measured terrain envelope, using terrain and database terrain data, to form multiple reference terrain envelopes, compare, and compare the amount of geodetic envelope and reference terrain envelope. Once a matching terrain dagger is found, each matching terrain is output. The geographic location of the envelope is given to a filtering / estimating module 62 0 2. M K 1 〇Τ 古 # f * ί, the correlation / matching module 62 0 1 compares the radio altitude measurement with the terrain I: Lu Mu and compares it with the inertial altitude or the mixed air pressure inertial altitude to form a “t-difference, and outputs it The crossing wave / estimation module 6 2 0 2. The inertial block 6202 measures the measurement information from the GPS receiver 10, and the navigational parameters of the navigation system 20 are compensated. Push: Modular navigation parameter error, GPS receiver enters optimal estimation. Optimal qualitative sensor error is derived: navigation parameters can be obtained in the following two ways......... ... 6 (a)-1 filter / estimated bridge 堍 9 n 9 Du m β ^ ^ t ^ ^ ^ ^, fi inertial navigation parameter of the continuous navigation system 20

C:\Program Files\Patent\k322p002.ptd 第 28頁 454095 五、發明說明(24) 數。 6 (a) - 2濾波/估計模塊6 2 0 2將得出慣性導航參數誤 差、GPS接收機誤差以及慣性傳感器誤差的最優估計反饋 給慣性導航系統20,以便慣性導航系統2〇對其誤差進行反 讀校正。. 6 (b)如第四圖所示’一相關/匹配模塊6 211通過輸入 輸出模塊..6 1接..收來自無線.電尚度表4〇的無線電.高度測量、 來自氣壓高度表3 0、來自地形數據庫5 〇的地形數據,使 用收集到的無線電高度測量和氣壓高度測量,在一給定的 時間窗口内’創建一個測量的地形包絡,使用地形數據庫 的地形數據’形成多個參考的地形包絡,比較測量的地形 包絡和參考地形包絡,一旦找到匹配的地形包絡,輸出匹 配的地形包絡的地理位置給一TAINS (Terrain AidedC: \ Program Files \ Patent \ k322p002.ptd Page 28 454095 V. Description of the invention (24) Number. 6 (a)-2 The filtering / estimation module 6 2 0 2 feeds back the optimal estimation of the inertial navigation parameter error, the GPS receiver error, and the inertial sensor error to the inertial navigation system 20 so that the inertial navigation system 20 makes the error Perform reverse reading correction. 6 (b) As shown in the fourth figure, a 'correlation / matching module 6 211 through the input and output module. 6 1 connection: receiving radio from the wireless, electric power meter 40, altitude measurement, from the barometric altimeter 30. Terrain data from the terrain database 50. Using collected radio altitude measurements and barometric altitude measurements, 'create a measured terrain envelope within a given time window, using terrain database's terrain data' to form multiple The reference terrain envelope is compared with the measured terrain envelope and the reference terrain envelope. Once a matching terrain envelope is found, the geographic location of the matched terrain envelope is output to a TAINS (Terrain Aided

Inertial Navigation System)子濾波模塊 6212。 此外,相關/匹配模塊6211將無線電高度測量與地形 高度相加,並與慣性高度或混合氣壓慣性高度相比較,形 成' 尚度殘.差,將_之輸出.給T A 1N:S子滤波模塊6 2 1 2 '。 TAINS子濾波模塊6212對慣性導航參數誤差及慣性傳 感器誤差建模’對匹配的地形包絡的地理位置和高度殘差 進行濾波處理’得出慣性導航參數誤差以及慣性傳感器誤 差的局部?最優估'計。 —INSGPS (Inertial Navigation System/Global Posi tioning System )子濾、波器62 1 3輸入GPS接收機1 〇的 測量信息和慣性導般系統2 0的慣性導航參數’並對之進行Inertial Navigation System) sub-filtering module 6212. In addition, the correlation / matching module 6211 adds the radio altitude measurement to the terrain altitude, and compares it with the inertial altitude or the mixed air pressure inertial altitude to form a 'surplus residual. Difference, which outputs _ to the TA 1N: S sub-filter module 6 2 1 2 '. The TAINS sub-filtering module 6212 models the inertial navigation parameter error and inertial sensor error. ‘Filters the geographic location and height residuals of the matching terrain envelope’ to get the locality of the inertial navigation parameter error and inertial sensor error. Optimal estimate. —INSGPS (Inertial Navigation System / Global Positioning System) sub filter, wave filter 62 1 3 Input GPS receiver 1 〇 Measurement information and inertial navigation system 2 0 inertial navigation parameters ’and perform

C:\Program Files\Patent\k322p002.ptd 第 29 頁 454 09 5 五、發明說明(25) 滤波處理’得出慣性導航參數誤差、GPS接收機誤差以及 慣性傳感器誤差的另一局部最優估計。 一主濾波器模塊6 21 4融合來自τΑ I NS子濾波模塊6 21 2 和INSGPS子遽波器6213的局部最優估計及其估計誤差協方 差陣’得出慣性導航參數誤差、GP S接收機誤差以及慣性 傳感器誤差的 '全局最優估..計_. TAINS子濾波模塊621 2和INSGPS子濾波器模塊621 3分 別接收來自主濾波器模塊6214的慣性導航參數誤差、GPS 接收機誤差以及慣性傳感器誤差的全局最優估計及其估計 誤差協方差陣’更新TAINS子遽波器和INSGPS子濾波器, 執行TAINS子濾波模塊6212、INSGPS子濾波器模塊621 3和 主濾波器模塊6 2 1 4之間的信息分享算法。 為獲得不同的性能,Τ Α I NS子渡波模塊6 2 1 2、INSGPS 子漉波器模塊621 3和主濾波器模塊β2 1 4之間的通信和估計 方法可以有不同的方法。 主遽波器模塊6214可以執行TAINS子濾波模塊62丨2、 INSGPS子濾波器模塊6213和主濾波器模塊6214的估計結果 之間的相容性檢驗,以便檢測和隔離來自有故障的GpS衛 星的信息,並重構導航求解模塊62的結構和處理。 最優的定位導航參數可以通過以下兩種方式得出: 6(b)-l主濾波器模塊mu使用得出的慣性導航參數 誤差最優估計,補償來自慣性導航系統2 〇的慣性導航參 數。 6(b)-2主濾波器模塊6214將得出慣性導航參數誤C: \ Program Files \ Patent \ k322p002.ptd Page 29 454 09 5 V. Description of the invention (25) Filtering process ′ to obtain another locally optimal estimate of the inertial navigation parameter error, GPS receiver error, and inertial sensor error. A main filter module 6 21 4 fuses the local optimal estimate and its estimation error covariance matrix from the τΑ I NS sub-filter module 6 21 2 and the INSGPS sub-wavelet 6213 to obtain the inertial navigation parameter error and the GP S receiver. 'Global Optimal Estimation of Errors and Inertial Sensor Errors .. Gauge_. TAINS sub-filter module 621 2 and INSGPS sub-filter module 621 3 receive inertial navigation parameter errors, GPS receiver errors, and inertia from the main filter module 6214, respectively Global optimal estimation of sensor error and its estimation error covariance matrix 'Update TAINS sub-wavelet and INSGPS sub-filter, execute TAINS sub-filter module 6212, INSGPS sub-filter module 6213, and main filter module 6 2 1 4 Information sharing algorithm. In order to obtain different performances, there may be different methods of communication and estimation methods between the τ Α NS sub-wavelet module 6 2 1 2, the INSGPS sub-wavelet module 621 3 and the main filter module β 2 1 4. The main wave filter module 6214 can perform a compatibility check between the estimated results of the TAINS sub-filter module 62 丨 2, the INSGPS sub-filter module 6213 and the main filter module 6214, in order to detect and isolate the signals from a faulty GpS satellite Information, and reconstruct the structure and processing of the navigation solution module 62. The optimal positioning and navigation parameters can be obtained in the following two ways: The inertial navigation parameters obtained by using the 6 (b) -1 main filter module mu are optimally estimated to compensate for the inertial navigation parameters from the inertial navigation system 2o. 6 (b) -2 The main filter module 6214 will get the inertial navigation parameter error

C:\Program Files\Patent\k322p002.ptd 第 30 頁 454 09 5 五、發明說明(26) 差' GPS接收機誤差以及慣性傳感器誤差的最優估計反饋 給丨貝性導航糸統2 0,以便慣性導航系統2 〇對其誤差進行反-饋校正〇 _ 6c如第五圖所示,一單點地形淨空計算模塊m2 1通過 輸入輸出模塊61接收來自..無線電高度表4〇的無線電高度測 量、來自氣壓高度表30的氣壓高度測量 '來自地形數據庫 50的地形數據’將慣性高度或混合氣壓慣性高度與現在 位置的地形高度相比較,得出參考的單點地形诤空測量, 無線電高度測量是測量的單點地形淨空測量i單點地形淨 空計算模塊622 1將參考的單點她形淨空測量和測量的單點 地形淨空測量之差,輪出給一濾波/估計模塊6222。 由於地形的起伏特性,地形淨空測量是飛行器位置的 非線性函數’而且,參考的單點地形淨空測量和測量的 單點地形淨空測量之差是更是導航參數誤差的函數' 理論上’地形淨空測量是無線電高度表的天線的方向 圖' 飛行器的橫向/縱向位置、高度、姿態的非線性函 數’ 一般來說’第K節拍的參考的單點地形淨空測量可表 達為' TCk = H1NS-h(Xk, Yk)+ yk 這裡’ TCk是第k節拍的參考的單點地形淨空測量;hins 是慣性導航系統20指示的飛行器飛行高度或混合慣性氣壓 高度測量;h(Xk,Yk)是慣性導航系統2〇指示位置(χ,γ )處 的地形高度;v k是地形數據庫誤差。 遽波/估計模塊6222對來自GPS接收機10的測量信息、C: \ Program Files \ Patent \ k322p002.ptd Page 30 454 09 5 V. Description of the invention (26) The best estimate of the GPS receiver error and inertial sensor error is fed back to the navigation system 2 0, so that Inertial navigation system 2 〇 Corrects its error by feedback-feedback _ 6c As shown in the fifth figure, a single-point terrain headroom calculation module m2 1 receives radio altitude measurements from the radio altimeter 40 through the input-output module 61 2. The air pressure altitude measurement from the air pressure altimeter 30 'topographic data from the terrain database 50' compares the inertial altitude or the mixed air pressure inertial altitude with the terrain height at the current position to obtain a reference single-point topographical aerial measurement, radio altitude measurement Is the measured single-point terrain headroom measurement i single-point terrain headroom calculation module 622 1 turns out a difference between the referenced single-point herringbone headroom measurement and the measured single-point terrain headroom measurement to a filtering / estimation module 6222. Due to the undulating nature of the terrain, the terrain headroom measurement is a non-linear function of the aircraft position. Moreover, the difference between the reference single-point terrain headroom measurement and the measured single-point terrain headroom measurement is a function of the navigation parameter error. The measurement is the pattern of the antenna of the radio altimeter 'a non-linear function of the lateral / longitudinal position, altitude, and attitude of the aircraft'. In general, the reference single-point terrain clearance measurement at the Kth beat can be expressed as' TCk = H1NS-h (Xk, Yk) + yk where 'TCk is the reference single-point terrain headroom measurement at the k-th beat; Hins is the aircraft flight altitude or mixed inertial pressure altitude measurement indicated by the inertial navigation system 20; h (Xk, Yk) is the inertial navigation The system 20 indicates the terrain height at the position (χ, γ); vk is the terrain database error. The chirp / estimation module 6222 measures the measurement information from the GPS receiver 10,

C:\ProgramFiles\Patent\k322p002.ptd 第 31 頁 454 09 5 五 '發明說明(27) 慣性導航系統2 0的慣性導航參數、來自單點地形淨空計算 模塊6 2 2 1的參考的單點地形淨空測量和測量的單點地形淨 空測量之差進行濾波計算,得出慣性導航參數誤差、GPS 接收機誤差以及慣性傳感器誤差的最優估計。 由於h(Xk,Yk)是位置(X, Y )的非線性函數’濾波广估計模 塊(6222 )是一非線性濾波/估計器。 最優的定位導航參數可以通過以下兩種方式得出: 6(c ) -1濾波/估計模塊6222使用得出的慣性導航參 數誤差最優估計,補償來自慣性導航系統2〇的慣性導航參 數。 6 (c) -2遽波/估計模塊6222將得出慣性導航參數誤 差、GPS接收機誤差以及慣性傳感器誤差的最優估計反饋 給慣性導航系統20,以便慣性導航系統20對其誤差進行反 饋校正、 6(d)如第六圖所示,一單點地形淨空計算模塊6231通 過輸入輸出模塊61揍收來自無線電高度表40的無線電高度 測量、來自氣壓高度表30的氣壓高度測量、來自地形數據 庫50的地形數據,將慣性高度或混合氣壓慣性高度與現在 位置的地形高度相比較,得出參考的單點地形淨空測量。 無線電高度測量是測量的單點地形淨空測量。單點地形淨 空計算模塊6 2 3 1將參考的單點地形淨空測量和測量的單點 地形诤空測量之差,輸出給一TAINS子濾波器模塊6232。 TAINS子濾波模塊6 23 2對慣性導航參數誤差及慣性傳 感器誤差建模,對參考的單點地形淨空測量和測量的單點C: \ ProgramFiles \ Patent \ k322p002.ptd Page 31 454 09 5 Five 'Description of the Invention (27) Inertial navigation parameters of the inertial navigation system 2 0, single point terrain from the reference of single point terrain headroom calculation module 6 2 2 1 The difference between the headroom measurement and the measured single-point topographic headroom measurement is filtered to calculate the optimal estimates of inertial navigation parameter errors, GPS receiver errors, and inertial sensor errors. Since h (Xk, Yk) is a non-linear function of position (X, Y), the filtering wide estimation module (6222) is a non-linear filter / estimator. The optimal positioning and navigation parameters can be obtained in the following two ways: The 6 (c) -1 filtering / estimation module 6222 uses the optimal estimation of the inertial navigation parameter error to compensate the inertial navigation parameter 20 from the inertial navigation system. 6 (c) -2 The wave / estimation module 6222 feeds back the optimal estimates of the inertial navigation parameter error, GPS receiver error, and inertial sensor error to the inertial navigation system 20 so that the inertial navigation system 20 can correct its error feedback. 6 (d) As shown in the sixth figure, a single-point terrain clearance calculation module 6231 receives radio altitude measurements from the radio altimeter 40, air pressure altitude measurements from the barometric altimeter 30, and the terrain database through the input / output module 61. 50 terrain data, the inertial altitude or mixed air pressure inertia altitude is compared with the terrain altitude at the current position to obtain a reference single-point terrain headroom measurement. Radio altitude measurement is a single point terrain headroom measurement. The single-point terrain headroom calculation module 6 2 3 1 outputs the difference between the referenced single-point terrain headroom measurement and the measured single-point terrain headroom measurement to a TAINS sub-filter module 6232. TAINS sub-filtering module 6 23 2 Modeling inertial navigation parameter errors and inertial sensor errors, reference single-point terrain clearance measurement and single-point measurement

C:\Program Files\Patent\k322p(}〇2._pt(r 第 32 頁 454 09 5 五、發明說明(28) 地形淨空測量之差進行濾波處理,得出慣性導航參數誤差 以及慣性傳感器誤差的局部最優估計》 一 INSGPS子濾波器6233輸入GPS接收機1〇的測量信息 和慣性導航系統2 0的慣性導航參數,並對之進行濾波處 理,得出慣性導航參數誤差' GPS接收機誤差以及慣性傳 感器誤差的另一局部最優估計。 一主濾波器模塊6234融合來自TAINS子濾波模塊6 2 3 2 和INSGPS子濾波器6233的局部最優估計和估計誤差協方差 陣’得出慣性導航參數誤差、GPS接收機誤差以及慣性傳 感器誤差的全局最優估計。 TAINS子濾波模塊6232和INSGPS子濾波器模塊6233分 別接收來自主濾波器模塊6234的慣性導航參數誤差、GPS 接收機誤差以及慣性傳感器誤差的全局最優估計及其估計 誤差協方差陣,更新TAINS子濾波器和INSGPS子遽波器, 執行TAINS子遽波模塊6 2 3 2、INSGPS子濾波器模塊6 23 3和 主濾波器模塊6234之間的信息分享算法。 為獲得不同的性能,TAINS子瀘波模塊6232、INSGPS 子濾波器模塊6233和主濾波器模塊6234之間的通信和估計 方法可以有不同的方法。 主渡波器模塊6234可以執行TAINS子濾波模塊6232、 INSGPS子濾波器模塊6233和主渡波器模塊6214的估計結果 之間的相容性檢驗’以便檢測和隔離來自有故障的⑶^衛 星的信息’並重構導航求解模塊62的結構和處理。 最優的定位導航參數可以通過以下兩種方式得出:C: \ Program Files \ Patent \ k322p (} 〇2._pt (r Page 32 454 09 5 V. Description of the invention (28) The difference between the terrain clearance measurement is filtered to obtain the inertial navigation parameter error and the inertial sensor error. Local Optimal Estimation》 An INSGPS sub-filter 6233 inputs the measurement information of the GPS receiver 10 and the inertial navigation parameters of the inertial navigation system 20, and filters them to obtain the inertial navigation parameter error 'GPS receiver error and Another local optimal estimation of the inertial sensor error. A main filter module 6234 fuses the local optimal estimation from the TAINS sub-filter module 6 2 3 2 and the INSGPS sub-filter 6233 and estimates the error covariance matrix to obtain the inertial navigation parameters. Global optimal estimation of errors, GPS receiver errors, and inertial sensor errors. TAINS sub-filter module 6232 and INSGPS sub-filter module 6233 receive inertial navigation parameter errors, GPS receiver errors, and inertial sensor errors from main filter module 6234, respectively. Global optimal estimation and its estimation error covariance matrix, update TAINS subfilter and INSGPS subwavelet, and execute TAINS Wavelet module 6 2 3 2. Information sharing algorithm between INSGPS sub-filter module 6 23 3 and main filter module 6234. In order to obtain different performance, TAINS sub-wave module 6232, INSGPS sub-filter module 6233 and main The communication and estimation methods between the filter modules 6234 can have different methods. The main wave filter module 6234 can execute the TAINS sub-filter module 6232, the INSGPS sub-filter module 6233, and the estimation results of the main wave filter module 6214. Performance check 'in order to detect and isolate the information from a faulty CD satellite' and reconstruct the structure and processing of the navigation solution module 62. The optimal positioning and navigation parameters can be obtained in the following two ways:

C:\Program Files\Patent\k322p002.ptd 第 33 頁 ^54095 五 '發明說明(29) 6(d)-l主濾波器模塊6234使用得出的慣性導航來 誤差最優估計,補償來自慣性導航系統2〇的慣性導航參數 數0 6(d)-2主濾波器模塊6234將得出慣性導航參數誤 差、GPS接收機誤差以及慣性傳感器誤差的最優估計、 给慣性導航系統20,以便慣性導航系統2〇對其 °貝 饋校正。 、兩走進仃反 ^ 如第七圖所示’地面鄰警求解模塊63進一步包括一 詢參數計算模塊631、飛行軌跡預測模塊6 3 2、主警決狄^ 塊63 3、飛行軌跡計劃輔助模塊β34 、合成視^處》理模朿、 6 3 5、語音處理模塊6 3 6。 、鬼 查詢參數計算模塊631接收來自導航求解模塊62的最 優導航參數,計算地形數據庫50的查詢參數,以便從 數據庫50獲得飛行器當前位置和周圍的地形數據。 飛行軌跡預測模塊632接收和積累來自導航求解模塊 62的最優導航參教、來自飛行控制和管理系統9〇的飛行器 性能和布局數據’預測飛行器向前飛行的飛行轨跡。飛 轨跡預測模塊6 3 2輸出預測的飛行器向前飛行的飛行轨跡 以及位置、速度、姿態給告警決策模塊633。 该告警決策模塊633接收來自飛行軌跡預測模塊632的 預測的飛行執跡、來自飛行控制和管理系統9〇的飛行器性 能和布局數據如下滑線和起落架數據等、來自地形數據庫 5〇的飛行器當前位置和周圍的地形數據,如果預測的飛行 轨跡太靠近前面地面,告警決策模塊6 3 3便作出地面鄰.警C: \ Program Files \ Patent \ k322p002.ptd Page 33 ^ 54095 Five 'Invention Description (29) 6 (d) -l The main filter module 6234 uses the resulting inertial navigation to estimate the error optimally and compensates from the inertial navigation The number of inertial navigation parameters of the system 20 is 6 (d) -2. The main filter module 6234 will obtain the optimal estimates of inertial navigation parameter errors, GPS receiver errors, and inertial sensor errors, and give them to the inertial navigation system 20 for inertial navigation. The system 20 corrects it in degrees. 2. As shown in the seventh figure, 'The ground adjacent police solution module 63 further includes a query parameter calculation module 631 and a flight trajectory prediction module 6 3 2. The main police decision block ^ Block 63 3. Flight trajectory planning assistance Module β34, Synthetic Vision, Management Model, 6 3 5, and Speech Processing Module 6 3 6. The ghost query parameter calculation module 631 receives the optimal navigation parameters from the navigation solution module 62 and calculates the query parameters of the terrain database 50 so as to obtain the current position of the aircraft and the surrounding terrain data from the database 50. The flight trajectory prediction module 632 receives and accumulates optimal navigation guidance from the navigation solution module 62, aircraft performance and layout data from the flight control and management system 90, and predicts the flight trajectory of the aircraft forward. The flight trajectory prediction module 6 3 2 outputs the predicted flight trajectory of the forward flight of the aircraft, and the position, speed, and attitude to the alarm decision module 633. The alarm decision module 633 receives the predicted flight track from the flight trajectory prediction module 632, the aircraft performance and layout data from the flight control and management system 90, such as slip line and landing gear data, etc., and the current aircraft from the terrain database 50. Location and surrounding terrain data. If the predicted flight trajectory is too close to the front ground, the alarm decision module 6 3 3 will make a ground neighbor.

C:\Program Files\Patent\k322p002. ptd 第 34 頁 454 09 5 五、發明說明(30) 信息,並將之輪出於通* t u 謦步揀;r祕ας 、、&quot;爪行軌跡計劃輔助模塊634 '合成視 k你a / , 處理模塊636。此外,告警決策模塊 633也將現在的位置、技痒 助模塊634。 速度、4態輪出給飛行軌跡計劃輔 1 ^跡#劃輔助模塊634接收來自告警決策模塊如 鄰吕信息和現在的位置、速度、姿態、來自地形數 據庫50的飛打器當前位置和周圍的地形數據、“飛行控 制Π理系統90的飛行器性能和布局數據,為飛行員計算 一最優的防撞回避軌跡。 合成視覺處理模塊635接收來自告警決策模塊6 3 3的預 測的飛行軌跡和地面鄰警信息 '來自來自地形數據庫5〇 飛行器當前位置和周圍的地形數據、來自飛行軌跡計割 助模塊634的最優的防撞回避執跡,為合成視覺系統7〇 算其驅動數據。 〇t 語音處理模塊636接收來自告警決策模塊633的預 飛行軌跡和地面鄰警信息、來自來自地形數據庫5〇的飛二 器當前位置和周阖的地形數據、來自飛行軌跡計劃辅助= 塊63 4的最優的防撞回避執跡,為語音系統8〇計酿、 數據。 動 如第一圖所示,一組合定位和地面鄰警方法包括 步驟:i 下列 (1 )接收GPS信號,得出GPS的位置、速度和時間作# 或偽距、偽距率測量’將之輸給一組合定位及地面鄰警〜 處理機》 舌C: \ Program Files \ Patent \ k322p002. Ptd Page 34 454 09 5 V. Description of the invention (30) information, and turn it out of the way * tu Step by step; r secret ας, &quot; Claw track plan Auxiliary module 634 'synthesizes video a /, processing module 636. In addition, the alarm decision module 633 will also assist the module 634 with the current position. Speed, 4-state turn-out to the flight trajectory planning assistance 1 迹 Track #planning assistance module 634 receives information from the alarm decision module such as neighbors and current position, speed, attitude, current position of the hitter from the terrain database 50 and surrounding Terrain data, "aircraft performance and layout data of the flight control system 90, calculate an optimal collision avoidance trajectory for the pilot. The synthetic vision processing module 635 receives the predicted flight trajectory and ground neighbors from the alert decision module 6 3 3 The warning information is from the terrain database 50. The current position of the aircraft and the surrounding terrain data, and the optimal collision avoidance avoidance track from the flight trajectory cut-off module 634. The driving data is calculated for the synthetic vision system 70. Voice The processing module 636 receives the pre-flight trajectory and ground adjacent police information from the alarm decision module 633, the current position of the second vehicle from the terrain database 50 and the topographic data of the surrounding area, and the assistance from the flight trajectory plan = Block 63 4 Optimal The anti-collision avoidance track is designed for the voice system 80, and the data. As shown in the first picture, a combination of positioning and ground The neighborhood police method includes the following steps: i The following (1) receives the GPS signal and obtains the GPS position, speed, and time for # or pseudorange, pseudorange rate measurement, and then inputs it to a combination of positioning and ground neighborhood police ~ processor. " tongue

C:\Program Files\Patent\k322p002.ptd 第35頁C: \ Program Files \ Patent \ k322p002.ptd Page 35

4b4 Uy b 五、發明說明(31) — (2)接收飛行器的角速率和比力信息,求解導航 程’獲得慣性導航參數值,如戌鼽[1]、速度、姿陣等, 之送給組合定位及地面鄰警處理機1 ^ (3 )測量大氣壓力,計算氣壓高度測量,將之 合定位及地面鄰警處理機。 &gt;&gt;〇 (4 )測量飛行器發射和從地面反射回來的無線電 號的時間延遲,計算線電高度測量將之送給組合定 ° 面鄰警處理機。 地 .(5 )查詢一機載地形數據庫或通過一數據鏈查詢— 與地面的地形數據庫,獲得飛機現在位置和周圍的地形言 度數據將之送給組合定位及地面鄰警處理機。 ° (6 )接收GPS接收機的位置、速度和時間信息或偽 距、偽距率測量、慣性導航參數、氣壓高度測量、無線電 高度測量、飛行器現在位置和周圍的地形高度數據,計算 最優的位置、速度、姿態尊導航信息,以及最優的地面鄰 警信息.。 如第八圖所示,在第i步驟中,來自第6步驟的最優位 置、速度、加速度、姿態數據進一步可用來辅助Gps接收 機1 0的信號處理機1 6的信號捕獲、跟蹤、再捕獲處理, 以便提高系統性能。 如第九圖所示,在第2步驟中,可以用來自第6步驟的 位置誤差、速度誤差、姿態誤差以及傳感器誤差的最优估 計’在慣性導航系統1 0中的傳感器誤差補償模塊23、變換 矩陣計算模塊24、姿態位置速度計算模塊2&gt;中,進行誤差4b4 Uy b V. Description of the invention (31) — (2) Receive the angular velocity and specific force information of the aircraft, solve the navigation range to obtain the inertial navigation parameter values, such as 戌 鼽 [1], speed, attitude array, etc., and send them to Combined positioning and ground adjacent police processor 1 ^ (3) Measure the atmospheric pressure, calculate the barometric height measurement, and combine them with the ground adjacent police processor. &gt; &gt; 〇 (4) Measure the time delay of the radio signal transmitted from the aircraft and reflected from the ground, calculate the wire electrical height measurement and send it to the combined fixed-surface adjacent police processor. Ground (5) Query an on-board terrain database or query through a data link — and the terrain terrain database to obtain the aircraft's current location and surrounding terrain speech data and send it to the combined positioning and ground adjacent police processor. ° (6) Receive GPS receiver position, speed and time information or pseudorange, pseudorange rate measurement, inertial navigation parameters, barometric altitude measurement, radio altitude measurement, aircraft current position and surrounding terrain altitude data, and calculate the optimal Position, speed, attitude and navigation information, as well as optimal ground neighbor information. As shown in the eighth figure, in step i, the optimal position, speed, acceleration, and attitude data from step 6 can be further used to assist the signal acquisition, tracking, and re-processing of the signal processor 16 of the GPS receiver 10 Capture processing to improve system performance. As shown in the ninth figure, in the second step, the optimal estimation of the position error, speed error, attitude error, and sensor error from the sixth step can be used. The sensor error compensation module 23 in the inertial navigation system 10, In the transformation matrix calculation module 24 and the attitude position speed calculation module 2>, errors are performed.

C:\Program Files\Patervt\k322pO()2.ptd 第 36 頁 4 54 09 5 五、發明說明(32) 反饋校正,以便提高系統性能。 如第二圖及第七圖所示,在第6步驟中,可以附加一 合成視覺處理步驟’將地面鄰警信息作進一步處理,以 便為.飛行員提而增強的視覺顯示。 如第二圖及第七圖所示,在第6步驟中,可以附加一 語音處理步驟’將地鄰警信息作進一步處理,用以給飛 行員提供語音地面鄰警信息。 第1〜5步驟可以並行方式或串行方式處理。 如第一圖及第八圖所示,第1步驟進一步包括: (1 -1 )通過GPS天線11接收GPS射頻RF信號,並將信 號饋給預放大電路12。 (1 — 2 )通過預放大電路12放大GPS RF信號,以便提 高其信號噪聲比,放大後的信號被饋入一下變頻電路丨3。 (1 一3 )借助下變頻電路13將輸入的GPS RF信號與來 自振蕩器1 7的本地信號混頻,下變頻為gps中頻(IF )信 號,並將GPS IF信號饋入一帶通濾波器14。 (1 - 4 )借助帶通濾波器1 4濾除輪入的U?信號中的脅 聲’以便提高其信號噪聲比,並將濾除噪聲後的IF信號饋 入一 IF採樣及A/D變換器15。 … (1 — 5 )借助11^採樣及^1)變換器15,來對輪人的模擬 IF信號進行採樣,並將數字I、q信號饋入信號處理機丨6。 (1 一6 )在信號處理機16中’接收來自iF採樣及人/^變 換器1 5的數字I、Q信號’來自組合定位及地面鄰警處理機 6〇的最優最優位置、速度、姿態信息,執行來自組合定位C: \ Program Files \ Patervt \ k322pO () 2.ptd Page 36 4 54 09 5 V. Description of the invention (32) Feedback correction to improve system performance. As shown in the second and seventh figures, in the sixth step, a synthetic vision processing step can be added to further process the ground neighbor police information so as to enhance the visual display for the pilot. As shown in the second and seventh figures, in the sixth step, a voice processing step can be added to further process the ground neighbor information to provide pilots with voice ground neighbor information. Steps 1 to 5 can be processed in parallel or serially. As shown in the first diagram and the eighth diagram, the first step further includes: (1 -1) receiving the GPS radio frequency RF signal through the GPS antenna 11, and feeding the signal to the pre-amplification circuit 12. (1-2) The pre-amplification circuit 12 amplifies the GPS RF signal in order to improve its signal-to-noise ratio, and the amplified signal is fed into the following frequency conversion circuit 丨 3. (1 to 3) The down-converter circuit 13 mixes the input GPS RF signal with the local signal from the oscillator 17, down-converts it to a GPS intermediate frequency (IF) signal, and feeds the GPS IF signal into a band-pass filter. 14. (1-4) The band-pass filter 14 is used to filter the threatening sound of the U? Signal in order to improve its signal-to-noise ratio, and feed the filtered IF signal into an IF sample and A / D Converter 15. … (1-5) With the 11 ^ sampling and ^ 1) converter 15, the analog IF signal of the human is sampled, and the digital I and q signals are fed to the signal processor 丨 6. (1-6) In the signal processor 16, 'receive the digital I and Q signals from the iF sampling and human / ^ converter 15' from the optimal optimal position and speed of the combined positioning and ground neighboring police processor 60. , Attitude information, execution from combined positioning

C:\Program Files\Patent\k322p002.ptd 第 37 頁 454095 五、發明說明(33) 跟蹤、 ’輸出給導 及地面鄰警處理機60數據辅助的gps信號的 再捕獲處理,計算偽距、偽距率以及衛’星、捕獲、 航處理機18。 星歷 (1—7)在導航處理機18中,來自作 距、偽距率以及衛星星歷被用來求解導^ 理器1 6偽 兩類數據給組合定位及地面鄰警處理機6 〇人程’得到下列 (1 )飛行器的位置、速度、時間信息。 (2 ) G P S接收機的原始測量值:偽距、 衛星星歷^ ‘ 瑪距率,以及 比 如第一圖及第九圖所示,第2步驟進—步包括. (2 — 1 )借助慣性測量組件2 1測量機體角t速率 力,將之輸給誤差補償模塊23。 ' (2 — 1 )在一傳感器誤差補償模塊23中,使用 6步驟中得到的傳感器誤差的最優估計,補償輪入的自第 角速率、比力中的誤差。補償後的機體角速率被輸出給 換矩陣計算模塊24,補償後的比力被輸出給坐標變〜 模塊25。 及谀叶鼻 (2 —3 )在一變換矩陣計算模塊24中,補償後的機體 角速率及來自地球和載體角速率計算模塊26的當地導貌坐 標系(η系)到慣性坐樣系(丨系)的旋轉矢量被用來更 新從機體系(b系)到導航系的的方向變換矩陣;來自組 合定位及地面鄰警處理機6〇的慣性導航計算的姿態的誤差 的最優估計被用來補償方向矩陣的誤差,更新從機體系到 導銳系的的方向矩陣的可以有歐拉法、直接方向余弦法和C: \ Program Files \ Patent \ k322p002.ptd Page 37 454095 V. Description of the invention (33) Tracking, 'output to guide and ground neighboring police processor 60 data-assisted GPS signal re-capture processing, calculate pseudorange, pseudo Range and satellites' satellite, capture, and aero processors 18. Ephemeris (1-7) In the navigation processor 18, the data from the working distance, pseudorange rate, and satellite ephemeris are used to solve the processor 16 pseudo-two types of data to the combined positioning and ground neighboring police processor 6. The man's way gets the following (1) position, speed and time information of the aircraft. (2) The original measured values of the GPS receiver: pseudorange, satellite ephemeris ^ 'ma distance, and as shown in the first and ninth pictures, the second step further includes-(2 — 1) by inertia The measuring unit 21 measures the angular velocity force of the body and outputs it to the error compensation module 23. '(2 — 1) In a sensor error compensation module 23, the optimal estimation of the sensor error obtained in 6 steps is used to compensate for the errors in the angular velocity and specific force of the wheel. The compensated body angular rate is output to the transformation matrix calculation module 24, and the compensated specific force is output to the coordinate transformation ~ module 25. And lobular nose (2-3) in a transformation matrix calculation module 24, the compensated body angular rate and the local map coordinate system (η system) from the earth and carrier angular rate calculation module 26 to the inertial sitting sample system ( The rotation vector is used to update the direction transformation matrix from the aircraft system (B system) to the navigation system; the optimal estimate of the attitude error calculated from the integrated positioning and ground proximity police processor 60 ’s inertial navigation is To compensate for the error of the directional matrix, and update the directional matrix from the machine system to the guided system can be Euler's method, direct direction cosine method and

c-\Program Files\Patent\k322p002.ptdc- \ Program Files \ Patent \ k322p002.ptd

454095 五'發明說明(34) ' ' 四元數法,從機體系到導航系的的方向變換矩陣被輸出給 坐標變換計算模塊2 5和姿態位置速度計算模塊2 7。 (2 — 4 )在坐標變換計算模塊2 5中,來自傳感器誤差 補償模塊2 3的補償後的比力是表達在機體坐標系中的,它 被來自變換矩陣計算模塊24的變換矩陣轉換為表達在導航 坐標系中的比力’並將之輸出到姿態位置速度計算模塊 27。 (2 - 5 )該組合定位及地面鄰,警處理機6 〇的慣性導航參 數的最優估計’計算位置、速度、姿態,並補償其誤 差’更新後導航參數被送給地球和載體角速率計算模塊2 6 和組合定位及地面鄰警處理機6 0。 (2-6)在地球和載體角速率計算模塊26 ’來自姿態 位置速度計算模塊2 7的慣性導航參數被用來計算計算當地 導航坐標系到慣性坐標系的旋轉矢量,並將之輸出給變換 矩陣計算模塊24。 如第一圖所示,在第三步驟中,空氣壓力被氣壓高度 表3 0測出’並轉換為氣壓高度測量,並將之輸出給組合定 位及地面鄰警處理機6 0。 如第一圖所示’在第四步驟中,一無線電信號由無線 電高度表30發出’通過無線電高度表3 0接收地面的回波, 測置韓_射和接收的時間差’並將時間差轉換為無線電高度 測量,輸出無線電高度測量給組合定位及地面鄰警處理機 60 〇 如第二圖所示,第六步驟進一步包括下列步驟:454095 The description of the five inventions (34) 'quaternion method, the direction transformation matrix from the machine system to the navigation system is output to the coordinate transformation calculation module 25 and the attitude position velocity calculation module 27. (2-4) In the coordinate transformation calculation module 25, the compensated specific force from the sensor error compensation module 23 is expressed in the body coordinate system, and it is converted into an expression by the transformation matrix from the transformation matrix calculation module 24. The specific force 'in the navigation coordinate system is output to the attitude position speed calculation module 27. (2-5) The optimal positioning of the combined positioning and ground neighbors, the police processor 60, the optimal estimation of the inertial navigation parameters 'calculate the position, speed, attitude, and compensate for their errors' The updated navigation parameters are sent to the earth and the carrier angular rate Calculation module 2 6 and combined positioning and ground adjacent police processor 60. (2-6) In the earth and carrier angular rate calculation module 26 'The inertial navigation parameters from the attitude position velocity calculation module 27 are used to calculate the rotation vector of the local navigation coordinate system to the inertial coordinate system and output it to the transformation Matrix calculation module 24. As shown in the first figure, in the third step, the air pressure is measured by a barometric altimeter 30 and converted into a barometric altitude measurement, which is output to the combined positioning and ground adjacent police processor 60. As shown in the first figure, 'In the fourth step, a radio signal is sent from the radio altimeter 30.' The ground echo is received through the radio altimeter 30, the time difference between the transmission and reception is measured, and the time difference is converted into Radio altitude measurement, output radio altitude measurement to the combined positioning and ground adjacent police processor 60. As shown in the second figure, the sixth step further includes the following steps:

C:\Program Files\Patent\k322p002. ptd 第 39 頁 4 54 09 5 五、發明說明(35) (6—1)通過輸入輸出模塊61,從第1〜5步聰,接收 GPS揍收機的位置、速度、時間信息或偽矩、偽距率測 量,慣性導航參數、氣壓高度測量、無線電高度測量、現 在飛行器位置和周圍的地形數據。 ^ (6 —2)使用接收到的GPS接收機的位置、速度、時間 信息或偽距、偽距率測量、慣性導航參數、氣壓高度測 量、無線電高度測量、現在飛行器位置和周圍的地形數 據,計算計算最優的位置、速度、姿態等導航參數,為獲 得本發明的不同系統性能,計算方法^步驟可以有以下方 式: 6 — 2 (a ):如第三圖所示,通過輪入輸出模塊61, 來自無線電高度表40的無線電高度測量、來自氣壓高度表 3 0、來自地形數據庫5 0的地形數據被一相關/氐配模塊 6 2 0 1接收’收集到的無線電高度測量和氣壓高度測量’在 一 .給定的時間窗口内’被用來創建_個測.量的地形包絡’ 地形數據庫的地形數據’被用來形成多個參考的地形包 絡,測量的地形包絡和參考地形包絡被比較,一旦找到匹 配的地形包絡,匹配的地形包絡的地理位置被輸出給一慮 波/估計模塊6202。 此外,在一相關/匹配模塊62〇 1中,無線電高度測量 與地形高度相加,並與慣性高度或混合氣壓慣性高度相比 較’形成咼度殘差將之輸出給濾、波/估計模燒6.2 〇 2。 使用來自GPS接收機10的.測量信息、慣性.導航系統 的慣性導航參數、來自相關/匹配模塊6201的匹配的地形C: \ Program Files \ Patent \ k322p002. Ptd page 39 4 54 09 5 V. Description of the invention (35) (6-1) Via the input and output module 61, from the first to the fifth steps of Cong, receive GPS receiver Position, speed, time information or pseudo-moments, pseudo-range rate measurement, inertial navigation parameters, barometric altitude measurement, radio altitude measurement, current aircraft position and surrounding terrain data. ^ (6--2) using the received GPS receiver's position, speed, time information or pseudorange, pseudorange rate measurement, inertial navigation parameters, barometric altitude measurement, radio altitude measurement, current aircraft position and surrounding terrain data, Calculate and calculate the optimal navigation parameters such as position, speed, and attitude. In order to obtain the performance of different systems of the present invention, the calculation method may have the following steps: 6-2 (a): as shown in the third figure, output by rotation Module 61, radio altitude measurement from radio altimeter 40, terrain data from barometric altimeter 30, terrain data from terrain database 50 are received by a correlation / configuration module 6 2 0 1 'collected radio altitude measurements and barometric altitude Surveys 'in a given time window' were used to create _measured terrain envelopes. The terrain data of the terrain database was used to form multiple reference terrain envelopes. The measured terrain envelope and reference terrain envelope By comparison, once a matching terrain envelope is found, the geographic location of the matching terrain envelope is output to a wave / estimation module 6202. In addition, in a correlation / matching module 6201, the radio altitude measurement is added to the terrain altitude, and compared with the inertial altitude or mixed air pressure inertial altitude, 'formed residuals are formed and output to the filter, wave / estimated model 6.2 〇2. Use measurement information from GPS receiver 10, inertial navigation parameters of inertial navigation system, matched terrain from correlation / matching module 6201

C:\Program Files\Patent\k322p002.ptd 第 40 買 4 54 09 5 五、發明說明(36) '----:--- 包,的地理位置,在渡波/估計模塊62〇2,以集中處理的 方,,進打濾波計算,得出慣性導航參數誤差、Gps接收 機誤差以及慣性傳感器誤差的最優估計,最優的定位導 航參數可以通過以下兩種方式得出: 6 ( a ) -1在渡波/估計模塊62〇2中,使用得出的慣性 導航參數誤差最優估計,補償來自慣性導航系統2〇的慣性 導航參數》 6 ( a ) -2得出慣性導航參數誤差、Gps接收機誤差 以及慣性傳感器誤差的最優估計被濾波/估計模塊62〇2反 饋給慣性導航系統20,以便慣性導航系統2〇對其誤差進行 反饋校正。 6 —2 (b)如第四圖所示’通過輪入輸出模塊61,來自 無線電南度表4 0的無線電高度測量、來自氣壓高度表3 〇、 來自地形數據庫5 0的地形數據被一相關/匹配模塊62丨丨接 收’收集到的無線電高度測量和氣壓高度測量,在一給 定的時間窗口内,被用來創建一個測量的地形包絡,地形 數據庫的地形數據’被甩來形成多個參考的地形包絡,測 量的地形包絡和參考地形包絡被比較,一旦找到匹配的地 形包絡,匹配的地形包絡的地理位置被輸出給一TAINS子 濾波模塊6212。 ' 此外,在一相關/匹配模塊621丨中,無線電高度測量 與地形高度相加’並與慣性高度或混合氣壓償性高度相比 軚’形成高度殘差’將之輸出給TAINS子濾波模塊621 2。 慣性導航參數誤差及慣性傳感器誤差在TAINS子渡波模塊C: \ Program Files \ Patent \ k322p002.ptd The 40th buy 4 54 09 5 V. Description of the invention (36) '----: --- The geographical location of the package, in the wave / estimate module 62〇2, to The method of centralized processing is to perform filtering calculation to obtain the optimal estimation of inertial navigation parameter error, Gps receiver error, and inertial sensor error. The optimal positioning and navigation parameters can be obtained by the following two methods: 6 (a) -1 In the crossing wave / estimation module 62〇2, use the optimal estimation of the inertial navigation parameter error obtained to compensate for the inertial navigation parameter 20 from the inertial navigation system》 6 (a) -2 to obtain the inertial navigation parameter error, Gps The optimal estimation of the receiver error and the inertial sensor error is fed back to the inertial navigation system 20 by the filtering / estimation module 622, so that the inertial navigation system 20 corrects its error feedback. 6-2 (b) As shown in the fourth figure, through the turn-in output module 61, the radio altitude measurement from the radio southerly table 40, the air pressure altimeter 3 0, and the terrain data from the terrain database 50 0 are correlated. The / matching module 62 receives the collected radio altitude measurement and barometric altitude measurement. Within a given time window, it is used to create a measured terrain envelope. The terrain data of the terrain database is dumped to form multiple The reference terrain envelope, the measured terrain envelope and the reference terrain envelope are compared. Once a matching terrain envelope is found, the geographic location of the matched terrain envelope is output to a TAINS sub-filtering module 6212. In addition, in a correlation / matching module 621 丨, the radio altitude measurement is added to the terrain height, and compared with the inertial altitude or the mixed air pressure compensation altitude, `` form a height residual '' and output it to the TAINS sub-filter module 621 2. Inertial navigation parameter error and inertial sensor error in TAINS sub-wave module

C:\Program Files\Patent\k322p002.ptdC: \ Program Files \ Patent \ k322p002.ptd

454 09 5 五、發明說明(37) 6 2 1 2被建模,匹配的地形包絡的地理位置和高度殘差在 T AINS子濾波模塊6 21 2中進行濾波處理,得出慣性導航參 數誤差以及慣性傳感器誤差的局部最優估計。 GPS接收機1 〇的測量信息和慣性導航系統2 〇的慣性導 航參數被一 INSGPS子濾波器6213接收,並對之進拧濾波處 理,得出慣性導航參數誤差、GPS接收機誤差以及慣性傳 感器誤差的另一局部最優估計。 來自TAINS子濾波模塊6212和INSGPS子濾波器621 3的 局部最優估計及其估計誤差協方差陣被主濾波器模塊6214 進行融合處理,得出慣性導航參數誤差、GPS接收機誤差 以及慣性傳感器誤差的全局最優估計。 收來自主濾波器模塊62 1 4的慣性導般參數誤差、GPS 接收機誤差以及慣性傳感器誤差的全局最優估計及其估計 誤差協方差陣被TAINS子濾波模塊6 212和INSGPS子濾波器 模塊6213分別接收,以便更新TAINS子濾波器和INSGps子 遽波器,執行TAINS子濾波模塊621 2、INSGPS子濾波器模 塊6213和主濾波器模塊62U之間的信息分享算法。 為獲得不同的性能,TAINS子濾波模塊6212、INSGPS 子渡波器模塊6213主濾波器模塊62 14之間的通信和估計方 法可以有不同的方法。 TAINS子濾波模塊6212、INSGPS子濾波器模塊621 3和 主濾波器模塊6 21 4的估計結果之間的相容性檢驗可由主遽 波器模塊62 1 4執行,以便檢測和隔離來自有故障的GPS衛 生的彳§息’並重構導航求解模塊6 2的結構和處理.。454 09 5 V. Description of the invention (37) 6 2 1 2 is modeled. The geographic location and height residual of the matched terrain envelope are filtered in the T AINS sub-filtering module 6 21 2 to obtain the inertial navigation parameter error and Local optimal estimation of inertial sensor error. The GPS receiver 1 〇 measurement information and inertial navigation system 2 〇 inertial navigation parameters are received by an INSGPS sub-filter 6213, and then filtered and processed to obtain inertial navigation parameter errors, GPS receiver errors and inertial sensor errors Of another locally optimal estimate. The local optimal estimates from the TAINS sub-filter module 6212 and the INSGPS sub-filter 6213 and their estimation error covariance matrices are fused by the main filter module 6214 to obtain the inertial navigation parameter errors, GPS receiver errors, and inertial sensor errors Global optimal estimate. The global optimal estimates of inertial general parameter errors, GPS receiver errors, and inertial sensor errors and their estimated error covariance matrices received from the main filter module 62 1 4 are TAINS sub-filter module 6 212 and INSGPS sub-filter module 6213 Received separately to update the TAINS sub-filter and INSGps sub-wavelet, and executes the information sharing algorithm between the TAINS sub-filter module 6212, the INSGPS sub-filter module 6213 and the main filter module 62U. In order to obtain different performances, there may be different methods of communication and estimation methods between the TAINS sub-filter module 6212, the INSGPS sub-wavelet module 6213, and the main filter module 62-14. The compatibility check between the estimated results of the TAINS sub-filtering module 6212, INSGPS sub-filtering module 621 3 and the main filter module 6 21 4 can be performed by the main wave filter module 62 1 4 in order to detect and isolate from faulty Information on GPS Hygiene 'and Restructure the Structure and Processing of Navigation Solution Module 6 2.

C:\Program Files\Patent\k322p0.02.ptd .第 42 頁 45409 5C: \ Program Files \ Patent \ k322p0.02.ptd. Page 42 45409 5

五、發明説明(38) 最優的定位導航參數可以通過以下兩種方式得出: 6 ( b ) -1在主濾波器模塊6 21 4中,使用得出的慣性 導航參數誤差最優估計,補償來自慣性導航系統2〇的慣性 導航參數。 6 ( b ) -2將得出慣性導航參數誤差、GPS揍收機誤 差以及慣性傳感器誤差的最優估計由主濾波器模塊6214反 饋給慣性導航系統20,以便慣性導航系統2〇對其誤差進行 反饋校正。 6 (c)如第五圖所示,通過輸入輸出模塊61,來自無 線電高度表40的無線電高度測量、來自氣壓高度表(3〇 ) '來自地形數據庫(50 )的地形數據被一單點地形淨空 計算模塊6 2 2 1接收’慣性高度或混合氣壓慣性高度與現在 位置的地形高度相比較,得出參考的單點地形淨空測量, 無線電南度測量是測量的單點地形淨空測量,參考的單點 地形淨空測量和測量的單點地形淨空測量相比較,其結果 被輸出給一濾波/估計模塊6 2 22。 “ 由於地形的起伏特性’地形淨空測量是飛行器位置的 非線性函數,而且’參考的單點地形淨空測量和測量的 單點地形淨空測量之差是導航參數誤差的函數。、 理論上,地形淨空測量是無線電高度表的天線的方向 圖、飛行器的橫向/縱向位置、高度、姿態的非線性函 數,一般來說,第K節拍的參考的單點地形淨空測量可表 達為* TCk = HINS-h(Xk, Yk) + (i)V. Description of the invention (38) The optimal positioning and navigation parameters can be obtained in the following two ways: 6 (b) -1 In the main filter module 6 21 4, the optimal estimation of the inertial navigation parameter error is used, The inertial navigation parameters from the inertial navigation system 20 are compensated. 6 (b) -2 The optimal estimation of the inertial navigation parameter error, GPS receiver error, and inertial sensor error is fed back to the inertial navigation system 20 by the main filter module 6214, so that the inertial navigation system 20 performs its error. Feedback correction. 6 (c) As shown in the fifth figure, through the input-output module 61, the radio altitude measurement from the radio altimeter 40, the terrain data from the barometric altimeter (30) ', and the terrain data from the terrain database (50) are a single-point terrain. The headroom calculation module 6 2 2 1 receives the inertial altitude or mixed air pressure inertia altitude and compares it with the terrain height at the current position to obtain a reference single-point terrain headroom measurement. The radio southerly measurement is a measured single-point terrain headroom measurement. The single-point terrain headroom measurement is compared with the measured single-point terrain headroom measurement, and the result is output to a filtering / estimation module 6 2 22. "Due to the undulating characteristics of the terrain, 'the terrain headroom measurement is a non-linear function of the aircraft position, and the difference between the reference single-point terrain headroom measurement and the measured single-point terrain headroom measurement is a function of the navigation parameter error. In theory, the terrain headroom The measurement is a non-linear function of the radio altimeter's antenna pattern, the lateral / longitudinal position, altitude, and attitude of the aircraft. In general, the reference single-point terrain clearance measurement at the Kth beat can be expressed as * TCk = HINS-h (Xk, Yk) + (i)

C; \Prograni Fi l6s\Pcttent\k322p002. ptd 第 43 頁 五、發明說明(39) --- 日坆裡’ TCk是第K節拍的參考的單點地形淨空測量; ^&quot;^疋^性導航系統20指示的飛行器飛行高度或混合慣性 ,、二,測量;h(Xk,Yk)是慣性導航系統2〇指示位置(X,γ )處的地形高度;^ k地形數據庫誤差。 、 來自GPS接收機1 〇的測量信息、慣性導航系統2〇的慣 性航參數、來自單點地形淨空計算模塊622 1的參考的單 點《:地淨/測量和測量的單點地形淨空測量之差,在遽波 /估7塊6 222 + ’進行遽波計算,得出慣性導航參數誤 :S接收機誤差以及慣性傳感器誤差的最優估計。 最優的定位導航參數可以通過以下兩種方式得出: $ ) ―1在瀘波/估計模塊62 22中,使用得出的慣性 誤差最優估計,補償來自慣性導航系統20的慣性 導航參數。 6 ( c ) 2得出慣性導航參數誤差、π〗接收機誤差 Ϊ感器誤差的最優估計被濾波/估計模湖2反 饋,。t貝性導航系統20,以便慣性導航系統2〇對 行 反饋校正。 6⑷如第六圖所通過輪入輸出模塊61,來自盔 線電南度表4D的無線電高度測量、來自氣壓高度㈣ 自地形數據庫50的地形數據被一單點地形淨空計算模 6 22 1接收,慣性高度或混合氣壓慣性高度與現在位置 形高度相比較,得出參考的單點地形淨空測量,益線 度測量是測量的單點地形淨空測量,參考的單點地形淨=C; \ Prograni Fi l6s \ Pcttent \ k322p002. Ptd p. 43 5. Description of the invention (39) --- Sundial Lane 'TCk is the reference single-point terrain clearance measurement at the Kth beat; ^ &quot; ^ 疋 ^ 性The altitude or hybrid inertia of the aircraft indicated by the navigation system 20, 2, and measurement; h (Xk, Yk) is the terrain altitude at the indicated position (X, γ) of the inertial navigation system 20; and the terrain database error. , Measurement information from GPS receiver 10, inertial navigation parameters of inertial navigation system 20, single point reference from single-point terrain headroom calculation module 6221, ": ground clearance / measurement and measurement of single-point terrain headroom measurement Poor, perform a wave calculation at 6222 + '7 block / Estimation, and get the inertial navigation parameter error: S receiver error and optimal estimate of inertial sensor error. The optimal positioning and navigation parameters can be obtained in the following two ways: $) ―1 In the wave / estimation module 62 22, the inertial error optimal estimation is used to compensate the inertial navigation parameters from the inertial navigation system 20. 6 (c) 2 The optimal estimation of the inertial navigation parameter error, π 接收机 receiver error, and the sensor error are fed back by the filtering / estimated model lake 2. The tactile navigation system 20 allows the inertial navigation system 20 to perform a feedback correction on the line. 6: As shown in the sixth figure, through the turn-in output module 61, the radio altitude measurement from the helmet line electric southmeter 4D, and the air pressure altitude. The terrain data from the terrain database 50 is received by a single-point terrain headroom calculation module 6 22 1 The inertia height or mixed air pressure inertia height is compared with the current position shape height to obtain a reference single-point terrain headroom measurement. The profit line measurement is a measured single-point terrain headroom measurement. The referenced single-point terrain headroom =

C:\Program Files\Patent\k322p002. ptd 第 44 頁C: \ Program Files \ Patent \ k322p002.ptd page 44

1H 454 09 5 五'發明說明(40) 測量和測量的單點地形淨空測量相比較,其結果被輪出給 一TAINS子濾波器模塊6 2 3 2。 慣性導航參數誤差及慣性傳感器誤差在TAINS子遽波 模塊6 2 3 2被建模,參考的單點地形淨空測量和測量的單點 地形淨空測量之差在TA IMS子濾波模塊6232中進行、濾波處 理,得出慣性導航參數誤差以及慣性傳感器誤差的局部最 優估_計。 G P S接收機1 0的測量信息和慣性導航系統2 〇的慣性導 航參數被一 IN S G P S子渡波器6 2 3_ 3接收,並對之進行遽波處 理,得出慣性導航參數誤差、GPS接收機誤差以及慣性傳 .感器.誤差的另一局部最優估計。 來自TAINS子濾波模塊6232和INSGPS子濾波器6233的 局部最優估計和估計誤差協方差陣被主濾、波器模塊6 2 3 4進 行融合處理,得出慣性導航參數誤差、GPS接收機誤差以 及慣性傳感器誤差的全局最優估計。 收來自主濾波器模塊6234的慣性.導航參數誤差、GPS 接收機誤差以及慣性傳感器誤差的全局最優估計及其估計 誤差協方差陣被TAINS子濾波模塊6 232和INSGPS子濾波器 模塊6233分別接收,以便更新TAINS子濾波器6 2 3 2和 INSGPS子濾波器6233,執行TAINS子濾波模塊6232、 INSGPS手濾波器模塊6233和主濾波器模塊6234之間的信息 分享算法。 為獲得不同的性能,TAINS子濾波模塊6232、INSGPS 子濾波器模塊6 2 3 3和主濾、波器模塊6 2 3 4之間的通信和估計1H 454 09 5 Fifth invention description (40) The measurement is compared with the measured single-point terrain headroom measurement, and the result is rotated out to a TAINS sub-filter module 6 2 3 2. The inertial navigation parameter error and the inertial sensor error are modeled in the TAINS sub-wave module 6 2 3 2. The difference between the reference single-point terrain headroom measurement and the measured single-point terrain headroom measurement is performed and filtered in the TA IMS sub-filter module 6232. Processing, the local optimal estimation of inertial navigation parameter error and inertial sensor error is obtained. The measurement information of the GPS receiver 10 and the inertial navigation system 2 0 are received by an IN SGPS sub-wavelet 6 2 3_ 3 and subjected to wave processing to obtain inertial navigation parameter errors and GPS receiver errors And another local optimal estimate of inertial transmission, sensor, and error. The local optimal estimates and estimated error covariance matrices from the TAINS sub-filter module 6232 and the INSGPS sub-filter 6233 are fused by the main filter and waver module 6 2 3 4 to obtain the inertial navigation parameter error, GPS receiver error, and Global optimal estimation of inertial sensor errors. Receive the inertia from the main filter module 6234. The global optimal estimates of navigation parameter errors, GPS receiver errors, and inertial sensor errors and their estimated error covariance matrices are received by TAINS sub-filter module 6 232 and INSGPS sub-filter module 6233, respectively. In order to update the TAINS sub-filter 6 2 3 2 and the INSGPS sub-filter 6233, the information sharing algorithm between the TAINS sub-filter module 6232, the INSGPS hand filter module 6233 and the main filter module 6234 is executed. In order to obtain different performance, the communication and estimation between the TAINS sub-filter module 6232, the INSGPS sub-filter module 6 2 3 3 and the main filter and wave filter module 6 2 3 4

C:\ProgramFiles\Patent\k322p002.ptd 第 45 頁 4 54 09 5 五、發明說明(41) 方法可以有不同的方法。 T AINS子濾波模塊6 2 3 2、INSGP S子濾波器模塊6 2 3 3和 主濾波器模塊6 2 3 4的估計結果之間的相容性檢驗可由主濾 波器模塊6 234執行,以便檢測和隔離來自有故障的(jps衛 星的信息,並重構導航求解模塊62的結構和處理。 最優的定位導航參數可以通過以下兩種方式得出: 6 (d ) -1在主滤波器模塊623 4中,使用得出的慣性 導航參數誤差最優估計’補償來自慣性導航系統2〇的慣性 導航參數。 6 (d) -2將得出慣性導航參數誤差'GPS接收機誤 差以及慣性傳感器誤差的最優估計由主滤波器模塊6 2 3 4反 饋給慣性導航系統20,以便慣性導航系統2〇對其誤差進行 反饋校正。 (6-3)如第七圖所示,輸入來自導航參數求解模塊62 的最優導航參數、來自地形數據庫5〇的地形數據、來自機 載飛行控制和管理系統9 0的飛機性能和布局數據,計算地 面鄰警信息’進一步包括下列步驟: 來自導航求解模塊62的最優導航.參數被查詢參數計算 模塊6 3 1接收’用來計算地形數據庫5 〇的查詢參數,以便 從地形數據庫50獲得飛行器當前位置和周圍的地形數據。 來自導航求解模塊62的最優導航參數被飛行軌跡預蜊模塊 6 3 2接收和積累’它與來自飛行控制和管理系統9〇的飛行 器性能和布局數據,用以計算預測的飛行器向前飛行的飛 行轨跡,輸出預測的飛行器向前飛行的飛行軌跡以及現在C: \ ProgramFiles \ Patent \ k322p002.ptd Page 45 4 54 09 5 V. Description of the invention (41) There can be different methods. T AINS sub-filtering module 6 2 3 2, INSGP S sub-filtering module 6 2 3 3 and the main filter module 6 2 3 4 The compatibility check between the estimated results can be performed by the main filter module 6 234 in order to detect And isolate the information from the faulty (jps) satellite, and reconstruct the structure and processing of the navigation solution module 62. The optimal positioning navigation parameters can be obtained in the following two ways: 6 (d) -1 in the main filter module In 623 4, the inertial navigation parameter error optimal estimate obtained is used to 'compensate the inertial navigation parameter from the inertial navigation system 20. 6 (d) -2 will obtain the inertial navigation parameter error' GPS receiver error and inertial sensor error The optimal estimate of the feedback is fed back to the inertial navigation system 20 by the main filter module 6 2 3 4 so that the inertial navigation system 20 corrects its error feedback. (6-3) As shown in the seventh figure, the input comes from the navigation parameter solution The optimal navigation parameters of module 62, terrain data from the terrain database 50, aircraft performance and layout data from the on-board flight control and management system 90, and calculation of ground adjacent police information 'further includes the following steps: The optimal navigation from the navigation solution module 62. The parameters are received by the query parameter calculation module 6 3 1 'to calculate the query parameters of the terrain database 50 to obtain the current position of the aircraft and the surrounding terrain data from the terrain database 50. From the navigation solution The optimal navigation parameters of module 62 are received and accumulated by the flight trajectory prediction module 6 3 2 'It is used with the aircraft performance and layout data from the flight control and management system 90 to calculate the predicted flight trajectory of the forward flight of the aircraft , Output the predicted flight trajectory of the aircraft forward and now

CAProgram Files\Patent\k322p002.ptd 第 46 頁CAProgram Files \ Patent \ k322p002.ptd page 46

ά54095 五、發明說明(42) 〜 ~~ 的位f、速度、姿態輪出給告警決策模塊6 33。 j自飛行軌跡預測模塊632的預測 飛行控制和管理系統90的飛行器性能和/仃數軌跡如、來自 和=數據等、來自地形數據庫5行:::滑線 周圍的地形數據,被告警決策模塊6 二1 =位置和 飛行執跡太靠近前面地面,便作出地面二二果,預:的 輸出給飛行軌跡計劃輔助模塊m、 覺^理槿並將之 6 35、/音處理模塊636。此外,現在的位置覺處速^模練 也被輸出給飛行軌跡計劃輔助模塊634。 又妾態 來自告警決桌模塊633的地面鄰警俨自、 哭 =圍來自地形數據庫二 残f•生二和右片據、來自飛行控制和管理系統90的飛r 飛行軌跡計劃辅助模塊634接收Λ 骶仃員计异一最優的防撞回避軌跡。 為 r自來! Π f!模塊633的預測的飛行軌跡和地面鄰、 信息、來自來自地形數據庫50 田衅曰 &quot;&quot;::,;^^&quot; ί ί 回避執跡被合成視覺處理描祕β 撞 70計算其驅動數據 模塊635接收,為合成視覺系統 乂來ΓΠ ί ΐ模塊633的預測的飛行軌跡和地面鄰邀 地形數據、來自飛行軌:㈡=器當前位置和周圍的 回避執跡被語音處理模塊66sj接輔收助1 塊634的最優的防撞 算其驅動數據。 36接收’為語音處理模額6計ά54095 V. Description of the invention (42) The bits f, speed, and attitude of ~~~ are given to the alarm decision module 6 33. The self-flight trajectory prediction module 632 predicts the aircraft performance and / or the number of trajectories of the flight control and management system 90 such as, from, and = data, etc., from the terrain database 5 rows ::: terrain data around the sliding line, which is alerted by the decision module 6 2 1 = The position and flight track are too close to the ground in front, then make the ground 2 2 results, and the output of the pre-: is output to the flight trajectory planning assistance module m, Jue Li, and 6/35, / tone processing module 636. In addition, the current position perception speed training is also output to the flight path planning assistance module 634. Also, the ground neighbors from the alarm decision table module 633 can receive the data from the terrain database, the second and the second data, and the flight path planning assistance module 634 from the flight control and management system 90. Λ The crew calculates an optimal collision avoidance trajectory. Come from r! Π f! Module 633's predicted flight trajectory and ground neighbors, information from the terrain database 50 Tian Jue said: ,, ^^ &quot; ί avoidance track is synthesized visual processing Describing the beta collision 70 calculates its driving data module 635 to receive, the predicted flight trajectory of the synthetic vision system ΓΠ ί ΐ module 633, and the ground adjacent terrain data, from the flight trajectory: the current position of the device and surrounding avoidance The track is used by the voice processing module 66sj to assist and calculate the driving data of the optimal anti-collision block 634. 36 receive ’6 models for voice processing

C:\Program Files\Patent\k322p002. ptd 第 47 頁 4 5 4 09 5 附頁 TCk-H]NS-~h(&amp;, Yk)+ ^ IsC: \ Program Files \ Patent \ k322p002.ptd Page 47 4 5 4 09 5 Attachment TCk-H] NS- ~ h (&amp;, Yk) + ^ Is

C:\ProgramFiies\Patent\k322p002.ptd 第 48 頁C: \ ProgramFiies \ Patent \ k322p002.ptd page 48

Claims (1)

4 5 ZL n Q R4 5 ZL n Q R 88103653 驟 修正 種飛/行器定位和她面鄰警之方法,包含以下步 (a )接收全球定位系統(G P S )信號,進行變化和計 箅,得出位置、速度、時間信息或偽距、偽距率量測,將 k輸出給一組合定位/地面鄰警處理機; (b )接收飛行器的角速率和比力信號,計算慣性導航 #參數,包括位置、速度、姿態等,並將該慣性導航參敦輸 t出給該組合定位/地面鄰警處理機; (c )測量大氣壓力,計算出氣壓高度測量,並將該氣 壓高度測量輸出給該給合定位/地面鄰警處理機; 後 否 M: Μ 原 (d )測量一無線電信號從該飛行器發出時刻和該無線 電信號從地面反射回來時刻之差,將該時間差轉換為一無 1線電高度測量,並將該無線電高度測量輸出給該組合定位 /地面鄰警處理機; (e )查詢一地形數據庫,獲得該飛行器現在位置和.周 圍的地形高度數據,並將該地形高度數據輸出給處理機; (ί )接收該GPS的位置、速度、時間信息或偽距、.偽 距率量測、該慣性導航參數、該無線電高度測量、該氣崖 高度測量、該飛行器現在位置.和厨圍位.置的地形高度數% 據,計算最優的定位和地面鄰警信息者。 2.如申請專利範圍第1項所述之一飛行器定位和地面 鄰警之方法,其中,在第b步驟中,更包含一附加步驟, 即從第f步^接收該慣性導航參數誤差和慣性傳感器誤差的 最優估計,執行一誤差反饋校正處理,以便獲得,更好的性88103653 A method for rapidly modifying the position of the aircraft / traveler and the police near her, including the following steps (a) receiving a Global Positioning System (GPS) signal, performing changes and calculations, and obtaining position, speed, time information or pseudorange Pseudorange rate measurement, output k to a combined positioning / ground adjacent police processor; (b) Receive the angular rate and specific force signal of the aircraft, calculate the inertial navigation # parameters, including position, speed, attitude, etc., and The inertial navigation sensor inputs the output to the combined positioning / ground adjacent police processor; (c) measures the atmospheric pressure, calculates the barometric height measurement, and outputs the barometric height measurement to the combined positioning / ground adjacent police processor; After no M: M original (d) measures the difference between the time when a radio signal is emitted from the aircraft and the time when the radio signal is reflected from the ground, converts the time difference into a radioless height measurement, and outputs the radio height measurement Give the combined positioning / ground adjacent police processor; (e) Query a terrain database to obtain the current position of the aircraft and the surrounding terrain height data, and the terrain height data To the processor; (ί) Receive the GPS position, speed, time information or pseudorange, pseudorange rate measurement, the inertial navigation parameters, the radio altitude measurement, the air cliff height measurement, and the current position of the aircraft. The topographic height data of the kitchen enclosure. Set the optimal positioning and ground neighbor information. 2. The method of aircraft positioning and ground neighbor police as described in item 1 of the scope of patent application, wherein in step b, an additional step is further included, namely receiving the inertial navigation parameter error and inertia from step f ^ Optimal estimation of sensor errors, performing an error feedback correction process in order to obtain better performance 第50頁 454095 __案號88103653_竹年丨丨月曰 修正_ 六、申請專利範圍 能者。 . . . · .. 3.如申諳專利範圍第1項所述之一飛行器定位和地面 鄰警之方法,其中,在第f步驟中,包含以下步驟: (f - 1 )接收該GPS接收機的位置、速度、時間信息或 偽距、偽距率測量、該慣性導航參數、該無線電高度測 量、該氣壓高度測量,談飛行器現在位置和周圍地形高度 數據; (f-2 )使用該GPS接收機的位置、速度、時間信息或 偽距、偽距率測量、該慣性導航參數、該無線電高度測 量、該氣壓高度測量、該飛行器現.在位置和.周_.圍地形_高度 數據,計算最優的導航數據,包括位置,速度,姿態,; (f - 3 )輸入該最優的導航數據、該飛行器現在位置和 周圍地形高度數據、以及來自一機載飛行控制和管理系統 飛行器性能和布局數據,計算出地面鄰警信息者。 4 ..如申請專利範..圍第2 _項所述之一飛行.器定位和地面. 鄰警方法,其中,在第f步驟,包含以下步驟: (f - 1 )接收該GPS接收機的位置、速度、時間信息或 偽距、偽距率測量、該慣性導航參數、該無線電高度測 量、該氣壓高度測量,該飛行器現.在位置和周_圍:地形高度 數據; (f - 2 )使用該GPS接收機的位置、速度、時間信息或 偽距、偽距率測量、該慣性導航參數、該無線電高度測 量、該氣塵高度測量、該飛行器現.在位、置,和周..圍地形高度 數據,計算最優的導航數據,包括位置,速度,姿態;Page 50 454095 __ Case No. 88103653_ Bamboo Year 丨 丨 Monthly Amendment_ VI. Scope of patent application. .... 3. The method of aircraft positioning and ground proximity police as described in item 1 of the patent application scope, wherein in step f, the following steps are included: (f-1) receiving the GPS reception Aircraft position, speed, time information or pseudorange, pseudorange rate measurement, the inertial navigation parameters, the radio altitude measurement, the barometric altitude measurement, talk about the current position of the aircraft and the surrounding terrain altitude data; (f-2) use the GPS Receiver's position, speed, time information or pseudorange, pseudorange rate measurement, the inertial navigation parameters, the radio altitude measurement, the barometric altitude measurement, the aircraft's current position, and the week _. Surrounding terrain _ altitude data, Calculate optimal navigation data, including position, speed, and attitude; (f-3) Enter the optimal navigation data, the aircraft's current position and surrounding terrain altitude data, and aircraft performance from an airborne flight control and management system And layout data, to calculate the ground neighbor police information. 4 .. The method of applying for patents .. One of the two methods described in item 2 _. Aircraft positioning and ground. Adjacent police method, in step f, including the following steps: (f-1) receiving the GPS receiver Position, speed, time information or pseudorange, pseudorange rate measurement, the inertial navigation parameters, the radio altitude measurement, the barometric altitude measurement, the aircraft is now in position and surrounding area: terrain altitude data; (f-2 ) Use the GPS receiver's position, speed, time information or pseudorange, pseudorange rate measurement, the inertial navigation parameters, the radio altitude measurement, the airborne altitude measurement, the aircraft presence, position, and week. . Surrounding terrain height data, calculate optimal navigation data, including position, speed, and attitude; 454095 _案號88103653 )??年ί丨月W日 修正 ___ 六、申請專利'範圍 (f ~ 3 )輸y入該最優、的導航數據、該飛.行器現:在.位置和' 周圍地形高度數據、以及來自一機載飛行控制和管理系統 飛行器性能和布局數據,計算出地面鄰警信息者。 5. 如申請專利範圍第3項所述之一飛行器定位和地面 鄰警方法,其中,在第f- 3步驟,更包含以下步驟: 使用該最優的導航參數,計算該地形高度數據庫的查 詢參數,並將該查詢參數输入該地形數據庫,以便獲得該 現在位.置和周圍位置的地形數據; 使用該最優的導航參數和來自該機載飛行控制和管理 系統飛行器性能和布局參數,計算飛行器前向的飛行執 跡; 使用該飛行器前向的飛行執跡和來自該機載飛行控制 和管理系.統飛行器性能和布局參數,計算和比較,如果該 前向的飛行執跡太鄰近地面,則做出告警信息; I ' ί 接收該得出的告警信息、該現在飛行器的位置.、速 度、姿態、該地形數據庫的飛行器現在位置和周圍地形高 度數據、該機載飛行控制和管理系統飛行器性能和布局參 •數,計算一條最優回避飛行轨跡..者。 6. 如申請專利範圍第4項所述之一飛行器定位和地面 鄰警方法,其中,在第f - 3步驟,更包含以下步驟: 使用該最優的導航參數,計算該地形高度數據庫的查詢參 數,並將該查詢參數輸入該地形數據庫,以便獲得該現在 位置和周圍位置的地形數據; 使用該最優的導航參數和來自該機載飛行控制和管理454095 _ Case No. 88103653) ?? Amended on the Wth day of the month___ Sixth, the scope of the patent application (f ~ 3) Enter y into the optimal navigation data, the flight. Now the traveler: in the 'The surrounding terrain height data, as well as aircraft performance and layout data from an on-board flight control and management system, calculate the ground neighbor information. 5. The aircraft positioning and ground neighboring police method described in item 3 of the scope of the patent application, wherein in step f-3, the method further includes the following steps: using the optimal navigation parameter to calculate the query of the terrain altitude database Parameters, and enter the query parameters into the terrain database in order to obtain the terrain data of the current position and surrounding locations; use the optimal navigation parameters and aircraft performance and layout parameters from the airborne flight control and management system to calculate Forward flight track of the aircraft; Use the forward flight track of the aircraft and from the onboard flight control and management system. Calculate and compare the performance and layout parameters of the aircraft, if the forward flight track is too close to the ground , Then make an alarm message; I 'ί receive the derived alarm information, the position of the current aircraft, speed, attitude, altitude data of the aircraft's current position and surrounding terrain in the terrain database, and the onboard flight control and management system Aircraft performance and layout parameters, calculate an optimal avoidance flight trajectory .. 6. The aircraft positioning and ground neighboring police method as described in item 4 of the scope of the patent application, wherein in step f-3, the method further includes the following steps: Use the optimal navigation parameter to calculate the query of the terrain altitude database Parameters, and enter the query parameters into the terrain database in order to obtain the terrain data of the current location and surrounding locations; use the optimal navigation parameters and from the airborne flight control and management 454095 __ 案號88103653_行年ι|月&gt;〇日 修正 六、申請專利範祖 系統飛行器性能和布局參數,計算飛行器前向的飛行執: 跡; 使用該飛行器前向的飛行軌跡和來自該機載飛行控制 和管理系統飛行器性能和布局參數,計算和比較,如果該 前向的飛行軌跡太鄰近地面,則做出舍警信息; 接收該得出的告警信息、該現在飛行器的位置、速 度、姿態、該地形數據庫的飛行器現在位置和周圍地形高 度數據、該機載飛行控制和管理系統飛行器性能和布局參 數,計算一條最優回避飛行執跡者。 7.如申請申請專利範圍第6項所述之一飛行器定位和 地面鄰警方法,其中第(f -2)步驟包含下列步驟; 輸入來自一無線電高度表的無線電高度測量、來自氣壓高 度表的氣壓高度測量以及來自該地形數據庫的地形數據, I · 給一相關/匹配模塊; 使用收集的該無線電高度測量和氣壓高度測量產生在 指定的時間窗口内的一個測量的地形輪廓線,而收集的來 自該地形數據庫的該地形數據用來產生對惠區域的多個地 形輪廓線,做為參考的地形輪廓線,比較該測量的地形輪 廓線和參考的地形輪廓線,一但確定匹配得最好的地形輪 廓線,則匹配的地形輪廓線的地理位置,被輸入一瀘波/ 估計器; 無線電高度測量與當前飛行器位置的地形高度測量相 加之和,再與慣性高度測量或混合氣壓慣性高度測量相 減,得出一高度測量殘差;454095 __ Case number 88103653_ 行年 ι | Month &gt; 0th Amendment VI. Patent application Fanzu system aircraft performance and layout parameters, calculate the forward flight certificate of the aircraft: track; use the forward flight path of the aircraft and Aircraft flight control and management system aircraft performance and layout parameters, calculation and comparison, if the forward flight trajectory is too close to the ground, make a warning message; receive the resulting warning information, the current aircraft position, speed , Attitude, aircraft's current position and surrounding terrain altitude data of the terrain database, aircraft performance and layout parameters of the on-board flight control and management system, and calculate an optimal avoidance flight tracker. 7. The aircraft positioning and ground proximity police method described in item 6 of the scope of the patent application, wherein step (f-2) includes the following steps: inputting a radio altitude measurement from a radio altimeter, Barometric altitude measurements and terrain data from the terrain database, I · Give a correlation / matching module; use the collected radio altitude measurements and barometric altitude measurements to generate a measured terrain profile within a specified time window, and collect the The terrain data from the terrain database is used to generate multiple terrain contours for the benefit area as reference terrain contours. The measured terrain contours and the reference terrain contours are compared. Terrain contour line, the geographic location of the matched terrain contour line is input into a wave / estimator; the radio altitude measurement and the terrain altitude measurement of the current aircraft position are added together, and then combined with the inertial altitude measurement or mixed air pressure inertial altitude Subtract the measurements to get a height measurement residual; 第53頁 454095 案號 88103653 行年“月日 修正 六、申請專利範圍 由該渡 信息或偽距 形輪廊線的 式進行濾波 誤差.、慣性 將得出 行誤差反饋. 8.如申· 地面鄰警方 輸入來 壓高度表的 據,给一拇 使用收 指_定的時間 自該地形數 形輪靡線’ 廓線和參考 廓線,則匹 地遽波器_ 無線電 加之和、再y 減,得出一 由該TA 地理位置和 波/估計器對讓GP S接收機的位置、速度、時間: ,偽距率量測、該慣性導航參數、該匹配的地 地理位置以及該高度測量殘差以集中處理的方 計算,得出該慣性導航參數誤差、GP S接收機 傳感器誤差的最優估計;_ 的該慣性導航反饋給該慣性導航系統,以便進 校正者。 請申請專利範圍第6項所述之一飛行器定位和 法,其中第(f - 2 )步驟包含以下步驟: 自一無線電高度表的無線電高度測量、來自氣 氣壓高度測量以及來自該地形數據庫的地形數 關/匹配模塊; 集的該無線電高度測量和氣壓高度測量產生在 窗口内的一個測量的地形輪廓線,而收集的來 據庫的該地形數據用來產生對應區域的多個地 做為參考的地形輪廓線,比較該測量的地形輪 的地形輪廓線,一但確定匹配得最好的地形輪 配的地形輪廓的地理位置,被送入一T A I NS本 高度測量與當前飛行器位置的地形高度測量相 與慣性高度測量或混合氣壓慣性高度測量相 高度測量殘差; I N S本地濾波/估計器對該匹配的地形輪廓線的 該高度測量殘差進行濾波處理,獲得局部最優 py-Page 53 454095 Case No. 88103653 Year "Month and Day Amendment Sixth, the scope of patent application is filtered by the information or pseudo-pitch-shaped contour line to filter errors. Inertia will result in line error feedback. 8. Rushen · Ground Neighborhood The police input to press the altimeter data, give the thumb a set time from the topographical figure of the terrain, the profile and the reference profile, then the ground waver _ the radio plus the sum, then y minus, Obtain the position, speed, and time of the GPS receiver and the GPS / wave / estimator pair from the TA location, velocity, time: pseudorange rate measurement, the inertial navigation parameters, the matched geographic location, and the altitude measurement residual Calculated by the method of centralized processing, the optimal estimation of the inertial navigation parameter error and the GPS receiver sensor error is obtained; the inertial navigation of _ is fed back to the inertial navigation system so as to be corrected. Please apply for patent No. 6 One of the aircraft positioning methods, wherein the (f-2) step includes the following steps: a radio altitude measurement from a radio altimeter, an air pressure altitude measurement, and a number from the terrain The terrain number of the database is closed / matched; the set of the radio altitude measurement and the barometric altitude measurement generates a measured terrain contour line in the window, and the collected terrain data from the database is used to generate multiple terrains in the corresponding area. As a reference terrain contour line, the terrain contour line of the measured terrain wheel is compared. Once the geographical position of the terrain profile that matches the best terrain wheel is determined, it is sent to a TAI NS height measurement and the current aircraft position. The height measurement residuals of the terrain height measurement phase and the inertial height measurement or the mixed air pressure inertial height measurement phase; the INS local filter / estimator filters the height measurement residuals of the matched terrain contour line to obtain a local optimal py- 第54頁 ^4 5 4 09 5 修正 案號 88103653 六、申請專利範圍 的慣性導航參數誤差和慣性傳感器誤差的最優估計; 由一 INSGPS本地瀘波器對來自該GPS接收機的位置、 速度、時間或偽距、偽距率量測、該慣性導航參數,進行 濾波處理,得出局部最優的該慣性導航參數誤差、GPS接' 收機誤差、慣性傳感器誤差的另——局部最優估計; 由一主濾波器,接收來自該I NSGPS本地瀘波器的慣性 導航參數誤差、GPS接收機誤差、慣性傳感器誤差的最優 估計及其協方差陣和來自該T A I N S的慣性導航參數誤差和. 慣性傳感器誤差的另一局部最優估計及其及其協方差卩車, 進行渡波計算得出全局最優'估計「 . _ 反饋得出的該慣性導航參數誤差、慣性傳感器誤差、 GPS接收機誤差的全局最優估計到該TAINS本地濾波器和 GP S_I N S本地濾.波.器.,以便重調該T A I N S本.地..濾.波器和該 G P S I N S.本地渡波is ’並執行該主滤波器.’該G P S I N S本地遽 波器和該TA I MS本地濾波器之間的信息分享算法; 調諧該主濾波器、該I N S G P S本地濾波器以及該T A I N S 本地濾波之間的通信和估計模式,以便獲得不同的性能; 對該主濾波器,該GPS I NS本地濾波器和該ΤΑ I NS本地濾波 _器的:狀態估計進行相容性檢驗·,以便檢測和隔離上述G. P S 衛星的失效信號,並重構上述導航解算的結構和流程; 將得出的該慣性導航反饋給該慣性導航系統,以便進行誤 差反饋校正者。 9.如申請申請專利範圍第5項所述之一飛行器定位和 地面鄰警方法,其中第(Γ- 2 )步驟包含以下步驟:Page 54 ^ 4 5 4 09 5 Amendment No. 88103653 VI. Optimal estimation of inertial navigation parameter error and inertial sensor error in the patent application range; An INSGPS local oscilloscope is used to determine the position, speed, Time or pseudo-range, pseudo-range rate measurement, and the inertial navigation parameter are filtered to obtain the local optimal inertial navigation parameter error, GPS receiver 'receiver error, and inertial sensor error. A main filter receives the optimal estimation of the inertial navigation parameter error, GPS receiver error, inertial sensor error and its covariance matrix and the inertial navigation parameter error sum from the TAINS from the NSGPS local waver. Another local optimal estimate of the inertial sensor error and its covariance are used to calculate the global optimal 'estimation' by crossing wave calculation. _ The inertial navigation parameter error, inertial sensor error, GPS receiver error obtained from the feedback Global optimal estimation to the TAINS local filter and the GP S_I NS local filter.wave filter. In order to readjust the TAINS local.filter.wave filter and the GPSIN S. local wave is 'and execute the main filter.' Information sharing algorithm between the GPSINS local waver and the TA I MS local filter; tune the main filter, the INSGPS local filter, and the TAINS Communication and estimation mode between local filters in order to obtain different performance; for the main filter, the GPS I NS local filter and the TA I NS local filter_: state estimation for compatibility check Detect and isolate the failure signal of the above G. PS satellite, and reconstruct the structure and process of the above navigation solution; feedback the inertial navigation obtained to the inertial navigation system for error feedback correction. 9. If applying for an application One of the aircraft positioning and ground neighbor police methods described in the fifth item of the patent scope, wherein the (Γ-2) step includes the following steps: 第55頁 454 09 5 案號 88103653 β年Η月:日 修正 六、申請專利範圍 將來自上述慣性導航系統的慣性導航參數,來自上述 ... . . . · 氣壓高度表的氣壓高度測量,上述無線電高度表的無線電 高度測量,上述地形數所庫的地形數據輸入到一單點地形 淨空計算模塊; 在該地形淨空計算模塊内,單點氣壓高度測量或混合 氣壓慣性高度測量與飛行器現在位置的地形高度相減,得 出一參考的單點地形淨空測量,而將無線電高度測量作為 一實際測量的單點地形淨空測量,將該實際測量的地形淨 空測量與參考的地形淨空測量之差輸出給一瀘波/估計 33. · 由該濾波/估計器對該GPS接收機的位置、速度、時間 信息或偽距,偽距率量測、該慣性導航參數、該實際測量 的地形淨空測量與參考的地形淨空測量之差以集中處理的 方式進行濾波計算,得出該慣性導航參數誤差、GPS接收 機誤差、慣性傳感器誤差的最優估計; 將得出的該慣性導航反饋給該慣性導航系統,以便進 行誤差反饋校正者。 1 0 .如申請申請專利範圍第6項所述之一飛行器定位和 地面鄰警方法,其中第(f - 2 )步驟包含以下步驟: 將來自上述慣性導航系統的慣性導航參數,來自上述 氣壓高度表的氣壓高度測量,上述無線電高度表的無線電 高度測量,上述地形數所庫的地形數據輸入到一單點地形 淨空計算模塊; 在該地形淨空計算模塊内,單點氣壓高度測量或混合Page 55 454 09 5 Case No. 88103653 β Year Leap Month: Day Amendment VI. The scope of the patent application will come from the inertial navigation parameters of the inertial navigation system mentioned above, and from the above ...... The radio altitude measurement of the radio altimeter, the terrain data stored in the above terrain number is input to a single-point terrain headroom calculation module; in this terrain headroom calculation module, the single-point air pressure altitude measurement or mixed air pressure inertial altitude measurement and the current position of the aircraft The terrain height is subtracted to obtain a reference single-point terrain headroom measurement, and the radio altitude measurement is used as an actual measured single-point terrain headroom measurement. The difference between the actual measured terrain headroom measurement and the reference terrain headroom measurement is output to A wave / estimate 33. · The GPS receiver's position, speed, time information or pseudorange, pseudorange rate measurement, the inertial navigation parameter, the actual measured terrain headroom measurement and reference are performed by the filter / estimator. The difference in terrain headroom measurement is filtered in a centralized manner to obtain the inertial navigation parameters. Difference, optimal estimation error GPS receiver, an inertial sensor error; and the derived inertial navigation back to the inertial navigation system, in order to carry out error correction by feedback. 10. The aircraft positioning and ground proximity police method as described in item 6 of the scope of the patent application, wherein the step (f-2) includes the following steps: the inertial navigation parameters from the inertial navigation system are derived from the above-mentioned air pressure altitude The barometric altitude measurement of the meter, the radio altitude measurement of the above radio altimeter, and the terrain data stored in the above terrain number are input to a single-point terrain clearance calculation module; in the terrain clearance calculation module, the single-point pressure altitude measurement or mixed 第56頁 4 54 09 5 修正 案號 88103653 六、申請專利範圍 氣壓慣性高度測量與飛行器現在位置的地形高、度祖減,得 出一參考的單點地形淨空測量,而將無線電高度測量作為 一實際測量的單點地形淨空測量,將該實際測量的地形淨 空測量與參考的地形淨空測量之差輸出給一TAINS本地濾 波器; 由該ΤΑ I NS本地濾波/估計器對該實際測量的地形淨空 測量與參考的地形淨空測量之差進行據波處理,後得局部 最優的慣性導航參數誤差和慣性傳感器誤差的最優估計, 該TAINS本地濾波器是一非線性濾波/估計器或擴展卡爾曼 濾波.器; 由一 INSGPS本地濾波器對來自該GPS接收機的位置、_ 速度、時間或偽距、偽距率量測、讓慣性導航參數,進行 .渡波處理,得出局部最優的該慣性導航參數誤差、GPS, . . . . ... . . . . . ; ·. 收機誤差、慣性像感器誤差的另一局部最優估計; 由一主濾波器,接收來自該I N S G P S本地濾波器的慣性 導航參數誤差、GPS接收機誤差、慣性傳感器誤差的最優 估計及其協方差陣和來自該T A I NS的慣性導航參數誤差和 慣性傳感器誤差的另一局部最優估計及其及其協方差陣, 進行遽波計算得出全局最優估計Λ 反饋得出的該慣性導航參數誤差、慣性傳感器誤差、 GPS接收機誤差的全局最優估計到該TAINS本地渡波器和 GPS I NS本地濾波器,以便重調該T A I NS本地渡波器和該 GPS I NS本地渡波器,並執行該主遽波器’該GPSI NS本地濾 波器和該T A I RS本地濾波器之間的信息分享算法;Page 56 4 54 09 5 Amendment No. 88103653 VI. Patent application scope Air pressure inertia altitude measurement and the terrain height and degree declining of the aircraft's current position, a reference single point terrain headroom measurement is obtained, and radio altitude measurement is used as The actual measured single-point terrain headroom measurement, the difference between the actual measured terrain headroom measurement and the reference terrain headroom measurement is output to a TAINS local filter; the TAA NS local filter / estimator for the actual measured terrain headroom The difference between the measurement and the reference terrain headroom measurement is wave-processed to obtain an optimal estimate of the local optimal inertial navigation parameter error and inertial sensor error. The TAINS local filter is a non-linear filter / estimator or extended Kalman Filter. An INSGPS local filter measures the position, velocity, time or pseudorange, pseudorange, pseudorange rate, and inertial navigation parameters from the GPS receiver. The wavelet processing is performed to obtain a locally optimal Inertial navigation parameter error, GPS,........ Estimation; A main filter receives the optimal estimates of inertial navigation parameter errors, GPS receiver errors, inertial sensor errors from the INSGPS local filter and their covariance matrix and inertial navigation parameter errors and inertia from the TAI NS Another local optimal estimation of the sensor error and its covariance matrix, the global optimal estimate obtained by performing a chirp wave calculation, and the global optimum of the inertial navigation parameter error, inertial sensor error, and GPS receiver error obtained from feedback Estimate the TAINS local waver and GPS I NS local filter to readjust the TAI NS local waver and the GPS I NS local waver, and execute the main chirper 'the GPSI NS local filter and the TAI Information sharing algorithm between RS local filters; 第5T頁 4 5 4 09 5 案號 88103653 β年丨丨月π曰 修正 六、申請專利範圍 瀘波之間的通.信和估計模式,以便獲得不同的性能; 對該主濾波器,讓GPS I NS本地濾波器和該T A I NS本地遽波 器的狀態估計進行相容性檢驗,以便檢測和隔離上述GPS 衛星的失效信號,並重構上述導航解算的結構和流程; 將得出的該慣性導航反饋給該慣性導航系統,以便進行誤 差反馈校正者。 11.如申請專利範圍第1至10項所述之一飛行器定位和 地面鄰警方法,其中在第f步驟中,所述的最優導航參數 包括最優的飛行器位置、速度、加速度和姿態等信息,在 第a步驟中,進一步包含一拊加步驟,即從第Γ步驟接收該 最優導航參數,用來辅助上述GPS接收機的信號捕獲、跟 蹤、再捕獲處理者。 1 2 .如上述申請專利範圍第1至1 0項所述之一飛行器定 位和地面鄰警方法,其中在第f步驟之後進一:步包含一附 加步驟,即接收上述地面鄰警信息、最優導航參數、地形 數據,進行合成視覺處理,以便為飛行員提供一個增強的 視覺顯示者。 1 3 .如申請專利範圍第1 1項中所述之一飛行器定位和 地面鄰警方法,其中在第ί步驟之後進一步包含一附加步 驟,即接收上述地面鄰警信息、最優導航參數、地形數 據,進行合成視覺處理,以便為飛行員提供一個增強的視 覺顯示者。 14.如申請專利範圍第1至10項所述之一飛行器定位和 地面鄰警方法,其t在第f步驟之後進一步包含一附加步Page 5T 4 5 4 09 5 Case No. 88103653 β Years 丨 丨 Month π Amendment Sixth, the patent application scope communication between the wave. Letter and estimation mode in order to obtain different performance; For the main filter, let GPS I The NS local filter and the state estimation of the TAI NS local waver perform a compatibility check in order to detect and isolate the failure signal of the above GPS satellite, and reconstruct the structure and process of the above navigation solution; the inertia to be obtained Navigation feedback is provided to the inertial navigation system for error feedback correction. 11. The aircraft positioning and ground neighboring police method according to one of the items 1 to 10 of the scope of patent application, wherein in step f, the optimal navigation parameters include the optimal aircraft position, speed, acceleration, attitude, etc. The information, in step a, further includes an adding step, that is, receiving the optimal navigation parameter from step Γ to assist the signal acquisition, tracking, and re-acquisition processor of the GPS receiver. 1 2. The aircraft positioning and ground neighbor police method described in one of the items 1 to 10 of the above-mentioned patent application range, wherein one step after step f is further included: the step includes an additional step of receiving the above-mentioned ground neighbor police information, the optimal Navigation parameters, terrain data, and synthetic visual processing are performed to provide pilots with an enhanced visual display. 1 3. The aircraft positioning and ground neighbor police method described in item 11 of the scope of the patent application, which further includes an additional step after the first step, namely receiving the above ground neighbor police information, optimal navigation parameters, terrain Data for synthetic visual processing to provide the pilot with an enhanced visual display. 14. The aircraft positioning and ground neighbor police method according to one of the items 1 to 10 of the scope of patent application, wherein t further includes an additional step after step f. 第58頁 4 5 4 09 5 _案號 88103653 31年)丨月/日__ . 六'、申請專利範圍 驟,即接收上述地面臨警信息,進行語言處理,以便為飛 行員提供聽覺的地面臨警信息者。 1 5 .如申請專利範圍第1 1項中所述之一飛行器定位和 地面鄰警方法,其中在第f步驟之後進一步包含一附加步 驟,即接收上述地面臨警信息,進行語言處理,以便為飛 行員提供聽覺的地面臨警信息者。 1 6 .如申請專利範圍第1 2項所述之一飛行器定位和地 面鄰警方法,其中在第f步驟之後進一步包含一附加步 驟,即接收上述地面臨警信息,進行語言處理,以便為飛 行員提供聽覺的地面臨警信息者。 1 7如申請專利範圍第1 2項所述之一飛行器定位和地面 鄰警方法,其中在第f步驟之後進一步包含一附加步驟, 即接收上述地面臨警信息,進行語言處理,以便為飛行員 :提供聽覺的地面跋警信息者。 18.如申請專利範圍第1至10項所述之一飛行器定位和 丨地面鄰警方法,其中第a步驟進一步包含下列步驟: 通過上述GPS天線接收GPS RF 信號,並將該GPS RF 信號 輸入到一預放大電路; 在該預放大電路中,上述GPS RF 信號被放大,以便 提高其信號噪聲比,並將之输出到一下變頻電路; 在下變頻電路中,將該放大的G PS信號與來自上述振 蕩器的本地參考信號進行混頻,得到GPS中頻信號,包括 模擬的同相(I )和正交(Q)信號,並將該中頻信號送入一 帶通瀘波器;.Page 58 4 5 4 09 5 _ Case No. 88103653 31 years) 丨 month / day __. Sixth, the scope of the patent application, that is, to receive the above-mentioned police information and language processing in order to provide pilots with audible ground Police information. 15. The aircraft positioning and ground neighbor police method as described in item 11 of the scope of the patent application, which further includes an additional step after step f, that is, receiving the above-mentioned facing police information and performing language processing in order to The pilot provided an audible face to a police informer. 16. The aircraft positioning and ground adjacent police method as described in item 12 of the scope of the patent application, which further includes an additional step after step f, that is, receiving the above-mentioned face-to-face police information and performing language processing in order to provide pilots with Provide audible face to police information. 17 According to one of the methods described in item 12 of the scope of the patent application, the aircraft positioning and ground neighboring police method further includes an additional step after step f, that is, receiving the above-mentioned facing police information and performing language processing in order to provide pilots with: Provide audible ground police information. 18. The aircraft positioning and ground adjacent police method described in one of items 1 to 10 of the scope of patent application, wherein step a further includes the following steps: receiving a GPS RF signal through the GPS antenna and inputting the GPS RF signal to A pre-amplification circuit; in the pre-amplification circuit, the GPS RF signal is amplified in order to improve its signal-to-noise ratio and output to the down-conversion circuit; in the down-conversion circuit, the amplified G PS signal The local reference signal of the oscillator is mixed to obtain the GPS intermediate frequency signal, including the analog in-phase (I) and quadrature (Q) signals, and the intermediate frequency signal is sent to a band pass chirp; 第59頁 454095 案號 88103653 年 /丨月/日 修正 六、申請專利範園 在該帶通瀘波器中,該中頻信號中的噪聲被i:除,以 便提高其信號噪聲比,並將之輸出到一中頻采樣和A/ D變 換器; 在該中頻采樣和A/D變換器中,該中頻信號被采樣並 數字化,形成數字I和Q信號,將之輸入到一信號處理器; 在讓信號處理器中,使用上述的I,Q信號,對上述的G P S 信號進行捕獲、、跟蹤處..理,使用來自上.述.紅合定位.和'.地j.面 臨警處理機的最優導航參數,對該信號播獲和跟蹤處理進 行辅助,計算偽距、偽距率測量,提取衛星星歷數據,並 將該偽距,偽距率衛星星歷數據,輸出給一導航處理機; 在該導航處理機中,使用上述之偽距、偽距率測量,以及 衛星星歷數據,計算飛行器位置、速度和時間信息,並將 . .. ... ..... · ... , -. 該飛行器位置、速度和時間:信息或輸入的偽距、偽,距率測: 量輪出給上述.組合定位和地面警處理機,者。 1 9 .如申請專利範圍第1 1項所述之一飛行器定位和地 面鄰警方法,其中第a步驟進一步包含下列步驟: 通過上述GPS天線接收GPS RF 信號,並將該GPS RF 信號 輸入到一預放大電路; 在該預故大電路中,:上述GPSRF 信號被放大,以便 提高其信號噪聲比,並將之輸出到一下變頻電路;在下變 頻電路中,將該放大的GPS信號與來自上述振器的本地 參考信號進行混頻,得到GPS中頻信號,包括模擬的同相 (I )和正交(Q)信號,並將該中頻信號送入一帶通濾波 yPage 59 454095 Case No. 88103653 / / Month / Day Amendment VI. In the band-pass amplifier, the noise in the IF signal is divided by i: in order to improve its signal-to-noise ratio, and Output to an IF sampling and A / D converter; in the IF sampling and A / D converter, the IF signal is sampled and digitized to form digital I and Q signals, which are input to a signal processing In the signal processor, the above I, Q signals are used to capture, track, and manage the above GPS signals. Use the signals from the above description, the red positioning, and the ground. The optimal navigation parameters of the processor assist the signal acquisition and tracking processing, calculate the pseudorange and pseudorange rate measurements, extract satellite ephemeris data, and output the pseudorange and pseudorange rate satellite ephemeris data to A navigation processor; in the navigation processor, the above-mentioned pseudorange, pseudorange rate measurement, and satellite ephemeris data are used to calculate aircraft position, speed, and time information, and ... ...,-. The aircraft's position, speed, and time: information From the pseudo input, pseudo, range rate measurements: a combination of the amount of the positioning wheel and the ground to said alarm handler, who. 19. The aircraft positioning and ground proximity police method as described in item 11 of the scope of patent application, wherein step a further includes the following steps: receiving a GPS RF signal through the GPS antenna and inputting the GPS RF signal to a Pre-amplification circuit; In the pre-amplification circuit, the above GPSRF signal is amplified in order to improve its signal-to-noise ratio and output to the down conversion circuit; in the down conversion circuit, the amplified GPS signal The local reference signal of the mixer is mixed to obtain a GPS intermediate frequency signal, which includes analog in-phase (I) and quadrature (Q) signals, and sends the intermediate frequency signal to a bandpass filter y 第60頁 ^ 454 09 5 _;_案號88103653_fT年丨丨月/曰 修正 _ 六、申請專利範圍 在該帶通濾波器中,該中頻信號中的噪聲被瀘除,以 便提高其信號噪聲比,並將之輸出到一中頻集樣和A/D變 換器; 在該中頻采樣和A/D變換器中,該中頻信號被采樣並 數字化,形成數字I和Q信號,將之輸入到一信號處理器; 在該信號處理器中_,使.用上述的I,Q信號,對上述的G P S 信號進行捕獲、跟蹤處理,使用來自上述組合定位和地面 .臨警處理機的最優導航參數,對該信號捕獲和跟蹤處理進 行辅助,計算偽距、偽距率測量,提取衛星星歷數據,並 將該偽距,偽距率衛星星歷數據.,輸出給一導航處理機; 在該導航處理機中,使用上述之偽距、偽距率測量,以及 衛星星歷數據,計算飛行器位置、速度和時間信息,並將 該飛行器位置、速度和時間信息或輸入的偽距、偽距率測 量輸出給上述.組合定位和地面、臨警處理機者。 I 20 .如申請專利範圍第12項所述之一飛行器定位和地 !面鄰警方法,其中第a步驟進一步包.含下列步驟: 通過上述GPS天線接收GPS RF 信號,並將該GPS RF 信號 輸入到一預放大電路; 在該預放大電路中,上述GPS RF 信號被放’大,以便 提高其信號噪聲比.,並將之輸出到一下變頻電路; 在下變頻電路中,將該放大的GPS信號與來自上述振 蕩器的本地參考信號進行混頻,得到GPS中頻信號,包括 模擬的同袓(I )和正交(Q)信號,並將該中頻信號送入一 帶通濾波器;Page 60 ^ 454 09 5 _; _ Case No. 88103653_fT year 丨 丨 Month / Revision Amendment_6. Patent application scope In this band-pass filter, the noise in the IF signal is eliminated to improve its signal noise Ratio and output it to an IF sampler and A / D converter. In the IF sampler and A / D converter, the IF signal is sampled and digitized to form digital I and Q signals. Input to a signal processor; in the signal processor, use the above I, Q signals to capture and track the above GPS signals, use the combined positioning and ground from the above. Optimize navigation parameters, assist in signal acquisition and tracking processing, calculate pseudorange and pseudorange rate measurements, extract satellite ephemeris data, and output the pseudorange and pseudorange rate satellite ephemeris data to a navigation processor. ; In the navigation processor, use the above-mentioned pseudorange, pseudorange rate measurement, and satellite ephemeris data to calculate the aircraft position, speed, and time information, and the aircraft position, speed and time information, or the input pseudorange, Pseudorange rate measurement The amount of output to the above. Combined positioning and ground, proactive processor. I 20. The method of aircraft positioning and ground contact as described in item 12 of the scope of the patent application, wherein the step a further includes the following steps: receiving the GPS RF signal through the above GPS antenna, and transmitting the GPS RF signal Input to a pre-amplification circuit; in the pre-amplification circuit, the above-mentioned GPS RF signal is amplified so as to improve its signal-to-noise ratio and output to a down-conversion circuit; in a down-conversion circuit, the amplified GPS The signals are mixed with the local reference signal from the above-mentioned oscillator to obtain a GPS intermediate frequency signal, which includes analog isochronous (I) and quadrature (Q) signals, and sends the intermediate frequency signal to a band-pass filter; 454095 案號 88103653 竹年丨I月日 修正 六、申請專利範圍 在該帶通濾波器中,該申頻信號中的噪聲被瀘除,以 便提高其信號噪聲比,並將之輸出到一中頻 &lt;采樣和A / D變 換器; 在該中頻採樣和A / D變換器中,該中頻信號被採樣並 數字化,形成數字I和Q信號,將之輸入到一信號·處理器; 在該信號處理器中,使用上述的I,Q信號,對上述的GPS 信號進行捕獲、跟蹤處理,使用來自上述組合定位和地面 臨警處理機的最優導航參數,對該信號捕獲和跟蹤處理進 行辅助,計算偽距、偽距率測量,提取衛星星歷數據,並 將該偽距,偽距率衛星星歷數據,輸出給一導航處理機;/ 在該導航處理機中,使用上述之偽距、偽距率測量,以及 衛星星歷數據,計算飛行器位置、速度和時間信息,並將 該飛行器位置、速度和時間信息或輸入的偽距、偽距率測 量輸出給上述組合定位和地面V臨警處理機者。 | 2 1 如申請專利範圍第1 4項所述之一飛行器定位和地 面鄰警方法,其中第a步驟進一步包含下列步驟: 通過上述GPS天線接收GPS RF 信號,並將該GPS RF 信號輸入到一預放大電路; 在該預放大電路中,上述GPS RF 信號被放大,以便 提高其信號噪聲比,並將之輸出到一下變頻電路; 在下變頻電路中,將該放大的GPS信號與來自上述振 蕩器的本地參考信號進行混頻,得到GPS中頻信號,包括 模擬的同相(I )和正交(Q )信號,並將該冲頻信號送入一 帶通濾波器;454095 Case No. 88103653 Year of the Bamboo 丨 Issue of Amendment on the 6th of January, the scope of the patent application is in the bandpass filter, the noise in the applied frequency signal is eliminated, in order to improve its signal-to-noise ratio, and output it to an intermediate frequency &lt; Sampling and A / D converter; In the IF sampling and A / D converter, the IF signal is sampled and digitized to form digital I and Q signals, which are input to a signal processor; In the signal processor, the above-mentioned I and Q signals are used to capture and track the GPS signals described above, and the optimal navigation parameters from the combined positioning and ground-facing police processor are used to perform the signal capturing and tracking processing. Assistance, calculate pseudorange and pseudorange rate measurement, extract satellite ephemeris data, and output the pseudorange and pseudorange rate satellite ephemeris data to a navigation processor; / In the navigation processor, use the pseudo Range, pseudorange rate measurement, and satellite ephemeris data, calculate aircraft position, speed, and time information, and output the aircraft position, speed, and time information or the input pseudorange, pseudorange rate measurement to The above-mentioned combination of positioning and ground V Pro Police processor. 2 1 According to one of the methods described in item 14 of the scope of patent application, the method of aircraft positioning and ground proximity alarm, wherein step a further includes the following steps: receiving a GPS RF signal through the GPS antenna, and inputting the GPS RF signal to a A pre-amplification circuit; in the pre-amplification circuit, the GPS RF signal is amplified so as to improve its signal-to-noise ratio and output to a down-conversion circuit; in the down-conversion circuit, the amplified GPS signal Mixing the local reference signals to obtain GPS intermediate frequency signals, including analog in-phase (I) and quadrature (Q) signals, and sending the impulse signals to a band-pass filter; 454 09 5 _案號88103653_年&quot;月》曰 修正_ 々、申請專利範圍 在該帶通濾波器中,該中頻信號中的噪聲被瀘徐,以 便提高其信號嗓聲比,並將之輸出到一中頻采樣和A/D變 換器; 在該中頻采樣和A / D變換器中,該中頻信號被采樣並 數字化,形成數字I和Q信號,將之輸入到一信號處理器; 在該信號處理器中,使用上述的I,Q信號,對上述的GPS 信號進行捕獲、踉蹤處理,使用來自上述組合定位和地面. 〃臨警處理機的最優導航參數,對該信號捕獲和跟蹤處理進 行辅助,計算偽距、偽距率測量,提取衛星星歷數據,並 將該偽距,偽距率衛星星歷數據,輸出給一導航處理機; 在讓導航處理機中,使用上述之偽距、偽距率測量,以及 衛星星歷數據,計算飛行器位置、速度和時間信息,並將 該飛行器位置、速度和時間信息或輸入的偽距、偽距率測 量輸出給上述組合定位和地面^,臨警處理機者。 22.如申請專利範圍第1至1 0項所述之一飛行器定位和 地面鄰’警方法.,其中第b步驟進一步包含下列步驟:: Step b - 1 , 甩一慣性測量組件測量飛行器之角速率和 比力,並將該角速率和比力輸出給一誤差補償模塊; Step b-2. 使用來自上述組合定位和地面、皆警處理機 的慣性傳感器誤差的最優估計.,對上述角速率和比力量測 進行誤差補償; Step b-3 使用上述之補償之後的角速率和來自一地 球和飛行器角速率計算模塊的當地導航坐標系(N系)到慣 性坐樣系(i系)的旋轉角速率,更新一從機體系(b系)導'454 09 5 _Case No. 88103653_Year &quot; Month Amendment Output to an IF sampling and A / D converter; in the IF sampling and A / D converter, the IF signal is sampled and digitized to form digital I and Q signals, which are input to a signal processing In the signal processor, the above I, Q signals are used to capture and track the above GPS signals, and the combined positioning and ground from the above are used. Signal capture and tracking processing are assisted to calculate pseudorange and pseudorange rate measurement, extract satellite ephemeris data, and output the pseudorange and pseudorange rate satellite ephemeris data to a navigation processor; in the navigation processor , Using the above pseudorange, pseudorange rate measurement, and satellite ephemeris data, calculate aircraft position, speed, and time information, and output the aircraft position, velocity, and time information or the input pseudorange, pseudorange rate measurement to And positioning said ground composition ^ Pro processor by police. 22. The aircraft positioning and ground neighbor alarm method as described in one of the items 1 to 10 of the scope of the patent application, wherein step b further includes the following steps: Step b-1, measuring the angle of the aircraft by throwing an inertial measurement component Velocity and specific force, and output the angular velocity and specific force to an error compensation module; Step b-2. Use the optimal estimation of the inertial sensor error from the above-mentioned combined positioning and ground, all police processors. Speed and specific force measurement to perform error compensation; Step b-3 Use the angular rate after the above compensation and the local navigation coordinate system (N system) to the inertial sitting system (i system) from the Earth and aircraft angular rate calculation module. Rotation angular rate, update a slave system (b system) guide ' 第63頁 454095 _案號88103653_行年U月π曰 修正__ 六、申請專利範圍 當地導航坐標系的變換矩陣,使用來自上述組合定:位和地 面f警處理機的飛行器姿態誤差的最優估計,對談變換矩 陣的誤差進行補償,將該經誤差補償之後的變換矩陣輸出 给一坐標變揍計算模塊和一位置速度姿態計算模塊; '使用上述變換矩陣將上述經誤差補償之後的、表達在 機體坐標系中的比力量測,轉換為表達在導航坐標系中的 比力量測,並將之輸出給上述位置速度計算模塊; 使用上述表達在導航坐樣系中的比力量測,計算飛行 器之位置、速度、並用來自來自上述組合定位和地面(g)警 處理機的飛行器的位置誤差和速度誤差的最優估計,對該 位置、速度進行誤差補償,從上述變換矩陣中,提取姿態 信息,將得出的該位置、速度、姿態輸出給上述組合定位 和地面臨警處理機,· 使用上述所得的位·置、速度、姿態,計算從該當地導 航坐標系(N系)到慣性坐標系(i系)的旋轉向量,並將之輸 出.給第b_3步驟者。 2 3 .如申請專利範圍第1 1項所述之一飛行器定位和地 面鄰警方法,其中第b步驟進一步包含下列步驟: Step b-1. 用一慣性測量組件測量飛行器之角速率和 比力,並將該角速率和比力輸出給一誤差補償模塊; Step b-2. 使用來自上述組合定位和地面、臨警處理機 的慣性傳感器誤差的最優估計,對上述角速率和比力量測 進行誤差補償.; S t ep b -3 使用上述之補償之後的角速率和來自一地Page 63 454095 _ Case No. 88103653 _ Correction of the year U / month __ VI. The transformation matrix of the patent application range for the local navigation coordinate system, using the combination from the above: positioning and ground aircraft f Optimal estimation, compensating for the errors of the transformation matrix, and outputting the transformation matrix after the error compensation to a coordinate transformation calculation module and a position velocity and attitude calculation module; 'using the transformation matrix described above, The specific force measurement expressed in the body coordinate system is converted into the specific force measurement expressed in the navigation coordinate system and output to the above-mentioned position velocity calculation module; using the specific force measurement expressed in the navigation sitting sample system, the calculation is performed. The position and speed of the aircraft, combined with the optimal estimation of the position and speed errors from the aircraft from the combined positioning and ground (g) police processor, perform error compensation on the position and speed, and extract the attitude from the transformation matrix. Information, and output the obtained position, speed, and attitude to the above-mentioned combined positioning and ground facing police processor · If the resulting bit-position, speed, attitude, the rotation vector is calculated from the local navigation coordinate system (N lines) to the inertial coordinate system (i line), and outputs it. B_3 step to the first person. 2 3. The aircraft positioning and ground proximity police method as described in item 11 of the scope of patent application, wherein step b further includes the following steps: Step b-1. Measure the angular velocity and specific force of the aircraft with an inertial measurement unit And output the angular rate and specific force to an error compensation module; Step b-2. Using the above-mentioned optimal estimation of the inertial sensor error of the combined positioning and ground and proximity processor, measure the above angular rate and specific force Perform error compensation; S t ep b -3 use the angular rate and 第64頁 4 54 09 5 _案號88103653 Θ年I丨月日 修正 __ .六、申請專利範圍 球和飛行器角速率計算模塊的當地導航坐橡系(Ν系)到慣 性坐標系(i系)的旋轉角速率,更新一從機體系(b系)(0 當地導航坐標系的變換矩陣,使用來自上述組合定位和地 面臨警處理機的飛行器姿態誤差的最優估計,對該變換矩 陣的誤差進行補償,將該經誤差補償之後的變換矩陣輸出 給一坐標變換計算模塊和一位置速度姿態計算模塊; 使用上述變換矩陣將上述經誤差補償之後的、表達在 機體坐標系中的比力量測,轉換為表達在導航坐標系中的 比力量測,並將之輸出給上述位置速度計算模塊; 使用上述表達在導航坐標系中的比力量測,計算飛行 器之位置、速度、並用来自來自上..述.組合.定位.和地面臨_警· 處理.機的飛行器的位黑誤差和速度誤差的最優估計,對該 位置、速度進行誤差補償,從上述變換矩陣中,提取姿態 信息,將得出的該位置、速度、姿態輸出給上述組合定位 和地面:臨警處理機; ' 使用上述所得的位置、速度、姿態,計算從該當地導 航坐標系U系)到慣炸坐標系(i系)的旋轉向量,並將之輸 出給第b _ 3步驟者。 2 4 ·如申請專利範.圍第1 2項·所述之一飛.行器定位和.地 面鄰警方法’其中第b步驟進一步包含下列步驟: S t e.p b _ 1 .用一慣性測量組件測量飛行器之角速率和 比力,並將該角遠率和比力輸出給一誤差補償模塊; Step b-2 . 使甩來自上述組合定位和地面1赛)警處理機 的慣性傳感器誤差的最優估計,對上述角速率和比力量測Page 64 4 54 09 5 _ Case No. 88103653 Year I 丨 Month Day Amendment __. VI. Application for Patent Range Ball and Aircraft Angular Rate Calculation Module Local Navigation Sitting in the Rubber System (N System) to the Inertial Coordinate System (i System) ), And update a slave system (series b) (0 local navigation coordinate system transformation matrix, using the optimal estimation of the aircraft attitude error from the combined positioning and ground facing police processor, The error is compensated, and the transformation matrix after the error compensation is output to a coordinate transformation calculation module and a position velocity and attitude calculation module; the above-mentioned transformation matrix is used to measure the specific force expressed in the body coordinate system after the above error compensation. , Converted into the specific force measurement expressed in the navigation coordinate system, and output it to the above position and speed calculation module; using the specific force measurement expressed in the navigation coordinate system, calculate the position, speed of the aircraft, and use from above. .Combination.Positioning and ground facing_Alarm · Processing. Optimal estimation of bit black error and speed error of aircraft The speed is compensated for error, and the attitude information is extracted from the transformation matrix, and the obtained position, speed, and attitude are output to the above-mentioned combined positioning and ground: Provincial Police Processor; 'using the obtained position, speed, and attitude to calculate The rotation vector from the local navigation coordinate system (U system) to the inertial coordinate system (i system), and output it to the b_3 step person. 2 4 · As described in the patent application. No. 12 · One of the methods described above. The positioning of the traveler and the ground adjacent police method 'where step b further includes the following steps: S t ep b _ 1. Use an inertial measurement The component measures the angular rate and specific force of the aircraft, and outputs the angular rate and specific force to an error compensation module; Step b-2. Make the rejection of the inertial sensor of the police processor from the above-mentioned combined positioning and ground 1). The best estimate is to measure the above angular rate and specific force 第65頁 454 09 5 __案號 88103653_^兮年 // 月 曰__ 六、申請專利範圍 進行誤差補償; S t e p b - 3 使用上述之補償之後的角速率和來自一地 球和飛行器角速率計算模塊的當地導航坐標系(N系)到慣 性坐標系(i系)的旋轉角速率,更新一從機體系(b系)導 當地導航坐標系的變換矩陣,使用來自上述組合定位和地 面臨警處理機的飛行器姿態誤差的最優估計,對該變換矩 陣的誤差進行補償,將該經誤差補償之後的變換矩陣输出 給一坐標變換計算模塊和一位置速度姿態計算模塊; 使用上述變換矩陣將上述經誤差捕償之後的、表達在 機體坐標系中的比力量測,轉換為表達在導航坐樣系中的 比力量測,'並將之輸出給上述位置速度計算模塊; 使用上述表達在導航坐標系中的比力量測,計算飛行 器之位置、速度、並用來自來自上述組合定位和地面噶警 處理機的飛行器的位置誤差和速度誤差的最優估計,對該 位置、速度進行誤差補償,從上述變換矩陣中,提取姿態 信息,將得出的該位置、速度、姿態輸出給上述組合定位 I |和地面臨警處理機; 使用上述所得的位置、速度、姿態,計算從該當地導 航坐標系(N系)到慣性坐樣系(i系)的旋轉向量,並將之輸 出給第b_3步驟者。 . ' 2 5 .如申請專利範圍第1 4項所述之一飛.行:器、定位和.地 面鄰警方法,其中第b步驟進一步包含下列步驟:: S t ep b _ 1 . 用一慣性測量組件測量飛行器之角速岸和 比力,並將該角速率和比力輪出給一誤差補償模塊;Page 65 454 09 5 __Case No. 88103653_ ^ 西 年 // 月 月 __ VI. Patent application scope for error compensation; S tepb-3 uses the above-mentioned compensation for the angular rate and the angular rate from an earth and an aircraft to calculate The rotation angular rate of the module's local navigation coordinate system (N system) to the inertial coordinate system (i system), update a transformation matrix of the slave system (system b) to guide the local navigation coordinate system, and use the combined positioning and ground facing police from the above. Optimal estimation of aircraft attitude error of the processor, compensating for the error of the transformation matrix, and outputting the error-compensated transformation matrix to a coordinate transformation calculation module and a position velocity attitude calculation module; using the transformation matrix described above, The specific force measurement expressed in the body coordinate system after error compensation is converted into the specific force measurement expressed in the navigation sitting sample system, and is output to the above-mentioned position velocity calculation module; using the above expression in the navigation coordinates The specific force measurement in the system calculates the position and speed of the aircraft, and uses the combined positioning and processing from the ground police. The optimal estimation of the position error and speed error of the aircraft, and the position and speed error compensation is performed. The attitude information is extracted from the above transformation matrix, and the obtained position, speed and attitude are output to the combined positioning I and Ground facing police processor; using the position, speed, and attitude obtained above, calculate the rotation vector from the local navigation coordinate system (N system) to the inertial sitting system (i system), and output it to the person in step b_3. '2 5. Flying according to one of the fourteenth in the scope of the patent application: vehicle, positioning and ground adjacent police method, wherein step b further includes the following steps: S t ep b _ 1. Use a The inertial measurement component measures the angular velocity shore and specific force of the aircraft, and outputs the angular rate and specific force to an error compensation module; 第66頁 454 09 5 案號88103653 年//月夕日 修正 I 1 —~ ~ 六、申請專利範圍 Step b-2. 使用來自上述組合定位和地面臨)警處理機 的y慣性傳感器誤差的最優估1計,對上述.角速率和比.力量測 進行誤差複償; Step b-3 使用上述之補償之後的角速率和來自一地 球和飛行器角速率計算模塊的當地導航坐標系(N系)到慣 性坐標系(i系)的旋轉角速率,更新一從機體系(b系)導 當地導航坐標系的變換矩陣,使用來自上述組合定位和地 面、臨警處理機的飛行器姿態誤差的最優估計,對該變換.矩 !陣的誤差進行補償,將該經誤差補償之後的變換矩陣輸出 i給一坐標變換計算模塊和一位置速度姿態計算模塊; ! 使用上述變換矩陣將上述經誤差補償之後的、表達在 i機體坐標系中的比力量測,轉換為表達在導航坐標系中的 I比力量測,並將之輸出給上述位置速度計算模塊; : .使用上述表達在導航坐標系中的比.力量測,計算.飛行 ;器之位置、速度、並用來自來自上述組合定位和地面i臨!警 「處理機的飛行器的位置誤差和速度誤差的最優估計,對該i .位置、速度進行誤差補償,從上述變換矩陣中,提取姿態j 卜信息,將得出的該位置、速度、姿態輸出給上述組合定位 和地面臨警處理機; 使用上述所得的位置、速度、姿態,計算從該當地導I 航坐標系(N系)到慣性坐標系(i系)的旋轉向量,並將之輸 出給第b-3步驟者。 2 6 ..如申_請專利範圍_第1 8項所述之一飛行器定_位和地_ 面鄰警方法,其中第b步驟進一步包含下列步驟: 4 5 4 09 5 ^_案號88103653 ”年//月&gt;〇日 修正 ______ 六、申請專利範81 Step b - 1 . 用一慣_性測量組件測量飛行器:之角.速率和: 比力,並將該角速率和比力輸出給一誤差補償模塊; Step b-2 . 使用來自上述組合定位和地面臨)警處理機 的慣性傳感器誤差的最優估計,對上述角速率和比力量測 進行誤差補償; S t e p b - 3 使用上述之補償之後的角速率和來自一地 球和飛行器角速率計算模塊的當地導航坐標系(N系)到慣 性坐標系(i系)的旋轉角速率,更新一從機體系(13系)導 當地導航坐標系的變換矩陣,使用來自上述組合定位和地 面臨警處理機的飛行器姿態誤差的最優估計,對該變換矩 陣的誤差進行補償,將該經誤差補償之後的變換矩陣輸出 給一坐標變換計算模塊和一位置速度姿態計算模塊; 使用上述變換矩陣將上述經誤差捕償之.後的、表.達在 機體坐標系中的比力量測,轉換為表達在導航坐標系中的 比力量測’並將之輸出給上述位置速度計算模塊;= 使用上述表達在導航坐標系中的比力量測,計算飛行 器之位置、速度、並用來自來自上述組合定位和地面與〉警 處理機的飛行器的位置誤差和速度誤差的最優估計,對該 位置、速度進行誤差補償,從上述變換矩陣中,提取姿態. 信息,將得出的該位置、速度、姿態輸出給上述組合定位 和地面哮警處理機; ..使用上述所得的位置、速度、姿態,計算從該當地導 航坐標系(N系)到慣性坐標系(i系)的旋轉向量,並將之輸 出給第b-3步驟者。Page Docket No. 66454095 88103653 amended on the eve of Day // I 1 -. ~ ~ VI patent range Step b-2 used in combination from the positioning and faced) y police processors optimal inertial sensor errors Make an estimate and perform error compensation for the above angular velocity and ratio. Force measurement; Step b-3 Use the angular rate after the above compensation and the local navigation coordinate system (N system) from an earth and aircraft angular rate calculation module. The rotation angular rate to the inertial coordinate system (i system), update a transformation matrix of the slave system (b system) to the local navigation coordinate system, and use the optimal positioning attitude error of the aircraft from the above combined positioning and ground and police processors It is estimated that the error of the transform.moment! Matrix is compensated, and the transformed matrix after the error compensation is output to a coordinate transformation calculation module and a position velocity and attitude calculation module;! The specific force measurement expressed in the i-body coordinate system is converted to the specific force measurement expressed in the navigation coordinate system and output to the above-mentioned position velocity calculation mode. Block:: Using the above expressions in the navigation coordinate system. Force measurement, calculation, flight; position, speed of the aircraft, and the position error and speed of the aircraft from the combined positioning and ground pro! The optimal estimation of the error, the error compensation is performed on the i. Position and speed, and the attitude j is extracted from the above transformation matrix, and the obtained position, speed, and attitude are output to the above-mentioned combined positioning and facing police processor. Calculate the rotation vector from the local navigation coordinate system (N system) to the inertial coordinate system (i system) using the position, velocity, and attitude obtained above, and output it to step b-3. 2 6 .. As claimed _ please patent scope _ one of the aircraft positioning _ position and ground _ surface neighbor police method described in item 18, wherein step b further includes the following steps: 4 5 4 09 5 ^ _ Case No. 88103653 "year // Month &gt; 〇 Amendment ______ VI. Patent Application 81 Step b-1. Use an inertia measurement component to measure the aircraft: the angle, the velocity and the specific force, and output the angular velocity and the specific force to An error compensation module; Step b-2. From the above-mentioned combined positioning and ground facing) the optimal estimation of the inertial sensor error of the police processor, error compensation for the above-mentioned angular rate and specific force measurement; S tepb-3 using the above-mentioned compensated angular rate and from an earth and an aircraft The rotation angular rate of the local navigation coordinate system (N system) to the inertial coordinate system (i system) of the angular rate calculation module is used to update a transformation matrix of the slave system (13 system) to the local navigation coordinate system. The optimal estimation of the attitude error of the aircraft facing the police processor, the error of the transformation matrix is compensated, and the transformation matrix after the error compensation is output to a coordinate transformation calculation module and a position velocity attitude calculation module; using the above transformation The matrix converts the above-mentioned specific force measurement in the coordinate system of the body after the error is compensated into a specific force measurement expressed in the navigation coordinate system and outputs it to the above-mentioned position and speed calculation module; = Use the specific force measurement in the navigation coordinate system to calculate the position and speed of the aircraft, and use the The combined positioning and ground and the optimal estimation of the position error and speed error of the aircraft of the police processor, error compensation is performed on the position and speed, and the attitude is extracted from the above transformation matrix. The position, The speed and attitude are output to the above-mentioned combined positioning and ground alarm processor; .. using the position, speed, and attitude obtained above to calculate the rotation vector from the local navigation coordinate system (N system) to the inertial coordinate system (i system), And output it to step b-3. 454 09 5 _案號 88103653_年 / / 月 &gt; 曰___ 六、、申請專利範圍 2 7.如申請專利範圍第1至1 0項所述之一飛行器定位和 地面鄰警方法,其中第3步驟中,上述大氣壓力,是由一 氣壓高度表測量,並被轉換成氣壓高度測量,該氣壓高度 測量被輸出給上述組合定位和地面鄰警處理機者。 28. 如申請專利範圍第2 6項所述之一飛行器定位和地 面鄰警方法,其中第3步驟中,上述大氣壓力,是由一氣 壓高度表測量,並被轉換成氣壓高度測量,該氣壓高度測 量被輸出給上述組合定位和地面鄰警處理機者。 29. 如申請專利範圍第1至1 0項所述之一飛行器定位 和地面鄰警方法,其中第4步驟中,由一無線電高度表發 出的無線電信號,經地面反射再被該無線電高度表接收, 並測出發出和接收時刻之延時,該延時被轉換成無線電高 度測量,該無線電高度測量被輸出給上述組合定位和地面 鄰警處理機者。 30. 如申請專利範圍第2 6項所述之一飛行器定位和地 面鄰警方法,其中第4步驟中,由一無線電高度表發出的 無線電信號,經地面反射再被該無線電高度表接收,並測 出發出和接收時刻之延時,該延時被轉換成無線電高度測 量,該無線電高度測量被輸出給上述組合定位和地面鄰警 處理機者。 3 1 . —種飛行器定位和地面鄰警系統,包含以下部 件: 一 GPS接收機,接收GPS信號,變該GPS信號,計算得 出位置、速度、時間信息和偽距、偽距率測量;454 09 5 _ Case No. 88103653_ Year // Month &gt; Name ___ 6. Application for patent scope 2 7. Aircraft positioning and ground neighbor police method according to one of the patent application scope items 1 to 10, where In 3 steps, the atmospheric pressure is measured by a barometric altimeter and converted into a barometric altitude measurement, and the barometric altitude measurement is output to the above-mentioned combined positioning and ground adjacent police processor. 28. An aircraft positioning and ground proximity alarm method as described in item 26 of the scope of the patent application, wherein in the third step, the above atmospheric pressure is measured by a barometric altimeter and converted into a barometric altimeter. The altitude measurement is output to the above-mentioned combined positioning and ground proximity handler. 29. An aircraft positioning and ground proximity alarm method as described in items 1 to 10 of the scope of patent application, wherein in the fourth step, a radio signal emitted by a radio altimeter is reflected by the ground and then received by the radio altimeter , And measure the time delay of sending and receiving time, the delay is converted into a radio altitude measurement, and the radio altitude measurement is output to the above-mentioned combined positioning and ground adjacent police processor. 30. An aircraft positioning and ground proximity alarm method as described in item 26 of the scope of the patent application, wherein in the fourth step, a radio signal emitted by a radio altimeter is reflected by the ground and then received by the radio altimeter, and The time delay between sending and receiving time is measured, and the delay is converted into a radio altitude measurement, which is output to the above-mentioned combined positioning and ground adjacent police processor. 3 1. An aircraft positioning and ground proximity police system, including the following components: a GPS receiver, receives GPS signals, changes the GPS signals, and calculates position, speed, time information, and pseudorange and pseudorange rate measurements; 第69頁 454 09 5 案號 88103653 牙?年1/月χ»日 修正 六、申請專利範圍 一慣性導航系統,使用來自慣性測量組件的角速率和 比力信號,求解慣性導航方程,得出慣性導航參數; 一氣壓高度表,提供氣壓高度測量; 一無線電高度表,提供離地面的無線電高度測量; ——地形數據庫,提供飛行器現在位置和同圍地形的高 度數據; 一組合定位和地面臨警處理機,接收上述GPS接收機 的位置、速度、時間信息和偽距.、偽距率測量,該慣.性導 航慣性導航參數,來自該氣壓高度表的氣壓高度測量、來 自該無線電高度表無線電高度測量、來自該地形數據庫的 飛行器現在位置和周圍地形的高度數據以及來自一機載飛 行控制和管理系統的飛行器性能和參數,計算最優的位 置_、..速_度..、姿態等、.導.航信.息和最優地.面/臨_警處_理.者。 3 2.如申請專利範圍第31項所述之一飛行器定位和地 面鄰警系統,其中,談地形數據庫是一裝在該飛行器上的 地形數據庫者。 .3 3 .如申_請專利範圍.第3 1項所述.之一飛行器定位和地 面鄰警系統,其中,該地形數據庫是一裝在地面的地形數 據庫,該飛行器上可通過一數據鏈訪問該地形數據庫者。 - ......... 34.如申請專利範圍第3 1項所述之一飛行器定位和地 面鄰警系統,其中,該定位和地面鄰警系統處理機進一步 包括. 一輸入輸出模塊管理與上述其他器件和上述機載飛行 控制和管理系統的數據輸入和輸出;Page 69 454 09 5 Case No. 88103653 Tooth? Year 1 / Month χ »Day 6. Application for Patent Scope-An inertial navigation system, which uses the angular rate and specific force signals from the inertial measurement component to solve the inertial navigation equations to obtain the inertial navigation parameters; a barometric altimeter, which provides barometric altitude Survey; a radio altimeter that provides radio altitude measurements from the ground;-a terrain database that provides the aircraft's current location and altitude data of the surrounding terrain; a combined positioning and ground facing police processor that receives the GPS receiver's position, Speed, time information and pseudorange., Pseudorange rate measurement, the inertial navigation inertial navigation parameters, barometric altitude measurement from the barometric altimeter, radio altimetry measurement from the radio altimeter, current position of the aircraft from the terrain database And altitude data of the surrounding terrain, as well as aircraft performance and parameters from an on-board flight control and management system, calculate the optimal position _, .. speed _ degree, attitude, etc., navigation, navigation information, and optimal Ground. Surface / Pro_Police Department_Management. 3 2. The aircraft positioning and ground adjacent police system described in item 31 of the scope of patent application, wherein the terrain database is a terrain database installed on the aircraft. .3 3 As described in the patent application. Item 31. One of the aircraft positioning and ground adjacent police system, wherein the terrain database is a terrain database installed on the ground, and a data link can be passed on the aircraft. Access to the terrain database. -... 34. The aircraft positioning and ground adjacent police system described in item 31 of the scope of patent application, wherein the positioning and ground adjacent police system processor further includes an input-output module Manage data input and output with the other devices mentioned above and the on-board flight control and management system; 第70頁 4 54 09 5 案號88103653 ??年//月&gt;〇日 修正Page 70 4 54 09 5 Case No. 88103653 ?? year // month &gt; 〇 4 54 09 5 _案號88103653_0年7/月&gt;〇日 修正 __ i六、申請專利範圍 , 該飛行軌跡計劃辅助模塊接收來自該告警決策模塊盹 近地防撞告警信息和該飛行器現在的位置、速度、姿態、 來自該地形數據庫的飛行器當前位置和周圍的地形數據、 來自該飛行控制和管理系統的飛行器性能和布局數據,為 飛行員.計算一最優的防撞回避執跡者。 I 36.如申請專利範圍第3 5項所述之一飛行器定位和地 i |面鄰警系統,其中,一合成視覺系統與該組合定位及地面 |鄰警處理機祖連,用以給飛行員提供地面鄰警信息的視覺 丨顯示,一合成視覺處理模塊與該告警決策模塊、該地形 i數據庫、該飛行軌跡計劃輔助模塊相連為該合成視覺系統 :提供驅動數據者。 37.如申請專利範圍第35項所述之一飛行器定位和地 l·面鄰警系統,其中,一語音系統與該組合定位及地面鄰警 處理機相連,用以給飛行員提供地面鄰警信息的聽覺信 息,一語音處理模塊與該告警決策模塊、該地形數據 庫、該飛行執跡計劃辅助模塊相連為該語音.系統提供驅動 i數據者。 | 38.如申請專利範圍第3 1至37項所述之一飛行器定位 l·和地面鄰警系統,其中,該GPS接收機、該慣性導航系 統、該氣壓高度表、該無線電高度表、該地形數據庫、該 組合定位及近地防撞告警處理機、該合成視覺系統、該語 音系統以及該飛行控制和管理系統之間的連接方式是基於4 54 09 5 _Case No. 88103653_0 July / Month &gt; 0 Day Amendment __ i. For the scope of patent application, the flight trajectory planning assistance module receives the near-ground collision warning information from the alarm decision module and the current Position, speed, attitude, the current position of the aircraft from the terrain database and surrounding terrain data, aircraft performance and layout data from the flight control and management system, calculate an optimal collision avoidance tracker for the pilot. I 36. The aircraft positioning and ground i as described in item 35 of the scope of the patent application | surface adjacent police system, wherein a composite vision system and the combined positioning and ground | adjacent police processor are connected for the pilot Provides visual display of neighboring ground police information. A synthetic vision processing module is connected to the alarm decision module, the terrain i database, and the flight trajectory planning assistance module for the synthetic vision system: those who provide driving data. 37. One of the aircraft positioning and ground l. Neighbor police systems described in item 35 of the scope of the patent application, wherein a voice system is connected to the combined positioning and ground neighbor police processor to provide pilots with ground neighbor police information Auditory information, a voice processing module is connected to the alert decision module, the terrain database, and the flight track plan assistance module to provide the driver with data for the voice. System. 38. According to one of the items 31 to 37 in the scope of the patent application, the aircraft positioning system 1 and the ground adjacent police system, wherein the GPS receiver, the inertial navigation system, the barometric altimeter, the radio altimeter, the The connection methods between the terrain database, the combined positioning and near-earth collision warning processor, the synthetic vision system, the voice system, and the flight control and management system are based on 第72頁 4 54 09 5 案號88103653 年//月^日 修正Page 72 4 54 09 5 Case No. 88103653 yyyy / mm ^ dd Amendment 第73頁 4 54 09 5 年;/月y曰 修正 _案號 881Q3653 六、申請專利範圍Page 73 4 54 09 5 years; / month y Amendment _Case No. 881Q3653 6. Scope of patent application 氣壓高度測量、來自該地形數據庫的地形數據,使用收集 到的談無線電高度測量和該氣壓高度測量,在一給定的時 間窗口内,創建一個測量的地^形包絡,使用該地形數據庫 的地形數據,形成多個參考的地形包絡,比較該測量的 地形包絡和該參考地形包絡,輸出匹配的地形包絡的地理 位置給一T A I N S本地濾波模塊; 該相關/匹配模塊將該無線電高度測量與該地形高度 相加,並與慣性高度或混合氣壓慣性高度相比較,形成高 度殘差,將之輸出給該T A I N S本地濾波模塊; 該T A I NS子遽波模塊對該慣性導航參數誤差及慣性傳 感器誤差建模,對該匹配的地形包絡的地理位置和該高度 殘差進行濾波處理,得出該慣性導航參數誤差以及慣性傳 感器誤差的局部最優估計; 一 I NSGPS子濾波器接收該GPS接收機的測量信息和該 慣性導航系統的慣性導航參數,並對之進行濾波處理,得 出該慣性導航參數誤差、GPS 接收機誤差以及慣性傳感器 誤差的另一局部最優估計; 一主濾波器模塊融合來自該T A I N S子濾波模塊和該 INSGPS子濾波器的局部最優估計和估計誤差協方差陣,得 出該慣性導航參數誤差、GPS 接收機誤差以及慣性傳感器 .誤差.的全局最優估計、; 該TAINS子濾波模塊和該INSGPS子濾波器模塊分別接 收來自該主濾波器模塊的慣性導航參數誤差、GPS 接收機 誤差以及慣性傳感器誤差的全局最優估計及其估計誤差協Barometric altitude measurement, terrain data from the terrain database, using the collected radio altitude measurements and the barometric altitude measurement to create a surveyed terrain envelope within a given time window, using the terrain database's terrain Data to form multiple reference terrain envelopes, compare the measured terrain envelope with the reference terrain envelope, and output the geographic location of the matched terrain envelope to a TAINS local filtering module; the correlation / matching module associates the radio altitude measurement with the terrain The heights are added and compared with the inertial altitude or mixed air pressure inertial altitude to form a height residual and output it to the TAINS local filtering module; the TAI NS sub-wave module models the inertial navigation parameter error and the inertial sensor error , Performing filtering processing on the geographical position of the matched terrain envelope and the height residual to obtain a local optimal estimate of the inertial navigation parameter error and the inertial sensor error; an NSGPS sub-filter receives measurement information from the GPS receiver And the inertial navigation parameters of the inertial navigation system, and Perform a filtering process to obtain another local optimal estimate of the inertial navigation parameter error, GPS receiver error, and inertial sensor error; a main filter module fuses the local optimum from the TAINS sub-filter module and the INSGPS sub-filter The optimal estimation and the covariance matrix of estimation errors yield the global optimal estimation of the inertial navigation parameter error, the GPS receiver error, and the inertial sensor. Error; the TAINS sub-filter module and the INSGPS sub-filter module respectively receive from the Global optimal estimation of inertial navigation parameter error, GPS receiver error, and inertial sensor error of the main filter module and its estimation error 第74頁 4 54 09 5 案號 88103653 巧年f/月&gt;·〇曰 修正 六、申請專利範圍 方差陣,更新該ΤΑ I NS子濾波器和該I NSGPS子濾波器,執 行該ΤΑ I NS子濾波模塊、該I NSGPS子濾波器模塊和該主濾 波器模塊之間的信息分享算法; 該主濾波器模塊可以執行該T A I N S子濾波模塊、該 I NSGPS子濾波器模塊和該主渡波器模塊的估計結果之間的 祖容性檢驗,以便檢測和隔離來自有故障的GPS衛星的信 息,並重構該導航求解模塊的結構和處理; 該主濾波器模塊將得出的該慣性導航參數誤差、GPS 接收機誤差以及慣性傳感器誤差的最優估計反饋給該慣性 導航系統,以便該慣性導航系統對其誤差進行反饋校正 者' 4 1 .如申請專利範圍第3 4至3 7項所述之一飛行器定位 和地面鄰警系.統,其中_,該導航求解模塊進一步_包括:__ 一 單點地形輪廓計算模塊,接收來自該無線電高度表的無線 電高度測量、來自該氣壓高度表、來自該地形數據庫的地 形數據,將談慣性高度或混合氣壓慣性高度與飛行器現 在位置的地形高度相比較,得出一參考的單點地形輪廓測 量,該無線電高度測量是一測量的單點地形輪廓測量, 該單點地形輪廓計算模塊將該參考的單點地形輪廓測量和 該測量的單點地形輪廓測量之差,輸出給一濾波/估計模 塊; 該濾波/估計模塊接收來自該GPS搔收機的測量信息、 該慣性導航系統的慣性導航參數、來自該單點地形輪廓計 算模塊的參考的單點地开少輪廓測量和測量的單點地形輪廓Page 74 4 54 09 5 Case No. 88103653 Year f / month &gt; · 〇 Amendment VI. Patent application range variance matrix, update the TA I NS sub-filter and the I NSGPS sub-filter, execute the TA I NS Information sharing algorithm between the sub-filter module, the I NSGPS sub-filter module and the main filter module; the main filter module can execute the TAINS sub-filter module, the I NSGPS sub-filter module and the main wave filter module Ancestral test between the estimated results in order to detect and isolate the information from the faulty GPS satellite, and reconstruct the structure and processing of the navigation solution module; the inertial navigation parameter error that will be obtained by the main filter module 4. The optimal estimation of the GPS receiver error and the inertial sensor error is fed back to the inertial navigation system, so that the inertial navigation system can correct the error of the inertial navigation system. 4 1. An aircraft positioning and ground adjacent police system, where _, the navigation solution module further _ includes: __ a single-point terrain contour calculation module, receiving from the radio altitude Radio altitude measurement, terrain data from the barometric altimeter, and terrain data from the terrain database. Compare the inertial altitude or the mixed atmospheric inertia altitude with the terrain altitude at the current position of the aircraft to obtain a reference single-point terrain profile measurement. The radio height measurement is a measured single-point topographic profile measurement, and the single-point topographic profile calculation module outputs the difference between the reference single-point topographic profile measurement and the measured single-point topographic profile measurement to a filtering / estimation module; the The filtering / estimation module receives measurement information from the GPS receiver, inertial navigation parameters of the inertial navigation system, and referenced single-point ground contour measurement and measured single-point topographic profile from the single-point topographic profile calculation module 第75頁 4 54 03 5 案號 88103653 年//月 曰 修正 六、申請專利範圍 測量之差,以集中處理的方式進行濾波計算,得出該慣 性導航參數誤差、該GPS 接收機誤差以及該慣性傳感器誤 差的最優_估計; T,、 該濾波/估計模塊是一非線性濾波/估計器,它將得出 該慣性導航參數誤差、GPS 接收機誤差以及慣性傳感器誤 差的最優估計反饋給該慣性導航系統,以便該慣性導航系 統對其誤差進行反饋校正者。Page 75 4 54 03 5 Case No. 88103653 / / month, said amended six, the difference between the patent application range measurement, filtering calculations in a centralized manner, to obtain the inertial navigation parameter error, the GPS receiver error and the inertia Optimal estimation of sensor error; T, The filtering / estimation module is a non-linear filter / estimator, and it will feed back the optimal estimation of the inertial navigation parameter error, GPS receiver error, and inertial sensor error to the Inertial navigation system, so that the inertial navigation system feedback corrects its error. 第76頁Page 76
TW88103653A 1999-02-01 1999-03-10 Positioning and ground proximity warning method and system thereof for vehicle TW454095B (en)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
US09/241,164 US6157891A (en) 1998-11-16 1999-02-01 Positioning and ground proximity warning method and system thereof for vehicle

Publications (1)

Publication Number Publication Date
TW454095B true TW454095B (en) 2001-09-11

Family

ID=22909513

Family Applications (1)

Application Number Title Priority Date Filing Date
TW88103653A TW454095B (en) 1999-02-01 1999-03-10 Positioning and ground proximity warning method and system thereof for vehicle

Country Status (1)

Country Link
TW (1) TW454095B (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108153751A (en) * 2016-12-02 2018-06-12 上海航空电器有限公司 Active update method during a kind of airborne equipment map data base flight
CN110546457A (en) * 2017-05-02 2019-12-06 C系列飞机管理Gp公司 temperature correction of aircraft vertical speed
CN111308455A (en) * 2020-03-18 2020-06-19 中国商用飞机有限责任公司 Method and system for determining the ground clearance of an aircraft
CN111497532A (en) * 2015-03-20 2020-08-07 空中客车营运有限公司 Method for checking the air pressure of an aircraft tyre, hand-held device, and landing gear system
CN111551149A (en) * 2020-04-24 2020-08-18 中国航空无线电电子研究所 Calculation method suitable for aircraft geometric height

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111497532A (en) * 2015-03-20 2020-08-07 空中客车营运有限公司 Method for checking the air pressure of an aircraft tyre, hand-held device, and landing gear system
CN108153751A (en) * 2016-12-02 2018-06-12 上海航空电器有限公司 Active update method during a kind of airborne equipment map data base flight
CN110546457A (en) * 2017-05-02 2019-12-06 C系列飞机管理Gp公司 temperature correction of aircraft vertical speed
CN111308455A (en) * 2020-03-18 2020-06-19 中国商用飞机有限责任公司 Method and system for determining the ground clearance of an aircraft
CN111308455B (en) * 2020-03-18 2022-04-19 中国商用飞机有限责任公司 Method and system for determining the ground clearance of an aircraft
CN111551149A (en) * 2020-04-24 2020-08-18 中国航空无线电电子研究所 Calculation method suitable for aircraft geometric height

Similar Documents

Publication Publication Date Title
US6157891A (en) Positioning and ground proximity warning method and system thereof for vehicle
TW518422B (en) Positioning and proximity warning method and system thereof for vehicle
AU2017202519B2 (en) On-board backup and anti-spoofing GPS system
Benzerrouk et al. Alternative PNT based on Iridium Next LEO satellites Doppler/INS integrated navigation system
Dommety et al. Potential networking applications of global positioning systems (GPS)
TW591241B (en) Improved positioning and data integrating method and system thereof
WO2001011383A1 (en) Method and system for creating an approach to a position on the ground from a location above the ground
CN104331593B (en) For ground prediction aircraft along the device and method of the feature of the positioning in path
Bhatti Improved integrity algorithms for integrated GPS/INS systems in the presence of slowly growing errors
Sabatini et al. Avionics-based GNSS integrity augmentation for unmanned aerial systems sense-and-avoid
US6845304B1 (en) Method of and system for deriving inertial-aided deviations for autoland systems during GPS signal interruptions
Someswar et al. Global navigation satellite systems and their applications
Bijjahalli et al. GNSS performance modelling for positioning and navigation in Urban environments
Sabatini et al. A novel GNSS integrity augmentation system for civil and military aircraft
Sabatini et al. Avionics-based integrity augmentation system for mission-and safety-critical GNSS applications
Grzegorzewski Navigation an Aircraft by means of a Position potential in three dimensional space
TW454095B (en) Positioning and ground proximity warning method and system thereof for vehicle
Videmsek et al. Evaluation of RADAR altimeter-aided GPS for precision approach using flight test data
WO2002039138A1 (en) Positioning and ground proximity warning method and system thereof for vehicle
Vallot et al. Design and flight test of a differential GPS/inertial navigation system for approach/landing guidance
Gray In-flight detection of errors for enhanced aircraft flight safety and vertical accuracy improvement using digital terrain elevation data with an inertial navigation system, global positioning system and radar altimeter
Kulemann et al. Evaluation and comparison of different motion models for flight navigation
Amielh GNSS multipath model for aircraft surface navigation
Bertiger et al. Precise real-time low earth orbiter navigation with GPS
Song et al. Feasibility Analysis of GBAS/INS and RRAIM Integration for Surface Movement Operation

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