TWI564546B - On - board Vehicle Navigation System Calibration Method - Google Patents

On - board Vehicle Navigation System Calibration Method Download PDF

Info

Publication number
TWI564546B
TWI564546B TW104126461A TW104126461A TWI564546B TW I564546 B TWI564546 B TW I564546B TW 104126461 A TW104126461 A TW 104126461A TW 104126461 A TW104126461 A TW 104126461A TW I564546 B TWI564546 B TW I564546B
Authority
TW
Taiwan
Prior art keywords
navigation system
vehicle
angle
correcting
pitch
Prior art date
Application number
TW104126461A
Other languages
Chinese (zh)
Other versions
TW201706570A (en
Inventor
Ming-Huang Jiang
yong-xiang Zheng
jin-fa Shi
Xiu-Yue Ma
zhi-feng Lin
Original Assignee
Nat Chung-Shan Inst Of Science And Tech
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Nat Chung-Shan Inst Of Science And Tech filed Critical Nat Chung-Shan Inst Of Science And Tech
Priority to TW104126461A priority Critical patent/TWI564546B/en
Application granted granted Critical
Publication of TWI564546B publication Critical patent/TWI564546B/en
Publication of TW201706570A publication Critical patent/TW201706570A/en

Links

Landscapes

  • Navigation (AREA)

Description

陸上載具導航系統校正方法 Landborne navigation system correction method

本發明係與儀器校正技術有關,特別係指一種用於校正陸地用載具之導航系統裝置安裝誤差角度之陸上載具導航系統校正方法。 The present invention relates to instrument calibration techniques, and more particularly to a method for correcting a landborne navigation system for correcting the installation error angle of a navigation system device for a land vehicle.

一般而言陸用導航系統主要的功能為提供陸用車輛本身所在之位置、速度與姿態(Attitude)等資訊。其中位置與速度資訊應用的範圍包括一些車輛派遣系統(例如台灣大車隊等)可以藉此了解目前車輛所在位置並進行迅速有效的派車服務,又例如車輛導航軟體可以利用目前所在位置資訊及目的地進行路徑之最佳化規劃;也可以根據位置與速度資訊提供附近所在位置超速照相等相關警示服務等。至於車輛目前之姿態則可作為其他附屬設備之重要參考,例如天線系統,必須根據目前車輛姿態進行天線方位(Azimuth Angle)與俯仰(Elevation Angle)角度之調整以獲取最佳之訊號接收訊雜比(Signal Noise Ratio),車輛本身姿態資訊之精準度攸關訊號能否被順利解調之重要關鍵參數之一,例如衛星電話與衛星電視等;在軍用車輛方面,正確之車輛姿態可以協助本身配備之火砲(飛彈)系統精確擊中敵方目標,提高命中率。 In general, the main function of the land navigation system is to provide information such as the position, speed and attitude of the land vehicle itself. The range of location and speed information applications includes some vehicle dispatch systems (such as Taiwan's big teams, etc.) to understand the current location of the vehicle and to quickly and effectively deliver the car service. For example, the vehicle navigation software can use the current location information and purpose. The route is optimized for planning; the location and speed information can also be used to provide relevant warning services such as speeding photography at nearby locations. As for the current attitude of the vehicle, it can be used as an important reference for other auxiliary equipment. For example, the antenna system must adjust the antenna orientation (Azimuth Angle) and the elevation angle (Elevation Angle) according to the current vehicle attitude to obtain the best signal reception ratio. (Signal Noise Ratio), one of the key parameters of the vehicle's own attitude information, whether it can be successfully demodulated, such as satellite phones and satellite TV; in military vehicles, the correct vehicle attitude can assist itself The artillery (missile) system accurately hits enemy targets and improves the hit rate.

一般之導航系統主要利用陀螺儀與加速儀等感測儀具感測車身之角速度與加速度,經過誤差補償後,將此物理量在數位訊號處理器(DSP)內根據牛頓運動定律進行積分等導航運算以求得車輛本身之位置、速度與姿態等導航資料。由於初始姿態誤差與感測元件漂移量誤差等因素,使得運算求出的導航資料不正確且其誤差且隨時間逐漸發散,所提供之位置與速度資訊誤差過大導致相關的應用失去意義。為追求導航精度之提昇,另外一種方式為將車輛上可收集到之導航資料加以整合,運用個別量測資料之誤差不隨時間發散之特性,修正並降低慣性導航系統內之各個誤差源,使得導航精度獲致提昇,這種系統稱為輔助式導航系統。 The general navigation system mainly uses the gyroscope and accelerometer to sense the angular velocity and acceleration of the vehicle body. After error compensation, the physical quantity is integrated into the digital signal processor (DSP) according to Newton's law of motion. In order to obtain navigation information such as the position, speed and posture of the vehicle itself. Due to factors such as the initial attitude error and the error of the sensing component drift, the navigation data obtained by the calculation is incorrect and its error gradually diverges with time. The position and velocity information provided by the error is too large, which causes the related application to lose its meaning. In order to improve the navigation accuracy, another way is to integrate the navigation data that can be collected on the vehicle, and to use the characteristics of the individual measurement data to not diverge with time, to correct and reduce various error sources in the inertial navigation system, so that The navigation accuracy has been improved, and this system is called an auxiliary navigation system.

現階段導航系統最常運用之外部輔助導航系統之資料為全球定位系統,全球定位系統主要分為三部份:地面控制台(Control Segment)、衛星(Space Segment)與使用者(User Segment)。GPS之主要輸出資料為經度、緯度、高度與三軸向速度(ICD-GPS-200C),其誤差不隨時間累積發散,整合後之INS/GPS整合式導航系統具有低成本、高精度之良好特性。 At present, the most commonly used external navigation system for navigation systems is the global positioning system. The global positioning system is mainly divided into three parts: Control Segment, Space Segment and User Segment. The main output data of GPS is longitude, latitude, altitude and three-axis speed (ICD-GPS-200C). The error does not accumulate and accumulate with time. The integrated INS/GPS integrated navigation system has low cost and high precision. characteristic.

雖然INS/GPS整合式導航系統具有低成本高精度之諸多良好特性,唯衛星訊號容易受外在環境遮蔽(例如高樓大廈等建築物、隧道等)或是訊號干擾(無線基地台),使得整個系統無法滿足自給自足之要求。為增加抗干擾能力並同 時保持自主性(Self-contained),里程計成為一個重要的輔助裝備,陸用車輛一般皆會安裝所謂的里程計(Odometer:ODO),里程計可提供車輛行駛之里程數,在某些特殊之場景上INS/GPS搭配INS/ODO可以大幅提升精度並滿足自主性雙重要求,由於里程計為一般車輛之標準配備,不需額外重新安裝可大幅節省成本。 Although the INS/GPS integrated navigation system has many good features of low cost and high precision, satellite signals are easily shielded by external environments (such as buildings, tunnels, etc. in high-rise buildings) or signal interference (wireless base stations). The entire system cannot meet the requirements of self-sufficiency. To increase the anti-interference ability and When it is self-contained, the odometer becomes an important auxiliary equipment. Land vehicles generally install a so-called odometer (Odometer: ODO). The odometer can provide the mileage of the vehicle, in some special In the scenario, INS/GPS with INS/ODO can greatly improve the accuracy and meet the dual requirements of autonomy. Since the odometer is standard equipment for general vehicles, it can save a lot of money without additional reinstallation.

INS/GPS或是INS/ODO輔助式導航系統主要採用卡爾曼濾波(Kalman Filter)作為資料融合(Data Fusion)的架構來進行,濾波理論根據外部量測資料當時之精準度來進行最佳化估測,此時整合式導航系統此時所輸出之位置、速度與姿態可以滿足相關應用的精度需求。 INS/GPS or INS/ODO assisted navigation system mainly adopts Kalman Filter as the data fusion architecture, and the filtering theory is optimized based on the accuracy of external measurement data at that time. At this time, the position, speed and attitude of the integrated navigation system at this time can meet the accuracy requirements of related applications.

現階段將導航系統透過安裝基座安裝至陸用車輛時,由於機械加工工藝技術使得導航系統之體座標與車輛上之車身座標無法完全一致密合,但此密合度(兩個座標系統之間一致性)卻是採用INS/ODO輔助導航之精準度非常重要的因素。現今導航系統採用微機電式感測元件已逐漸成為趨勢,然而由於元件精度關係,要順利估測出此安裝誤差角度存在相當的困難度,為使導航系統所輸出的姿態能確實代表車輛當時之姿態,最直接的方式為透過光校方式確實量測車輛與導航系統間之安裝角度誤差,並將此數據輸入至導航系統中,導航系統於輸出姿態時再將此誤差予以扣除,此時所輸出之姿態才能算是車輛本身之姿態,此方法須額外準備光 校設備,不但費用高昂且相當耗時。另外一個方式則是參考車輛動態結合里程計輸出以進行導航系統之資料融合,雖然提出角度誤差相關之可察度分析,但當今文獻多半僅限於理論推導,對於如何校正導航系統之安裝角度誤差仍無提出明顯確切之作法。現有法則的另外一個缺點為車身動態的應用場景侷限於直線道路,無法適應至轉彎環境中。先前技術的另一個考量因素為製作成本,例如僅考慮里程計加陀螺儀(US4347573)或是GPS加上里程計(US5525998)、GPS加上加速儀(US5862511)等所建構之簡易導航系統等,大都無法顯示完整之滾轉、俯仰與方位角三軸向姿態,或是姿態輸出無法提供足夠之精確度。 At this stage, when the navigation system is installed to the land vehicle through the mounting base, the mechanical coordinate technology makes the body coordinates of the navigation system and the body coordinates on the vehicle cannot be completely consistent, but the tightness (between the two coordinate systems) Consistency) is a very important factor in the accuracy of INS/ODO-assisted navigation. Nowadays, the use of micro-electromechanical sensing elements in navigation systems has gradually become a trend. However, due to the accuracy of components, it is quite difficult to estimate the angle of installation error. The attitude of the navigation system can truly represent the vehicle at that time. Attitude, the most direct way is to accurately measure the installation angle error between the vehicle and the navigation system through the optical calibration method, and input this data into the navigation system. The navigation system then deducts this error when outputting the attitude. The attitude of the output can be regarded as the attitude of the vehicle itself. This method requires additional preparation of light. School equipment is expensive and time consuming. Another way is to refer to the vehicle dynamics combined with the odometer output for data fusion of the navigation system. Although the analysis of the angle error correlation is proposed, most of the current literature is limited to theoretical derivation, and how to correct the installation angle error of the navigation system is still No obvious and precise practice has been proposed. Another disadvantage of the existing rules is that the application scenarios of the body dynamics are limited to straight roads and cannot be adapted to the turning environment. Another consideration for the prior art is the production cost, such as the simple navigation system constructed by considering only the odometer plus gyroscope (US4347573) or GPS plus odometer (US5525998), GPS plus accelerometer (US5862511), etc. Most of them cannot display the full three-axis attitude of roll, pitch and azimuth, or the attitude output cannot provide sufficient accuracy.

鑒於傳統技術之缺點,本發明係提供一種陸上載具導航系統校正方法,係用於校正陸上載具配備上之導航系統因安裝加工造成之安裝角度誤差,以確保導航系統之精確度。 In view of the shortcomings of the conventional technology, the present invention provides a landborne navigation system correction method for correcting the installation angle error caused by the installation process of the navigation system equipped with the landlord to ensure the accuracy of the navigation system.

本發明係提供一種陸上載具導航系統校正方法,係用於計算導航系統安裝於載具上產生之俯仰誤裝角與水平方位誤裝角,用以補償該導航系統與該載具座標間之安裝角度誤差,校正導航系統輸出之姿態精度,該導航系統係具有全球衛星定位裝置、陀螺儀、加速儀與卡爾曼濾波器。本發明之陸上載具導航系統校正方法步驟係包括:將裝設有 導航系統之載具置於一坡道上,該載具前端朝向該坡道高處,讀取該導航系統之俯仰角度,得到一第一俯仰角;將該載具轉向180度,使該載具後端朝向該坡道高處,讀取該導航系統之俯仰角度,得到一第二俯仰角;將該第一俯仰角與第二俯仰角數值相加後除以2,得到一俯仰誤裝角;讀取該導航系統輸出之本體水平方位角;讀取該導航系統輸出之衛星定位水平速度方向角;將該本體水平方位角與該衛星定位水平速度方向角相減,得到一水平方位誤裝角資訊,作為卡爾曼濾波器之外部量測資料。 The invention provides a method for correcting a landborne navigation system, which is used for calculating a pitch misalignment angle and a horizontal azimuth mismatch angle generated by a navigation system mounted on a vehicle, for compensating between the navigation system and the carrier coordinate The angular error is installed to correct the attitude accuracy of the navigation system output. The navigation system has a global satellite positioning device, a gyroscope, an accelerometer and a Kalman filter. The method for correcting method of the landborne navigation system of the present invention includes: The vehicle of the navigation system is placed on a ramp, the front end of the vehicle faces the slope, and the pitch angle of the navigation system is read to obtain a first pitch angle; the carrier is turned 180 degrees to make the vehicle The back end faces the slope height, reads the pitch angle of the navigation system, and obtains a second pitch angle; adds the first pitch angle to the second pitch angle value and divides by 2 to obtain a pitch misplacement angle Reading the horizontal azimuth of the body output of the navigation system; reading the horizontal direction angle of the satellite positioning output by the navigation system; subtracting the horizontal azimuth angle of the body from the horizontal direction angle of the satellite positioning to obtain a horizontal orientation misassembly Angle information, as external measurement data of the Kalman filter.

本發明係為一種陸上載具導航系統校正方法,該第一俯仰角之數值係為該坡道角度與該俯仰誤裝角之和;該第二俯仰角之數值係為該坡道角度之負數與該俯仰誤裝角之和;該衛星定位水平速度方向角為載具行進時速度之方位角(相對於真北);該本體水平方位角為該導航系統本身(本體)輸出之方位角。 The invention relates to a landborne navigation system correction method, wherein the value of the first pitch angle is the sum of the slope angle and the pitch misload angle; the value of the second pitch angle is the negative of the slope angle The sum of the pitch misalignment angles; the satellite positioning horizontal velocity direction angle is the azimuth of the vehicle traveling speed (relative to true north); the body horizontal azimuth is the azimuth of the navigation system itself (body) output.

本發明係提供一種陸上載具導航系統校正方法,其中該載具係具有一里程計,本發明係可利用該里程計輸出之里程數,作為導航系統之GPS信號受到干擾時之輔助導航校正參數。本發明之陸上載具導航系統校正方法係進一步包括下列步驟:根據該載具於單位時間內移動之里程數,計算該載具之三軸向速度數值。該三軸向速度係指該載具於地面上移動之實際速度。 The present invention provides a landborne navigation system correction method, wherein the vehicle has an odometer, and the invention can utilize the mileage output by the odometer as an auxiliary navigation correction parameter when the GPS signal of the navigation system is interfered. . The landborne navigation system correction method of the present invention further includes the following steps: calculating the three-axis velocity value of the carrier based on the number of miles traveled by the carrier per unit time. The three axial speed refers to the actual speed at which the carrier moves on the ground.

以上之概述與接下來的詳細說明及附圖,皆是為了能進一步說明本發明達到預定目的所採取的方式、手段及功效。而有關本發明的其他目的及優點,將在後續的說明及圖示中加以闡述。 The above summary, the following detailed description and the accompanying drawings are intended to further illustrate the manner, the Other objects and advantages of the present invention will be described in the following description and drawings.

S1~S6‧‧‧本發明之陸上載具導航系統校正方法 S1~S6‧‧‧ method for correcting landborne navigation system of the invention

圖1係為現有技術之衛星導航系統架構圖。 FIG. 1 is a schematic diagram of a satellite navigation system architecture of the prior art.

圖2係為本發明之車輛(載具)之座標系統與導航系統體之座標兩者之間的關係圖。 2 is a diagram showing the relationship between the coordinate system of the vehicle (vehicle) of the present invention and the coordinates of the navigation system body.

圖3係為本發明之陸上載具導航系統校正方法步驟圖。 3 is a diagram showing the steps of a method for correcting a landborne navigation system of the present invention.

圖4係為本發明之位於理想水平路面之導航系統體座標與載具座標關係圖。 4 is a diagram showing the relationship between the body coordinates of the navigation system and the coordinates of the vehicle at the ideal level of the road surface of the present invention.

圖5係為本發明之俯仰誤裝角量測操作示意圖。 FIG. 5 is a schematic diagram of the tilting misalignment angle measurement operation of the present invention.

圖6係為本發明之導航系統與載具座標間之水平方位誤裝角示意圖。 Figure 6 is a schematic view of the horizontal orientation misalignment angle between the navigation system and the carrier coordinates of the present invention.

圖7係為本發明實施例之ε D標準方差收歛結果圖。 FIG. 7 is a graph showing the convergence result of the ε D standard deviation according to an embodiment of the present invention.

圖8係為載具之前後輪速度關係圖。 Figure 8 is a diagram showing the relationship between the rear wheel speeds before the vehicle.

以下係藉由特定的具體實例說明本發明之實施方式,熟悉此技藝之人士可由本說明書所揭示之內容輕易地瞭解本發明之其他優點與功效。 The embodiments of the present invention are described below by way of specific examples, and those skilled in the art can readily appreciate other advantages and functions of the present invention from the disclosure herein.

由於GPS接收機(Global Positioning System Receiver:GPSR)的蓬勃發展加上半導體製程的不斷精進提升,現階段陸用導航系統使用所謂的INS/GPS為最普遍的整合式架構,現有技術之衛星導航系統架構圖如圖1所示,所採用的法則為卡爾曼濾波(Kalman Filter)方式進行,最普遍的濾波週期為每秒1次(頻率為1Hz),內部導航系統透過陀螺儀與加速儀依據牛頓運動定律所進行之積分週期通常設定為10毫秒(10ms),GPSR所輸出的導航資料周期為一秒一次,導航資料內容為UTC Time、經度、緯度、高度與三軸向速度(表現在WGS-84 North Pointing NED座標系統),由於GPS所提供之導航資料涵蓋了三軸向之位置與速度,且所提供之資料精度良好,在理想狀況下,整合導航系統可以獲致令人滿意之結果。但實際環境中,GPS衛星訊號容易受地形、障礙物或是建築物所遮蔽,致使載具在所接收的衛星數目小於四顆的情形下,無法解算導航資料;另外衛星訊號本身雖然使用展頻理論(Spread Spectrum Theory),但仍極易受干擾,由於以上之缺點使得INS/GPS整合導航無法滿足強建性及自主性之要求;基於以上原因,一般陸用導航系統會加入里程計(Odometer)用以輔助導航,用以抑制純慣性導航會隨時間逐漸喪失精度之特性,加上里程計幾乎是一般陸用車輛的標準配備,不需額外新增裝備與配線,以上使得INS/ODO導航系統便成為另一個可能的選項。卡爾曼濾波的原理主要是將導航系統(A1)所輸出之資料與GPS(A2)或是里程計(A3)之輸出資 料進行比較之後,依據導航系統本身之狀態方程式進行各個狀態誤差之估測(Estimation),估測法則採用卡爾曼最佳估測理論(A5),最後將誤差項修正(A6)後送出精準之導航資料(A7)。 Due to GPS receiver (Global Positioning System The rapid development of Receiver:GPSR) and the continuous improvement of semiconductor manufacturing process, the current stage of land navigation system uses the so-called INS/GPS as the most common integrated architecture. The schematic diagram of the prior art satellite navigation system is shown in Figure 1. The rule adopted is Kalman Filter. The most common filtering period is 1 time per second (frequency is 1 Hz). The integration period of the internal navigation system through the gyroscope and the accelerometer according to Newton's law of motion is usually Set to 10 milliseconds (10ms), the GPSR output data cycle is once per second, and the navigation data content is UTC Time, Longitude, Latitude, Height and Triaxial Speed (expressed in the WGS-84 North Pointing NED coordinate system). Since the navigation data provided by GPS covers the position and speed of the three axes, and the information provided is accurate, under ideal conditions, the integrated navigation system can achieve satisfactory results. However, in the actual environment, the GPS satellite signal is easily obscured by terrain, obstacles or buildings, so that the vehicle cannot solve the navigation data when the number of satellites received is less than four. In addition, the satellite signal itself is used. Spread Spectrum Theory, but still very susceptible to interference, due to the above shortcomings, INS/GPS integrated navigation can not meet the requirements of strong construction and autonomy; for the above reasons, the general land navigation system will join the odometer ( Odometer) is used to assist navigation to suppress the inherent loss of accuracy of pure inertial navigation over time. Plus the odometer is almost standard equipment for general land vehicles. No additional equipment and wiring are required. The above makes INS/ODO The navigation system becomes another possible option. The principle of Kalman filtering is mainly to output the data of the navigation system (A1) and the output of GPS (A2) or odometer (A3). After comparing the materials, Estimation of each state error is performed according to the state equation of the navigation system itself. The estimation rule adopts the Kalman best estimation theory (A5), and finally the error term is corrected (A6) and sent to the precision. Navigation data (A7).

本發明定義之陸上載具係指陸用車輛,包括輪式車輛與履帶式車輛。本發明定義之導航系統係具有全球衛星定位裝置(GPS)、陀螺儀、加速儀與卡爾曼濾波器(Kalman filter),該導航系統可輸出衛星定位訊號、俯仰角度、水平方位角度與加速度之信號。理論上當導航系統安裝於載具(車輛)上且兩者之座標系統完全吻合時,導航系統輸出之姿態與位置訊號等同於該載具之姿態與位置,然而實際上導航系統與載具間難以避免會產生安裝誤差角度(誤裝角),兩者之座標系統難以完全吻合,造成導航系統輸出之姿態、位置訊號與載具實際之姿態、位置有所落差。車輛(載具)之座標系統(Vehicle Coordinate System:V)與導航系統體之座標(Body Coordinate:B)兩者之間的關係圖如圖2所示,其中XB、YB與ZB形成導航系統體座標(B)之笛卡兒右手直角座標系統;XV、YV與ZV形成載具(車身)座標(V)之笛卡兒右手直角座標系統;ε E為俯仰誤裝角,意即導航系統與載具於俯仰方向之安裝誤差角度;ε D為水平方位誤裝角,意即導航系統與載具於水平方位之安裝誤差角度。當ε Dε E皆屬於小角度(sin θθ而且cos θ≒1,實際情況中通常為3deg以下)的條件下,車身(載 具)座標V與導航系統座標B兩者間的座標轉換可以用下面的座標轉換矩陣關係式表示: 本發明係提供一種陸上載具導航系統校正方法,可以簡單並有效的計算出水平方位誤裝角ε D與俯仰誤裝角ε E,求出導航系統與車身(載具)座標間之安裝角度誤差,再藉由上述矩陣關係式進行補償,以精進導航系統輸出之姿態精度。 A landborne vehicle as defined by the present invention refers to a land vehicle, including a wheeled vehicle and a tracked vehicle. The navigation system defined by the invention has a global satellite positioning device (GPS), a gyroscope, an accelerometer and a Kalman filter, and the navigation system can output signals of satellite positioning signals, pitch angles, horizontal azimuth angles and acceleration signals. . Theoretically, when the navigation system is mounted on the vehicle (vehicle) and the coordinate system of the two is completely matched, the attitude and position signal output by the navigation system is equivalent to the posture and position of the vehicle, but in reality, it is difficult to navigate between the navigation system and the vehicle. Avoiding the installation error angle (missing angle), the coordinate system of the two is difficult to fully match, resulting in a gap between the attitude of the navigation system output, the position signal and the actual posture and position of the vehicle. The relationship between the vehicle coordinate system (Vehicle Coordinate System: V) and the coordinate system body (Body Coordinate: B) is shown in Figure 2, where X B , Y B and Z B are formed. Cartesian body coordinates (B) Cartesian right-handed right-angle coordinate system; X V , Y V and Z V form the Cartesian (V) coordinates of the Cartesian right-handed right-angle coordinate system; ε E is the pitch mis-installation angle That means the installation error angle of the navigation system and the vehicle in the pitch direction; ε D is the horizontal azimuth mismatch angle, which means the installation error angle of the navigation system and the vehicle in the horizontal orientation. When ε D and ε E are both small angles (sin θθ and cos θ ≒1, in practice, usually less than 3 deg), the coordinates between the body (carrier) coordinate V and the navigation system coordinate B Conversion can use the following coordinate transformation matrix relationship Indicates: The invention provides a method for correcting a landborne navigation system, which can calculate the horizontal azimuth mismatch angle ε D and the pitch mismatch angle ε E simply and effectively, and obtain the installation angle between the navigation system and the vehicle body (carrier) coordinates. The error is compensated by the above matrix relationship to improve the attitude accuracy of the navigation system output.

本發明係為一種陸上載具導航系統校正方法,係用於計算導航系統安裝於載具上產生之俯仰誤裝角與水平方位誤裝角,用以補償該導航系統與該載具座標間之安裝角度誤差,校正導航系統輸出之姿態精度。本發明之陸上載具導航系統校正方法步驟圖如圖3所示,該步驟係包括:將裝設有導航系統之載具置於一坡道上,該載具前端朝向該坡道高處,讀取該導航系統之俯仰角度,得到一第一俯仰角S1;將該載具轉向180度,使該載具後端朝向該坡道高處,讀取該導航系統之俯仰角度,得到一第二俯仰角S2;將該第一俯仰角與第二俯仰角數值相加後除以2,得到一俯仰誤裝角S3;讀取該導航系統輸出之本體水平方位角S4;讀取該導航系統輸出之衛星定位水平速度方向角S5;將該本體水平方位角與該衛星定位水平速度方向角相減,得到一水平方位誤裝角S6。 The invention relates to a method for correcting a landborne navigation system, which is used for calculating a pitch misalignment angle and a horizontal azimuth mismatch angle generated by a navigation system mounted on a vehicle, for compensating between the navigation system and the carrier coordinate Install the angle error to correct the attitude accuracy of the navigation system output. The step of the method for correcting the landborne navigation system of the present invention is as shown in FIG. 3. The step includes: placing the vehicle equipped with the navigation system on a ramp, the front end of the vehicle is facing the slope, and reading Taking the pitch angle of the navigation system to obtain a first pitch angle S1; turning the carrier to 180 degrees, causing the rear end of the vehicle to face the slope height, reading the pitch angle of the navigation system, and obtaining a second a pitch angle S2; adding the first pitch angle to the second pitch angle value and dividing by 2 to obtain a pitch mismatch angle S3; reading the body horizontal azimuth angle S4 output by the navigation system; reading the navigation system output The satellite locates the horizontal velocity direction angle S5; the horizontal azimuth angle of the body is subtracted from the satellite positioning horizontal velocity direction angle to obtain a horizontal azimuth misfit angle S6.

本發明係提供一種陸上載具導航系統校正方 法,首先需計算導航系統安裝於陸上載具產生之俯仰誤裝角,計算該俯仰誤裝角的步驟為:將裝設有導航系統之載具置於一坡道上,該載具前端朝向該坡道高處,讀取該導航系統之俯仰角度,得到一第一俯仰角數值;將該載具轉向180度,使該載具後端朝向該坡道高處,讀取該導航系統之俯仰角度,得到一第二俯仰角數值;將該第一俯仰角與第二俯仰角數值相加後除以2,得到一俯仰誤裝角數值。 The invention provides a correction device for a landborne navigation system First, the first step is to calculate the pitch mis-installation angle generated by the navigation system installed on the land-mounted vehicle. The step of calculating the pitch mis-installation angle is: placing the vehicle equipped with the navigation system on a ramp, the front end of the vehicle is oriented toward the The slope is high, the pitch angle of the navigation system is read, and a first pitch angle value is obtained; the vehicle is turned 180 degrees, the rear end of the vehicle is oriented toward the slope, and the pitch of the navigation system is read. Angle, a second pitch angle value is obtained; the first pitch angle is added to the second pitch angle value and divided by 2 to obtain a pitch misload angle value.

本發明之位於理想水平路面之導航系統體座標與載具座標關係圖如圖4所示,在理想之水平路面(Local-Level)上,導航系統A1本身的俯仰角(Pitch Angle:θ)輸出即為該導航系統與該載具間之俯仰誤裝角εE,即εE=θ,然而考量到現實生活中的應用場景,車輛載具所在之位置有可能不是當地區域之絕對水平,故本發明提供一種可快速計算出俯仰誤裝角之方法。本發明之俯仰誤裝角量測操作示意圖如圖5所示,將裝設有導航系統之載具置於一固定角度之坡道上,使載具前端(車頭)F朝向該坡道高處,讀取該導航系統之俯仰角度,得到一第一俯仰角θ IMU1 ,再使該載具前端(車頭)朝向該坡道低處,讀取該導航系統之俯仰角度,得到一第二俯仰角θ IMU2 ,該第一俯仰角與第二俯仰角之定義如下:θ IMU1=+α+ε E θ IMU2=-α+ε E 其中α為該坡道之傾斜角度,利用上述關係式可求得該導航 系統安裝於該載具上之俯仰誤裝角ε E 本發明於實際應用中,載具前端(車頭)轉向前後需儘量停留於原來之區域,以確保坡道傾斜角(α)保持一致,另選擇的地點其傾斜角度不宜過大,主要原因是過大的傾斜角度下,車身重力效應可能造成輪胎變形,導致本發明之俯仰誤裝角計算發生偏差。由於現有導航系統已可即時輸出與顯示俯仰角數值,本發明提供之方法所需時間僅為車輛載具進行轉向180度所耗之時間,遠較一般光校方式簡便快速,且成本較低廉,不需建構精密儀器設備與環境即可操作。 The relationship between the coordinates of the body of the navigation system and the coordinates of the vehicle at the ideal level of the road surface of the present invention is shown in Fig. 4. On the ideal level (Local-Level), the pitch angle (θ) of the navigation system A1 itself is output. That is, the pitch mismatch angle ε E between the navigation system and the vehicle, that is, ε E = θ. However, considering the application scenario in real life, the location of the vehicle carrier may not be the absolute level of the local area, so The present invention provides a method for quickly calculating a pitch misalignment angle. The schematic diagram of the tilting misalignment angle measuring operation of the present invention is as shown in FIG. 5, and the carrier equipped with the navigation system is placed on a slope of a fixed angle so that the front end (head) F of the vehicle faces the slope. Reading the pitch angle of the navigation system to obtain a first pitch angle θ IMU1 , and then positioning the front end (the front end) of the vehicle toward the lower slope, reading the pitch angle of the navigation system to obtain a second pitch angle θ IMU2 , the first pitch angle and the second pitch angle are defined as follows: θ IMU 1 = + α + ε E θ IMU 2 = - α + ε E where α is the inclination angle of the ramp, and the above relationship can be used The pitch misplacement angle ε E of the navigation system mounted on the carrier: In the practical application of the present invention, the front end (the front end) of the vehicle should be stopped as far as possible in the original area before and after the steering to ensure that the inclination angle ( α ) of the slope is consistent, and the inclination angle of the selected location should not be too large, the main reason is excessive At the oblique angle, the body gravity effect may cause the tire to be deformed, resulting in a deviation in the calculation of the pitch misalignment angle of the present invention. Since the existing navigation system can output and display the pitch angle value instantaneously, the time required by the method provided by the present invention is only the time taken for the vehicle carrier to turn 180 degrees, which is much simpler and faster than the general optical calibration method, and the cost is low. It can be operated without the need to construct precision instruments and equipment.

本發明之陸上載具導航系統校正方法,計算出導航系統與載具間之俯仰誤裝角後,接著計算該導航系統與該載具間之水平方位誤裝角。一般而言,INS/GPS整合導航系統乃是利用所謂的速度匹配法(Velocity Matching)進行最佳化之資料融合(Data Fusion),將導航系統本身之導航輸出誤差與內部之感測元件之誤差進行估測並消除。然而對於水平方位誤裝角ε D而言,它並不屬於導航系統內部之狀態誤差中,所以無法利用現有一般之INS/GPS最佳化理論進行估測,但是整合導航之方位角輸出中卻又真實存在此項誤差,導致導航系統無法真實提供確切之載具(車身)方位角,也造成了車載設備之定位精度受限,如衛星通信車之天線指向系統、行動太陽 能發電載具之太陽能板向光系統,或者軍事用途之火砲校正、飛彈導向、雷達光電偵測裝置之定位應用等等。現有技術中,若要找出ε D水平方位誤裝角,必須引進額外的車輛動態資訊才有可能實現。例如藉助於里程計並結合陸用車輛於直線道路行進時所具有的動態特性為最普遍的作法: 上式說明陸用車輛於直線道路前進時,其側向(Lateral)與垂直(Vertical)於路面之速度值為0(表現於車身座標V),但是利用速度資訊進行角度之估測屬於間接推估的方式,而且估測的過程中由於相關的導航狀態誤差彼此耦合,進而造成收斂時間過於冗長,且精度收斂不佳。 The method for correcting the landborne navigation system of the present invention calculates the pitch mis-installation angle between the navigation system and the vehicle, and then calculates the horizontal azimuth mismatch angle between the navigation system and the vehicle. In general, the INS/GPS integrated navigation system is a data fusion that is optimized by the so-called Velocity Matching method. The navigation output error of the navigation system itself is different from the internal sensing component. Make estimates and eliminate them. However, for the horizontal azimuth misfit angle ε D , it is not in the state error of the navigation system, so it cannot be estimated by the existing general INS/GPS optimization theory, but the azimuth output of the integrated navigation is This error also exists, resulting in the navigation system not being able to provide the exact azimuth of the vehicle (body), which also limits the positioning accuracy of the vehicle equipment, such as the antenna pointing system of the satellite communication vehicle and the solar energy of the mobile solar power vehicle. Plate-to-light systems, or artillery correction for military applications, missile guidance, positioning applications for radar photodetection devices, and more. In the prior art, if the ε D horizontal azimuth misfit angle is to be found, additional vehicle dynamic information must be introduced to achieve this. For example, by means of an odometer combined with the dynamic characteristics of a land vehicle traveling on a straight road, the most common practice is: The above formula shows that when the land vehicle advances on a straight road, the lateral (Lateral) and vertical (Vertical) speed values on the road surface are 0 (expressed in the body coordinate V), but the estimation of the angle using the speed information is an indirect push. In the estimation method, and the related navigation state errors are coupled to each other in the estimation process, the convergence time is too long and the accuracy convergence is not good.

本發明為解決現有技術之缺點,提出以GPS技術得知之衛星定位水平速度方向角與導航系統之本體水平方位角相互比對,藉此得知導航系統之水平方位誤裝角之方法。本發明所使用的量測資料資料與ε D直接相關,可以避免現有技術所遭遇到之收斂時間與精度瓶頸。根據一般GPSR之導航輸出資料(NMEA 0183 V3.0)有提供所謂的載具水平速度之方向,例如NEMA協定中之$GPRMC(Recommended Minimum Course:RMC)與$GPVTG(Course and Speed Over The Ground:VTG)等皆含有所謂的Course Over Ground(COG);COG所代表的物理意義為車輛行進時速度之方位角(相對於真北),在不考慮車子產生滑動之限制條件下(δ≒0),其實COG 所提供之方向等同於車身座標上之XV方向,即載具(車輛)的直線行進方向,故本發明定義之衛星定位水平速度方向角即為COG。本發明之導航系統與載具座標間之水平方位誤裝角示意圖如圖6所示,本發明定義之本體水平方位角為INS/GPS所輸出之導航系統本體的方位角,導航系統本身之方位角姿態輸出等同於XB方向,將該本體水平方位角與該衛星定位水平速度方向角相減,即可得知該導航系統之水平方位誤裝角ε D。若GPS若無法輸出NMEA 0183通訊協定,可以利用其所輸出之北軸向速度(VN)與東軸向速度(VE)依照以下之計算式求得COG: 本發明進一步提出一計算水平方位誤裝角ε D之計算公式實施例:z=ΨINS-COG=εDDCOG (3)其中ΨINS為導航系統之本體水平方位角;ψD為導航系統之水平方位角輸出誤差;COG為衛星定位水平速度方向角(相對於真北);ω COG為COG之速度方向角度誤差。觀察等式右邊,僅含有ε D與ψD兩項,其中ψD方位角誤差可透過車子進行加速或是轉彎等動作來消除或降低;至於ω COG為COG本身之雜訊誤差,COG之精確度與GPSR所輸出之速度精度有關,一般商用GPSR其速度精度約為0.1m/s(1 σ),以陸用載具60km/hr之行駛速度而言,其COG輸出精確度可以輕易達到0.1度以上, 假設COG誤差模式屬於高斯雜訊分佈(Gaussian Noise Distribution),考量其他誤差因素(例如時序對準誤差等),本發明提出一誤差數值模式:ωCOG~N(0,0.3) (4)本發明之實施例以公式(3)作為外部量測資料引入卡爾曼濾波器中,公式(4)為其誤差模式,假設初始GPS水平速度方位角誤差已透過卡爾曼濾波收斂至0.1度,圖7為本發明實施例之ε D標準方差收歛結果圖,R曲線為導航系統之水平方位角輸出誤差,B曲線為水平方位誤裝角ε D,圖7說明利用本發明提出之方法,ε D精度可收斂至與ψD數值之水準,ψD愈精確,對ε D精度愈有幫助。 In order to solve the shortcomings of the prior art, the present invention proposes a method for comparing the horizontal direction direction angle of the satellite positioning and the horizontal azimuth angle of the navigation system, which is known by the GPS technology, to learn the horizontal azimuth mismatch angle of the navigation system. The measurement data used in the present invention is directly related to ε D , which can avoid the convergence time and accuracy bottleneck encountered in the prior art. According to the general GPSR navigation output data (NMEA 0183 V3.0), there is a so-called vehicle horizontal speed direction, such as $GPRMC (Recommended Minimum Course: RMC) and $GPVTG (Course and Speed Over The Ground: in the NEMA Agreement). VTG) and so on contain the so-called Course Over Ground (COG); the physical meaning represented by COG is the azimuth of the speed of the vehicle (relative to true north), without considering the restriction of the car to slip ( δ ≒ 0) In fact, the direction provided by the COG is equivalent to the X V direction on the body coordinates, that is, the straight traveling direction of the vehicle (vehicle). Therefore, the horizontal direction angle of the satellite positioning defined by the present invention is COG. The schematic diagram of the horizontal orientation mismatch angle between the navigation system and the carrier coordinate of the present invention is shown in FIG. 6. The horizontal azimuth angle of the body defined by the present invention is the azimuth of the navigation system body output by the INS/GPS, and the orientation of the navigation system itself. The angular attitude output is equivalent to the X B direction, and the horizontal azimuth angle of the body is subtracted from the horizontal direction angle of the satellite positioning, and the horizontal orientation mismatch angle ε D of the navigation system is known. If the GPS cannot output the NMEA 0183 protocol, the COG can be obtained by using the north axial velocity (V N ) and the east axial velocity (V E ) of the output according to the following formula: The present invention further proposes a calculation formula for calculating the horizontal azimuth misfit angle ε D : z = INS INS - COG = ε D - Φ D + ω COG (3) where Ψ INS is the body's horizontal azimuth of the navigation system; D is the horizontal azimuth output error of the navigation system; COG is the horizontal direction angle of the satellite positioning (relative to true north); ω COG is the angular error of the speed direction of the COG. Observe the right side of the equation, which only contains ε D and ψ D. The ψ D azimuth error can be eliminated or reduced by the car to accelerate or turn; for ω COG is the noise error of COG itself, the accuracy of COG The degree is related to the speed accuracy of the GPSR output. The general commercial GPSR has a speed accuracy of about 0.1m/s (1 σ). With a land vehicle speed of 60km/hr, the COG output accuracy can easily reach 0.1 degrees or more. Assuming that the COG error mode belongs to Gaussian Noise Distribution, considering other error factors (such as timing alignment error, etc.), the present invention proposes an error value mode: ω COG ~ N (0, 0.3) (4) The embodiment of the invention introduces the formula (3) as the external measurement data into the Kalman filter, and the formula (4) is its error mode, assuming that the initial GPS horizontal velocity azimuth error has converge to 0.1 degree through the Kalman filter, FIG. 7 For the ε D standard variance convergence result graph of the embodiment of the present invention, the R curve is the horizontal azimuth output error of the navigation system, and the B curve is the horizontal azimuth mismatch angle ε D , and FIG. 7 illustrates the method proposed by the present invention, ε D precision can Converges to a value of the level and ψ D, ψ D more accurately, the accuracy of ε D more helpful.

本發明之陸上載具導航系統校正方法可進一步在載具中安裝里程計,以里程計輸出之資訊作為導航系統之輔助。INS/GPS整合導航系統為目前陸用導航系統最普遍之架構,雖然採用衛星訊號來提升導航精度,但也犧牲了自主性、容易遭受干擾以及建築物遮蔽等諸多缺點,在此架構下增加里程計(ODO)輔助導航可以達到彼此互補的功效,當GPSR遭受蓄意/非蓄意干擾時,導航系統可利用INS/ODO模式進行輔助導航以提升精度。車輛上所安裝之里程計其輸出為載具所行駛之里程,車輛在不考慮車輪的滑動摩擦狀況,且車子於直線道路理想狀態下,車輛於路面行駛中之側向(Lateral)與垂直於路面方向之速率為0,以車體座標觀點而言,車輛行駛具 備以下之關係式: 上述公式(5)為現有文獻所提及之非-哈納米克限制條件(Non-Holonomic Constraint),可以運用於直線運動之一般車輛,如果再將車輛上之里程計輸出納入考量,並假設單位時間(ΔT)內所行駛的里程數為ΔS,則於XV軸向的速度值可以表示為 現有技術中,利用公式(5)與公式(6)即可利用里程計輔助導航系統,建構出完整且低成本的三軸向速度量測資訊。但上述計算方式僅適用於直線道路無法適應轉彎路況,故本發明提出修正里程計用於輔助導航時在轉彎路況產生誤差之方法,以具前輪轉向系統之四輪車輛(載具)為例,該載具之前後輪速度關係圖如圖8所示,其中B點為里程計安裝於前輪軸中心處,A點為後輪軸中心處,車輛(載具)此時正進行角速率為ω之轉彎動作;一般的行駛條件下,側滑角(Side-Slip Angle:δ)接近於0,假設里程計安裝於B點處,可以得出: 其中ω為載具轉彎所量測到之角速率(Yaw-Rate);R為載具之轉彎半徑;VB為里程計安裝於B點時該載具之速率;d為車輛前後輪軸之間的距離。利用公式(7)可以得出B點的速度向量為 (表示在車身座標V上): 根據以上之推導可以進一步將非-哈納米克限制條件延伸至轉彎之應用環境中,此時車輛(載具)之三軸向速度數值為: 其中ΔT為單位時間,ΔS為單位時間(ΔT)內里程計之輸出值(里程數)。根據B點里程計所輸出之資料,我們可以進一步推估後輪軸中心A點處之速度向量為: 換言之,雖然里程計安裝於前輪軸中心B點處,但根據式(10)我們仍可推估後輪軸中心A點處,載具之三軸向速度數值為: 本發明之陸上載具導航系統校正方法為改善現有里程計用於導航系統時發生轉彎誤差問題,進一步將非-哈納米克限制條件予以延伸,將轉彎時之車輛動態與里程計安裝位置納入考慮,可提供導航系統更為精確的里程換算速度資料,對於 INS/ODO整合導航時所需之外部量測資料於轉彎時亦可適用,大幅提升INS/ODO整合導航精度。 The landborne navigation system correction method of the present invention can further install an odometer in the vehicle, and the information output by the odometer is used as an auxiliary of the navigation system. The INS/GPS integrated navigation system is the most common architecture for land navigation systems. Although satellite signals are used to improve navigation accuracy, it also sacrifices autonomy, vulnerability to interference, and building obscuration. The (ODO) assisted navigation can achieve complementary effects. When the GPSR suffers deliberate/unintentional interference, the navigation system can use the INS/ODO mode to assist navigation to improve accuracy. The output of the odometer installed on the vehicle is the mileage traveled by the vehicle. The vehicle does not consider the sliding friction condition of the wheel, and the vehicle is in the lateral direction of the straight road, and the vehicle is laterally and perpendicular to the road. The speed of the road surface is 0. From the perspective of the car body coordinates, the vehicle has the following relationship: The above formula (5) is the non-Holonomic Constraint mentioned in the existing literature, and can be applied to general vehicles with linear motion. If the odometer output on the vehicle is taken into consideration, the unit is assumed. When the mileage traveled in time (ΔT) is ΔS, the velocity value in the X V axis can be expressed as In the prior art, using the formula (5) and the formula (6), the odometer assisted navigation system can be utilized to construct a complete and low-cost three-axis velocity measurement information. However, the above calculation method is only applicable to a straight road that cannot adapt to a turning road condition. Therefore, the present invention proposes a method for correcting an error caused by a turning odometer when assisting navigation, and taking a four-wheeled vehicle (vehicle) having a front wheel steering system as an example. The front wheel speed relationship diagram of the vehicle is shown in Figure 8. The point B is the odometer installed at the center of the front axle, the point A is at the center of the rear axle, and the vehicle (vehicle) is now at an angular rate of ω . Turning action; under normal driving conditions, the side-slip angle ( δ ) is close to 0. Assuming the odometer is installed at point B, it can be concluded that: Where ω is the angular rate measured by the turning of the vehicle (Yaw-Rate); R is the turning radius of the vehicle; V B is the speed of the vehicle when the odometer is installed at point B; d is between the front and rear axles of the vehicle the distance. Using equation (7), we can get the velocity vector of point B (indicated on the body coordinate V): According to the above derivation, the non-Hankak restriction condition can be further extended to the application environment of the turn, and the three axial speed values of the vehicle (vehicle) are: Where ΔT is the unit time and ΔS is the output value (mileage) of the odometer per unit time (ΔT). According to the data output from the B-point odometer, we can further estimate the velocity vector at the point A of the rear axle center: In other words, although the odometer is installed at point B of the front axle center, according to equation (10), we can still estimate the point A of the rear axle center. The three axial speed values of the carrier are: The calibration method of the landborne navigation system of the present invention is to improve the turning error problem when the existing odometer is used in the navigation system, further extend the non-Hankak restriction condition, and take into consideration the vehicle dynamics during turn and the installation position of the odometer It can provide more accurate mileage conversion speed data of the navigation system. The external measurement data required for INS/ODO integrated navigation can also be applied during cornering, which greatly improves the navigation accuracy of INS/ODO integration.

上述之實施例僅為例示性說明本發明之特點及其功效,而非用於限制本發明之實質技術內容的範圍。任何熟習此技藝之人士均可在不違背本發明之精神及範疇下,對上述實施例進行修飾與變化。因此,本發明之權利保護範圍,應如後述之申請專利範圍所列。 The above-described embodiments are merely illustrative of the features and functions of the present invention, and are not intended to limit the scope of the technical scope of the present invention. Modifications and variations of the above-described embodiments can be made by those skilled in the art without departing from the spirit and scope of the invention. Therefore, the scope of protection of the present invention should be as set forth in the scope of the claims described below.

S1~S6‧‧‧本發明之陸上載具導航系統校正方法 S1~S6‧‧‧ method for correcting landborne navigation system of the invention

Claims (10)

一種陸上載具導航系統校正方法,其步驟包括:將裝設有導航系統之載具置於一坡道上,該載具前端朝向該坡道高處,讀取該導航系統之俯仰角度,得到一第一俯仰角;將該載具轉向180度,使該載具後端朝向該坡道高處,讀取該導航系統之俯仰角度,得到一第二俯仰角;將該第一俯仰角與第二俯仰角數值相加後除以2,得到一俯仰誤裝角。 A method for correcting a landborne navigation system includes the steps of: placing a vehicle equipped with a navigation system on a ramp, the front end of the vehicle facing the slope, reading a pitch angle of the navigation system, and obtaining a a first pitch angle; the vehicle is turned 180 degrees, the rear end of the vehicle is oriented toward the slope, and the pitch angle of the navigation system is read to obtain a second pitch angle; the first pitch angle is The two pitch angle values are added and divided by 2 to obtain a pitch misfit angle. 如申請專利範圍第1項所述之陸上載具導航系統校正方法,其中該導航系統係具有全球衛星定位裝置、陀螺儀、加速儀與卡爾曼濾波器。 The method for correcting a land-based navigation system according to claim 1, wherein the navigation system has a global satellite positioning device, a gyroscope, an accelerometer, and a Kalman filter. 如申請專利範圍第1項所述之陸上載具導航系統校正方法,其中該第一俯仰角之數值係為該坡道角度與該俯仰誤裝角之和。 The method for correcting a land-based navigation system according to claim 1, wherein the value of the first pitch angle is a sum of the slope angle and the pitch mis-assembly angle. 如申請專利範圍第1項所述之陸上載具導航系統校正方法,其中該第二俯仰角之數值係為該坡道角度之負數與該俯仰誤裝角之和。 The method for correcting a land-based navigation system according to claim 1, wherein the value of the second pitch angle is a sum of a negative angle of the slope angle and the pitch mis-assembly angle. 如申請專利範圍第2項所述之陸上載具導航系統校正方法,其中進一步包括:讀取該導航系統輸出之本體水平方位角;讀取該導航系統輸出之衛星定位水平速度方向角; 將該本體水平方位角與該衛星定位水平速度方向角相減,得到一水平方位誤裝角資訊,作為卡爾曼濾波器之外部量測資料。 The method for correcting a land-based navigation system according to claim 2, further comprising: reading a horizontal azimuth of the body of the navigation system; and reading a horizontal direction angle of the satellite positioning output by the navigation system; The horizontal azimuth of the body is subtracted from the horizontal direction angle of the satellite positioning to obtain a horizontal azimuth angle information, which is used as external measurement data of the Kalman filter. 如申請專利範圍第1項所述之陸上載具導航系統校正方法,其中該載具係具有一里程計。 The method for correcting a land-based navigation system according to claim 1, wherein the vehicle has an odometer. 如申請專利範圍第6項所述之陸上載具導航系統校正方法,其中該載具係為一具前輪轉向系統之四輪車輛。 The method for correcting a landborne navigation system according to claim 6, wherein the carrier is a four-wheeled vehicle with a front wheel steering system. 如申請專利範圍第7項所述之陸上載具導航系統校正方法,其中進一步包括:根據該載具於單位時間內移動之里程數,計算該載具之三軸向速度數值。該三軸向速度係指該載具於地面上移動之實際速度。 The method for correcting a land-based navigation system according to claim 7, wherein the method further comprises: calculating a value of the three-axis speed of the vehicle according to the number of miles moved by the vehicle in a unit time. The three axial speed refers to the actual speed at which the carrier moves on the ground. 如申請專利範圍第8項所述之陸上載具導航系統校正方法,當該里程計安裝於該載具之前輪軸中心處,該三軸向速度數值的計算方式為: 為該載具之三軸向速度數值,ω為載具轉彎所量測到之角速率,d為該載具前輪軸與後輪軸間之距離,ΔT為單位時間,ΔS為單位時間內里程計輸出之里程數。 The method for correcting a land-based navigation system according to claim 8 is as follows: when the odometer is installed at the center of the axle before the vehicle, the three-axis speed value is calculated as: For the three axial velocity values of the vehicle, ω is the angular velocity measured by the vehicle turning, d is the distance between the front axle and the rear axle of the vehicle, ΔT is the unit time, and ΔS is the odometer per unit time. The number of miles exported. 如申請專利範圍第8項所述之陸上載具導航系統校正方法,當該里程計安裝於載具之前輪軸中心處,則該後輪軸中心處之三軸向速度數值的計算方式為: 為該載具後輪軸中心處之三軸向速度數值,ω為載具轉彎所量測到之角速率,d為該載具前輪軸與後輪軸間之距離,ΔT為單位時間,ΔS為單位時間內里程計輸出之里程數。 The method for correcting a landborne navigation system according to claim 8 is as follows: when the odometer is installed at the center of the axle before the carrier, the calculation of the three axial velocity values at the center of the rear axle is: For the value of the three axial speeds at the center of the rear axle of the vehicle, ω is the angular velocity measured by the turning of the vehicle, d is the distance between the front axle and the rear axle of the vehicle, ΔT is the unit time, and ΔS is the unit. The number of miles output by the odometer during the time.
TW104126461A 2015-08-14 2015-08-14 On - board Vehicle Navigation System Calibration Method TWI564546B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
TW104126461A TWI564546B (en) 2015-08-14 2015-08-14 On - board Vehicle Navigation System Calibration Method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW104126461A TWI564546B (en) 2015-08-14 2015-08-14 On - board Vehicle Navigation System Calibration Method

Publications (2)

Publication Number Publication Date
TWI564546B true TWI564546B (en) 2017-01-01
TW201706570A TW201706570A (en) 2017-02-16

Family

ID=58407779

Family Applications (1)

Application Number Title Priority Date Filing Date
TW104126461A TWI564546B (en) 2015-08-14 2015-08-14 On - board Vehicle Navigation System Calibration Method

Country Status (1)

Country Link
TW (1) TWI564546B (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114413932A (en) * 2022-01-03 2022-04-29 中国电子科技集团公司第二十研究所 Positioning error correction test method based on communication between vehicle-mounted platforms

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2009006341A1 (en) * 2007-06-28 2009-01-08 Sirf Technology Holdings, Inc. Compensation for mounting misalignment of a navigation device
TW201132528A (en) * 2010-03-26 2011-10-01 Cheng Uei Prec Ind Co Ltd Picture adjustment system of head up display for vehicle and adjusting method using the same
CN102313535A (en) * 2011-06-29 2012-01-11 惠州市德赛西威汽车电子有限公司 Slope detection method
CN102410845A (en) * 2011-08-16 2012-04-11 江苏惠通集团有限责任公司 Method and device for correcting error, detecting angular speed and controlling mouse, and space mouse
US20120221244A1 (en) * 2011-02-28 2012-08-30 Trusted Positioning Inc. Method and apparatus for improved navigation of a moving platform
US8406996B2 (en) * 2010-08-25 2013-03-26 Trimble Navigation Limited Cordless inertial vehicle navigation

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2009006341A1 (en) * 2007-06-28 2009-01-08 Sirf Technology Holdings, Inc. Compensation for mounting misalignment of a navigation device
US8086405B2 (en) * 2007-06-28 2011-12-27 Sirf Technology Holdings, Inc. Compensation for mounting misalignment of a navigation device
TW201132528A (en) * 2010-03-26 2011-10-01 Cheng Uei Prec Ind Co Ltd Picture adjustment system of head up display for vehicle and adjusting method using the same
US8406996B2 (en) * 2010-08-25 2013-03-26 Trimble Navigation Limited Cordless inertial vehicle navigation
US20120221244A1 (en) * 2011-02-28 2012-08-30 Trusted Positioning Inc. Method and apparatus for improved navigation of a moving platform
CN102313535A (en) * 2011-06-29 2012-01-11 惠州市德赛西威汽车电子有限公司 Slope detection method
CN102410845A (en) * 2011-08-16 2012-04-11 江苏惠通集团有限责任公司 Method and device for correcting error, detecting angular speed and controlling mouse, and space mouse

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114413932A (en) * 2022-01-03 2022-04-29 中国电子科技集团公司第二十研究所 Positioning error correction test method based on communication between vehicle-mounted platforms
CN114413932B (en) * 2022-01-03 2024-05-14 中国电子科技集团公司第二十研究所 Positioning error correction testing method based on communication between vehicle-mounted platforms

Also Published As

Publication number Publication date
TW201706570A (en) 2017-02-16

Similar Documents

Publication Publication Date Title
US9488480B2 (en) Method and apparatus for improved navigation of a moving platform
Prikhodko et al. Towards self-navigating cars using MEMS IMU: Challenges and opportunities
US6681180B2 (en) Determination and control of vehicle sideslip using GPS
CN102506857B (en) Relative attitude measurement real-time dynamic filter method based on dual-inertial measurement unit/differential global positioning system (IMU/DGPS) combination
CN110926468B (en) Communication-in-motion antenna multi-platform navigation attitude determination method based on transfer alignment
WO2017107434A1 (en) Gnss-ins vehicle attitude determination method based on single antenna
US8467967B2 (en) Smart-phone bracket for car and truck navigation
US8406996B2 (en) Cordless inertial vehicle navigation
CN106643709B (en) Combined navigation method and device for offshore carrier
CN107132563B (en) Combined navigation method combining odometer and dual-antenna differential GNSS
JP5602070B2 (en) POSITIONING DEVICE, POSITIONING METHOD OF POSITIONING DEVICE, AND POSITIONING PROGRAM
CN109186597B (en) Positioning method of indoor wheeled robot based on double MEMS-IMU
CN104713555A (en) Autonomous vehicle navigation method for assisting orientation by applying omnimax neutral point
KR101765746B1 (en) Positioning method and system for autonomous driving of agricultural unmmaned tractor using multiple low cost gps
CN109059909A (en) Satellite based on neural network aiding/inertial navigation train locating method and system
CN104880189B (en) A kind of antenna for satellite communication in motion low cost tracking anti-interference method
CN102621570B (en) Automobile dynamic parameter measuring method based on double global positioning and inertia measurement
CN110823224B (en) Vehicle positioning method and vehicle
Park et al. MEMS 3D DR/GPS integrated system for land vehicle application robust to GPS outages
KR20190040818A (en) 3D vehicular navigation system using vehicular internal sensor, camera, and GNSS terminal
CN105910623B (en) The method for carrying out the correction of course using magnetometer assisted GNSS/MINS tight integration systems
CN103994766A (en) Anti-GPS-failure orientation method for fixed-wing unmanned aerial vehicle
US8890747B2 (en) Longitudinal and lateral velocity estimation using single antenna GPS and magnetic compass
CN113074757B (en) Calibration method for vehicle-mounted inertial navigation installation error angle
Niu et al. Camera-based lane-aided multi-information integration for land vehicle navigation