TWI564546B - On - board Vehicle Navigation System Calibration Method - Google Patents
On - board Vehicle Navigation System Calibration Method Download PDFInfo
- 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
Links
Landscapes
- Navigation (AREA)
Description
本發明係與儀器校正技術有關,特別係指一種用於校正陸地用載具之導航系統裝置安裝誤差角度之陸上載具導航系統校正方法。 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兩者間的座標轉換可以用下面的座標轉換矩陣關係式表示:
本發明係為一種陸上載具導航系統校正方法,係用於計算導航系統安裝於載具上產生之俯仰誤裝角與水平方位誤裝角,用以補償該導航系統與該載具座標間之安裝角度誤差,校正導航系統輸出之姿態精度。本發明之陸上載具導航系統校正方法步驟圖如圖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:
本發明之陸上載具導航系統校正方法,計算出導航系統與載具間之俯仰誤裝角後,接著計算該導航系統與該載具間之水平方位誤裝角。一般而言,INS/GPS整合導航系統乃是利用所謂的速度匹配法(Velocity Matching)進行最佳化之資料融合(Data Fusion),將導航系統本身之導航輸出誤差與內部之感測元件之誤差進行估測並消除。然而對於水平方位誤裝角ε D而言,它並不屬於導航系統內部之狀態誤差中,所以無法利用現有一般之INS/GPS最佳化理論進行估測,但是整合導航之方位角輸出中卻又真實存在此項誤差,導致導航系統無法真實提供確切之載具(車身)方位角,也造成了車載設備之定位精度受限,如衛星通信車之天線指向系統、行動太陽
能發電載具之太陽能板向光系統,或者軍事用途之火砲校正、飛彈導向、雷達光電偵測裝置之定位應用等等。現有技術中,若要找出ε D水平方位誤裝角,必須引進額外的車輛動態資訊才有可能實現。例如藉助於里程計並結合陸用車輛於直線道路行進時所具有的動態特性為最普遍的作法:
本發明為解決現有技術之缺點,提出以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:
本發明之陸上載具導航系統校正方法可進一步在載具中安裝里程計,以里程計輸出之資訊作為導航系統之輔助。INS/GPS整合導航系統為目前陸用導航系統最普遍之架構,雖然採用衛星訊號來提升導航精度,但也犧牲了自主性、容易遭受干擾以及建築物遮蔽等諸多缺點,在此架構下增加里程計(ODO)輔助導航可以達到彼此互補的功效,當GPSR遭受蓄意/非蓄意干擾時,導航系統可利用INS/ODO模式進行輔助導航以提升精度。車輛上所安裝之里程計其輸出為載具所行駛之里程,車輛在不考慮車輪的滑動摩擦狀況,且車子於直線道路理想狀態下,車輛於路面行駛中之側向(Lateral)與垂直於路面方向之速率為0,以車體座標觀點而言,車輛行駛具
備以下之關係式:
上述之實施例僅為例示性說明本發明之特點及其功效,而非用於限制本發明之實質技術內容的範圍。任何熟習此技藝之人士均可在不違背本發明之精神及範疇下,對上述實施例進行修飾與變化。因此,本發明之權利保護範圍,應如後述之申請專利範圍所列。 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)
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)
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)
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 |
-
2015
- 2015-08-14 TW TW104126461A patent/TWI564546B/en active
Patent Citations (7)
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)
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 |