JPS63158408A - Processing method of data of geomagnetism sensor - Google Patents
Processing method of data of geomagnetism sensorInfo
- Publication number
- JPS63158408A JPS63158408A JP25922286A JP25922286A JPS63158408A JP S63158408 A JPS63158408 A JP S63158408A JP 25922286 A JP25922286 A JP 25922286A JP 25922286 A JP25922286 A JP 25922286A JP S63158408 A JPS63158408 A JP S63158408A
- Authority
- JP
- Japan
- Prior art keywords
- data
- vehicle
- sensor
- geomagnetic sensor
- output data
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000003672 processing method Methods 0.000 title claims description 14
- 238000012937 correction Methods 0.000 abstract description 10
- 230000015654 memory Effects 0.000 abstract description 9
- 238000006243 chemical reaction Methods 0.000 abstract description 3
- 238000001514 detection method Methods 0.000 description 8
- 238000000034 method Methods 0.000 description 8
- 238000012545 processing Methods 0.000 description 7
- 238000010586 diagram Methods 0.000 description 6
- 230000005415 magnetization Effects 0.000 description 5
- 230000008859 change Effects 0.000 description 3
- 238000006073 displacement reaction Methods 0.000 description 3
- 230000004907 flux Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 241000283153 Cetacea Species 0.000 description 1
- 229910000831 Steel Inorganic materials 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 238000007630 basic procedure Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000013075 data extraction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005358 geomagnetic field Effects 0.000 description 1
- 238000012886 linear function Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 239000010959 steel Substances 0.000 description 1
- 230000001131 transforming effect Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Landscapes
- Instructional Devices (AREA)
- Navigation (AREA)
Abstract
Description
【発明の詳細な説明】
炎五斑1
本発明は、車載ナビゲーション装置における地磁気セン
サのデータ処理方法に関するものである。DETAILED DESCRIPTION OF THE INVENTION The present invention relates to a data processing method for a geomagnetic sensor in an on-vehicle navigation device.
1旦且韮
近年、地図情報をメモリに記憶しておき、その地図情報
をメモリから読み出して車両の現在地とともに表示装置
に表示させることにより1、車両を所定の目的地に誘導
する車載ナビゲーション装置が研究、開発されている。In recent years, in-vehicle navigation devices have been developed that guide a vehicle to a predetermined destination by storing map information in a memory, reading the map information from the memory, and displaying the map information along with the vehicle's current location on a display device. being researched and developed.
かかるブビゲーション装置には、車両の方位を検出する
方位センサが不可欠であり、この方位センサとして、例
えば地磁気(地球磁界)に基づいて車両の方位を検出す
る地磁気センサが用いられる。しかしながら、この地磁
気センサは外乱磁界の影響を受は易く、車両の踏切通過
時、鉄橋通過時、或は車両の側を大きな車(例えば、ト
ラックやバス′@)が通過した際に、その出力データに
大きな誤差が含まれることになる。Such a navigation device requires a direction sensor that detects the direction of the vehicle, and as this direction sensor, for example, a geomagnetic sensor that detects the direction of the vehicle based on geomagnetism (earth's magnetic field) is used. However, this geomagnetic sensor is easily affected by disturbance magnetic fields, and its output may be affected when a vehicle passes a railroad crossing, a railway bridge, or when a large vehicle (such as a truck or bus) passes by the vehicle. The data will contain large errors.
1豆立皇1
本発明は、上述した点に鑑みなされたもので、地磁気セ
ンサにより求められる方位データの信頼性を高めること
により、車両方位をより正確に検出して精痕の良いナビ
ゲーションを行なえるようにした地磁気センサのデータ
処理方法を提供することを目的と(る。1. The present invention has been made in view of the above-mentioned points, and by increasing the reliability of the direction data obtained by the geomagnetic sensor, the direction of the vehicle can be detected more accurately and navigation with good precision can be performed. The purpose of this study is to provide a data processing method for a geomagnetic sensor that allows
本発明による地磁気センサのデータ処理方法は、地磁気
センサの出力データの変動を許容する許容範囲を設定し
、地磁気センサの出力データが所定時間連続して前記許
容範囲内に入らないときは、所定のデータに基づいて地
磁気センサの出力データの補正を行なうことを特徴とし
ている。The geomagnetic sensor data processing method according to the present invention sets a tolerance range that allows variations in the output data of the geomagnetic sensor, and when the output data of the geomagnetic sensor does not fall within the tolerance range for a predetermined period of time, a predetermined The feature is that the output data of the geomagnetic sensor is corrected based on the data.
友−Jul! 以下、本発明の実施例を図に基づいて詳細に説明する。Friend-Jul! Hereinafter, embodiments of the present invention will be described in detail based on the drawings.
第1図は、本発明による地磁気センサのデータ処理方法
が適用される車載ナビゲーション装置の構成を示すブロ
ック図である。同図において、1は地磁気に基づいて車
両の方位データを出力するための地磁気センサ、2は車
両の角速度を検出するための角速度センサ、3は車両の
移動距離を検出するための走行距離センサ、4は緯度及
び経度情報等から車両の現在地を検出するためのGPS
(Global Po5itionino Syste
m)装置であり、これら各センサ(装置)の出力はシス
テムコントローラ5に供給される。FIG. 1 is a block diagram showing the configuration of a vehicle-mounted navigation device to which a geomagnetic sensor data processing method according to the present invention is applied. In the figure, 1 is a geomagnetic sensor for outputting vehicle orientation data based on geomagnetism, 2 is an angular velocity sensor for detecting the angular velocity of the vehicle, 3 is a mileage sensor for detecting the distance traveled by the vehicle, 4 is a GPS for detecting the vehicle's current location from latitude and longitude information, etc.
(Global Po5tionino System
m) device, and the output of each of these sensors (devices) is supplied to the system controller 5.
システムコントローラ5は、各センサ(装置)1〜4の
出力を入力としA/D (アナログ/ディジタル)変換
等を行なうインターフェース6と、種々の画像データ処
理を行なうとともにインターフェース6から順次送られ
てくる各センサー(装置)1〜4の出力データに基づい
て車両の移動3等を演算するcpu <中央処理回路)
7と、このCPU7の各種の処理プログラムやその他必
要な情報が予め囚き込まれたROM(リード・オンリ・
メ・モリ)8と、プログラムを実行する上で必要な情報
の書込み及び読出しが行なわれるRAM (ランダム・
アクセス・メモリ)9と、いわゆるCD−ROM11C
カード等からなり、ディジタル化(数値化)された地図
情報が記録された記録媒体10と、V −RA M (
Video RAM)等からなるグラフィックメモリ1
1と、CPU7から送られてくる地図等のグラフィック
データをグラフィックメモリ11に描画しかつ画像とし
てCRT等のディスプレイ12に表示すべく制御するグ
ラフィックコント0−ラ13とから構成されている。入
力装置14はキーボード等からなり、使用名によるキー
人力により各種の指令等をシステムコント0−ラ5に対
して発する。The system controller 5 has an interface 6 which inputs the outputs of the sensors (devices) 1 to 4 and performs A/D (analog/digital) conversion, etc., and processes various image data which are sequentially sent from the interface 6. CPU (central processing circuit) that calculates vehicle movement 3, etc. based on the output data of each sensor (device) 1 to 4
7 and a ROM (read-only) in which various processing programs and other necessary information for the CPU 7 are stored in advance.
RAM (random memory) 8 and RAM (random
access memory) 9 and the so-called CD-ROM 11C
A recording medium 10 consisting of a card etc., on which digitized (numerical) map information is recorded, and a V-RAM (
Graphic memory 1 consisting of Video RAM), etc.
1, and a graphic controller 0-13 that controls graphic data such as a map sent from the CPU 7 to be drawn in a graphic memory 11 and displayed as an image on a display 12 such as a CRT. The input device 14 consists of a keyboard, etc., and various commands are issued to the system controllers 0-5 by manual keystrokes according to names used.
次に、CPU7によって実行される基本的な手順を、第
2図のフローチャートに従って説明する。Next, the basic procedure executed by the CPU 7 will be explained according to the flowchart shown in FIG.
CPLI7は、先ず最初にプログラムを実行させるため
のイニシャライズを行ない(ステップ81)、しかる後
車両の現在地がセットされているか否かを判断する(ス
テップ82>。現在地がセットされていない場合は、現
在地セットルーチンの実行(ステップS3)、例えば人
力I置14でのキー人力による現在地のセットが行なわ
れる。次に、走行距離を零にしくステップS4)、続い
て入力装置14からのキー人力が有るか否かの判断を行
なう(ステップ85)。The CPLI 7 first initializes to execute the program (step 81), and then determines whether the current location of the vehicle has been set (step 82>. If the current location is not set, the current location is Execution of a set routine (step S3), for example, the current location is set using the key input from the input device 14.Next, the mileage is set to zero (step S4), followed by key input from the input device 14. It is determined whether or not (step 85).
キー人力が無い場合は、ディスプレイ12上に現在地周
辺の地図表示を行なうとともに車両の現在位置及びその
方位を例えば車両マークにてこの地図上に表示し、車両
が移動したらその移動に伴い地図をスクロールさせ、更
に現在グラフィックメモリ11上にある地図データの範
囲を車両位置が越えそうなときには、記録媒体10から
必要な地図データを読み出しでディスプレイ12上に表
示する(ステップ86)。If there is no key personnel available, a map of the area around the current location is displayed on the display 12, and the current location of the vehicle and its direction are displayed on this map using, for example, a vehicle mark, and when the vehicle moves, the map scrolls as the vehicle moves. Furthermore, when the vehicle position is about to exceed the range of the map data currently on the graphic memory 11, the necessary map data is read out from the recording medium 10 and displayed on the display 12 (step 86).
キー人力が有ると、その入力データに応じて現在地の再
セット(ステップ$7)、センサ補正(ステップS8)
、目的地セット(ステップ89)及び地図の拡大・縮小
(ステップ510)の各ルーチンを実行する。If there is key human power, the current location is reset according to the input data (step $7), sensor correction (step S8)
, destination setting (step 89), and map enlargement/reduction (step 510) routines are executed.
また、CPU7はタイマーによる割込み処理により、第
3図に示すように、一定時間間隔で地磁気センサ1及び
補助方位センサである角速度センサ2の各出力データに
基づいて車両の方位を常に計輝する(ステップ811,
812)。In addition, as shown in FIG. 3, the CPU 7 uses interrupt processing by a timer to constantly measure the vehicle's direction based on the output data of the geomagnetic sensor 1 and the angular velocity sensor 2, which is an auxiliary direction sensor, at fixed time intervals ( step 811,
812).
ところで、地磁気センサ1は一般に、同一平面上におい
て互いに90°の位相角をもって配置された一対の磁気
検出素子からなり、これら一対の素子の一方は例えばU
方向(北方向)の地磁気成分を検出し、他方はV方向く
東方向)の地磁気成分を検出するようになっている。か
かる構成の地磁気センサ1を、水平面上において一回転
させると、U、■双方の検出素子からの出力データによ
って、第4図に示すような、Uv直交座標系の原点Oを
中心とする円■の軌跡が描かれる。従って、例えば点P
(LJ+ 、 V+ )における北(0輪)からの時
計回りの方位角θは、次式(1)によって算出される。By the way, the geomagnetic sensor 1 generally consists of a pair of magnetic detection elements arranged on the same plane with a phase angle of 90° to each other, and one of the pair of elements is, for example, U
One detects the geomagnetic component in the direction (north direction), and the other detects the geomagnetic component in the V direction (east direction). When the geomagnetic sensor 1 having such a configuration is rotated once on a horizontal plane, the output data from both detection elements U and ■ generates a circle centered at the origin O of the Uv rectangular coordinate system as shown in FIG. The trajectory is drawn. Therefore, for example, point P
The clockwise azimuth θ from the north (0 wheel) at (LJ+, V+) is calculated by the following equation (1).
θ−tau (U/V)・=・(1)従って、このよ
うな地磁気センサ1を、車両の前後或は左右方向に対し
て所定の角度で車両に取り付けておき、U、■双方の検
出素子からの出力データに基づいて(1)式のmlを行
なうことにより、車両の方位を検出できるのである。θ-tau (U/V)・=・(1) Therefore, such a geomagnetic sensor 1 is attached to the vehicle at a predetermined angle with respect to the front and rear or left and right directions of the vehicle, and the detection of both U and By performing ml of equation (1) based on the output data from the element, the direction of the vehicle can be detected.
ここで、地磁気センサ1の周囲には、地球磁界による磁
束のみが存在するのが理想であるが、車両においては、
そのボデー鋼板の着磁等に起因した余分な磁束が存在す
るのが一般的である。そこで、かかる車両ボデーの着磁
による影響を除去して正確な方位検出を行なうために、
例えば、VJ開昭57−28208@公報に開示の方法
が提案されている。この方法においては、U、■磁気検
出素子が車両に固定されて両名間に相対変位がない場合
に、磁気検出素子を一旋回させて得られる出力をプロッ
トして描かれた円の中心と、座標原点との距離がボデー
着磁の影響によるものである点に鑑みて、描かれた円の
中心が原点に移動するように、雨検出素子から得られた
出力データを補正して、ボデー着磁の影響を除去するよ
うにしている。詳述するに、雨検出素子の出力が描く円
は第4図の■で示すように、その中心Qが原点から移動
した位置にある。そこで、雨検出素子の出力U。Ideally, only magnetic flux due to the earth's magnetic field exists around the geomagnetic sensor 1, but in a vehicle,
Generally, there is extra magnetic flux due to magnetization of the body steel plate. Therefore, in order to remove the influence of magnetization of the vehicle body and perform accurate direction detection,
For example, a method disclosed in VJ Publication No. 57-28208@ is proposed. In this method, when the magnetic sensing element is fixed to the vehicle and there is no relative displacement between the two, the center of a circle drawn by plotting the output obtained by rotating the magnetic sensing element once Considering that the distance from the coordinate origin is due to the influence of body magnetization, the output data obtained from the rain detection element is corrected so that the center of the drawn circle moves to the origin, and the body The effect of magnetization is removed. To be more specific, the center Q of the circle drawn by the output of the rain detection element is located at a position moved from the origin, as shown by ■ in FIG. Therefore, the output U of the rain detection element.
■の最大値LIm、Vw及び最小値Un、Vanを求め
、これらから次式(2)によって中心Qの座標を算出す
る。The maximum values LIm, Vw and the minimum values Un, Van of (2) are determined, and the coordinates of the center Q are calculated from these using the following equation (2).
Llo = (LJm+Um)/2
)・・・・・・(2)
Vo=(V鯨+V軸)/2
算出された値Llo、Voを用いて次式(3)によって
各磁気検出素子の出力値U、■の補正がなされ、補正さ
れたU′、V′から方位の算出が行なわれるのである。Llo = (LJm+Um)/2 )......(2) Vo = (V whale + V axis)/2 Using the calculated values Llo and Vo, the output value of each magnetic detection element is determined by the following formula (3). U and (2) are corrected, and the direction is calculated from the corrected U' and V'.
U==U−Ll。U==U−Ll.
) ・・・・・・(3) V−=V−V。) (3) V-=V-V.
また、地磁気センサ1の出力データの信頼性を高めるた
めに、ある規則に基づいて地磁気センサ1の出力データ
の変動を許容する許容範囲(以下、ウィンドウと称する
)を設定す、る。すなわち、第5図に斜線で示すように
、前回求めた方位データ(Un−+、Vn−+)を基準
として角度方向にウィンドウを設定し、前回求めた方位
データと今回求めた方位データとの差を常に監視し、今
回求めた方位データが前回求めた方位データと著しく違
う場合、即ちウィンドウ外となった場合は、そのデータ
をエラーとして所定のデータ、例えば前回のデータ若し
くは過去何回(回数は任意)かのデータの平均値と置換
することにより、地磁気センサ1の出力データの信頼性
を高める。また、地磁気センサ1から出力されるデータ
は数学的には、円の方程式に当てはまるので、この方程
式上にないデータもエラーと判定することができる。し
かし、データはA/DI換誤差等によりばらつくので、
半径方向にもある程度の幅をもたせてウィンドウを設定
している。第5図中、αは角度許容値、βは半径許容値
をそれぞれ示している。Furthermore, in order to increase the reliability of the output data of the geomagnetic sensor 1, a tolerance range (hereinafter referred to as a window) within which variation in the output data of the geomagnetic sensor 1 is allowed is set based on a certain rule. That is, as shown by the diagonal lines in Fig. 5, a window is set in the angular direction based on the previously obtained azimuth data (Un-+, Vn-+), and the azimuth data obtained previously and the azimuth data obtained this time are compared. The difference is constantly monitored, and if the current direction data is significantly different from the previous direction data, that is, if it is outside the window, that data is treated as an error and the data is changed to predetermined data, such as the previous data or the number of times in the past. is optional) By replacing the data with the average value, the reliability of the output data of the geomagnetic sensor 1 is improved. Furthermore, since the data output from the geomagnetic sensor 1 mathematically applies to the equation of a circle, data that does not fit into this equation can also be determined as an error. However, the data varies due to A/DI conversion errors, etc.
The window is set with a certain width in the radial direction as well. In FIG. 5, α represents an angle tolerance, and β represents a radius tolerance.
なお、方位データを求める時間間隔により方位の差は異
なるので、角速麿と車速の関係で求めることも可能であ
る。例えば、車速が40[km/hlのとき、最高角速
痕を30[度/S]とすると、地磁気センサ1の出力デ
ータがこの範囲を越えた場合にエラーとし、前回のデー
タもしくは過去何回かのデータの平均値と置換する。ま
た、角度でウィンドウを設定する場合、車速変化に応じ
て角度を設定することも可能であり、又車速に対して角
度を一次圀数で設定するだけではなく、あるヒステリシ
スを持たせることにより、車速変化に応じて対応角度を
頻繁に変えなくとも済むことになる。Note that since the difference in orientation varies depending on the time interval at which the orientation data is obtained, it is also possible to determine it based on the relationship between the angular velocity and the vehicle speed. For example, if the vehicle speed is 40 [km/hl] and the maximum angular velocity trace is 30 [degrees/S], if the output data of the geomagnetic sensor 1 exceeds this range, it will be considered an error, and Replace with the average value of the data. In addition, when setting the window using an angle, it is also possible to set the angle according to changes in vehicle speed.In addition to setting the angle with a linear number of squares relative to the vehicle speed, it is also possible to set the window with a certain hysteresis. This eliminates the need to frequently change the corresponding angle in response to changes in vehicle speed.
次に、CPLJ7によって実行される本発明による地磁
気センサのデータ処理方法の手順を、第6図のフローチ
ャートに従って説明する。Next, the procedure of the geomagnetic sensor data processing method according to the present invention executed by CPLJ7 will be explained according to the flowchart of FIG.
CPL17は先ず、いわゆる一回転補正が完了している
か否かを判断する(ステップ520)。完了していない
場合は一回転補正ルーチンを実行する(ステップ521
)。この一回転補正ルーチンでは、地磁気センサ1をP
A載した車両を一回転させ、Uo、Vo(センタI)及
び半径rの値が求められる。求められた値はRAM9に
記憶される。The CPL 17 first determines whether so-called one-rotation correction has been completed (step 520). If it has not been completed, execute the one-rotation correction routine (step 521).
). In this one-rotation correction routine, the geomagnetic sensor 1 is
The vehicle carrying A is rotated once, and the values of Uo, Vo (center I), and radius r are determined. The determined value is stored in RAM9.
続いて、初期方位の設定を行なう(ステップ522)。Next, an initial orientation is set (step 522).
エンジン始動時には車両が静止しており、車両の方位は
一定なはずであるから、初期値はこのとき設定するのが
好ましい。初期方位設定後、地磁気センサ1の出力デー
タを取り込み(ステップ823)、この出力データが先
述したウィンドウ(第5図の斜線部分)に入っているか
否かの判断を行なう(ステップ524)。ウィンドウに
入っている場合は、取り込んだ地磁気センタ1の出力デ
ータから先述した(1)〜(3)式に基づいて車両の方
位を計算する(ステップ525)。算出された方位は第
2図のフローチャートにおけるステップS6で、ディス
プレイ12上に地図とともに表示される。続いて、角速
度センサ2の出力データから求められている方位を地磁
気センサ1の出力データから求められている方位に一致
させる(ステップ526)。Since the vehicle is stationary when the engine is started and the orientation of the vehicle should be constant, it is preferable to set the initial value at this time. After setting the initial orientation, the output data of the geomagnetic sensor 1 is taken in (step 823), and it is determined whether or not this output data falls within the aforementioned window (the shaded area in FIG. 5) (step 524). If it is within the window, the direction of the vehicle is calculated based on the above-mentioned equations (1) to (3) from the captured output data of the geomagnetic center 1 (step 525). The calculated direction is displayed together with the map on the display 12 in step S6 in the flowchart of FIG. Subsequently, the azimuth determined from the output data of the angular velocity sensor 2 is matched with the azimuth determined from the output data of the geomagnetic sensor 1 (step 526).
次に、地磁気センサ1の出力データがウィンドウ外にな
った回数をカウントするウィンドウエラーカウンタのカ
ウントwIN及びセンタ値ずれが生じた回数をカウント
するセンタ値ずれ判定カウンタのカウント値Eを共に零
にしくステップ527)、しかる後ステップ823に戻
る。以上の流れは、地磁気センサ1の出力データが外乱
磁界に影響されることなくウィンドウ内に入っている、
通常動作時の流れである。Next, the count wIN of the window error counter, which counts the number of times the output data of the geomagnetic sensor 1 is outside the window, and the count value E, of the center value deviation judgment counter, which counts the number of times the center value deviation has occurred, are both set to zero. Step 527), then return to step 823. The above flow indicates that the output data of the geomagnetic sensor 1 is within the window without being affected by the disturbance magnetic field.
This is the flow during normal operation.
一方、地磁気センサ1の出力データがウィンドウに入っ
ていない場合には、ウィンドウエラーカウンタのカウン
ト値Nを“1″だけカウントアツプしくステップ829
)、続いてそのカウント値Nがウィンドウエラー最大重
Nmに達したか否かを判断する(ステップ530)。そ
して、ウィンドウエラー最大11Nmxに達するまでは
、今回取り込んだ地磁気センサ1の出力データをエラー
と見なし、過去の方位又は角速度センサ2等の補助方位
センサの出力データから求められる方位を利用しくステ
ップ531)、しかる後ステップ823に戻る。On the other hand, if the output data of the geomagnetic sensor 1 does not fit into the window, the count value N of the window error counter is incremented by "1" in step 829.
), then it is determined whether the count value N has reached the maximum window error severity Nm (step 530). Then, until the window error reaches the maximum of 11 Nmx, the output data of the geomagnetic sensor 1 that has been imported this time is regarded as an error, and the direction determined from the past direction or the output data of the auxiliary direction sensor such as the angular velocity sensor 2 is used.Step 531) , and then returns to step 823.
また、ウィンドウエラーカウンタのカウント値Nがウィ
ンドウエラー最大値Nwaに達した場合は、センタ値ず
れカウンタのカウント値Eを1″だけカウントアツプし
くステップ532)、続いてそのカウント値Eがセンタ
iffれ判定最大値E wrxに達したか否かを判断す
る(ステップ533)。Further, when the count value N of the window error counter reaches the window error maximum value Nwa, the count value E of the center value deviation counter is counted up by 1'' (step 532), and then the count value E is It is determined whether the determination maximum value Ewrx has been reached (step 533).
そして、センタ値ずれ判定最大’rNEwに達するまで
は、ある一定時間のタイマをヒツトしくステップ834
)、ステップ835でタイムアツプと判定するまで、地
磁気センサ1の出力データを取り込み(ステップ836
)、そのデータに基づいて方位のi!1 nを行なう(
ステップ537)。すなわち、地磁気センサ1の出力デ
ータがある一定時間ウイントウに入らない場合は、ウィ
ンドウを一時解除し、一定時間エラー処理を行なわない
のである。この処理により、例えば急ハンドル等により
規格外のデータが取り込まれた場合にもこれに対処でき
るのである。Then, in step 834, the timer is set for a certain period of time until the center value deviation judgment maximum 'rNEw is reached.
), the output data of the geomagnetic sensor 1 is captured (step 836) until it is determined that time is up in step 835.
), the direction i! based on that data! 1 Perform n (
step 537). That is, if the output data of the geomagnetic sensor 1 does not fit into the window for a certain period of time, the window is temporarily canceled and error processing is not performed for a certain period of time. Through this processing, it is possible to cope with the case where non-standard data is captured due to, for example, a sudden steering wheel.
以上、地磁気センサ1の出力データがウィンドウに入っ
ていない場合には、このデータから求められる方位の信
頼性が乏しいので、角速度センサ2の出力データから求
められた方位はそのままにしておく。As described above, if the output data of the geomagnetic sensor 1 is not within the window, the reliability of the orientation determined from this data is poor, so the orientation determined from the output data of the angular velocity sensor 2 is left as is.
センタ値ずれカウンタのカウント値Eがセンタ値ずれ判
定最大値EII11xに達した場合は、センタ値ずれと
判断し、他のデータを利用してセンタ値fれを補正しく
ステップ838)、ウィンドウエラーカウンタのカウン
ト値N及びセンタ値ずれ判定カウンタのカウント値Eを
共に零にしくステップ539)、しかる後ステップ82
3に戻る。車両が例えば踏切を通過した場合、踏切にお
ける強力な磁界によって車両ボデーが着磁され、これに
起因して地磁気センサ1の出力データがDC成分を持っ
てしまい、第7図に示す如くセンタ値ずれを生じるので
、それ以降は正しく方位を求めることができなくなって
しまう。このように車両ボデーが着磁されセンタ値ずれ
が生じたような場合、地磁気センサ1の出力データはい
つまでたってもウィンドウに入らないことになるので、
一定時間ウィントウに入らない回数をカウントすること
により、この状態が発生したと判断することができるの
である。そして、このような状態になった場合は、地磁
気センサ1の出力データがDC成分を持っていても、円
の方程式の中心座標が変化するだけで半径rは変化しな
い(地磁気の強さが変化しない限り半径rは変わらない
)ので、他のデータを利用して中心座標を求めることが
でき、よってセンタ値ずれを補正できるのである。When the count value E of the center value deviation counter reaches the center value deviation determination maximum value EII11x, it is determined that the center value deviation has occurred, and the center value f deviation is corrected using other data (step 838), and the window error counter is The count value N of the center value deviation determination counter and the count value E of the center value deviation determination counter are both set to zero (step 539), and then step 82
Return to 3. For example, when a vehicle passes through a railroad crossing, the vehicle body is magnetized by the strong magnetic field at the railroad crossing, which causes the output data of the geomagnetic sensor 1 to have a DC component, resulting in a center value shift as shown in FIG. , so that it is no longer possible to correctly determine the direction. If the vehicle body is magnetized in this way and a center value shift occurs, the output data of the geomagnetic sensor 1 will not fit into the window no matter how long it takes.
By counting the number of times the window does not enter the window for a certain period of time, it can be determined that this state has occurred. In such a situation, even if the output data of the geomagnetic sensor 1 has a DC component, only the center coordinates of the circle equation change and the radius r does not change (the strength of the geomagnetic field changes). (the radius r remains unchanged unless
このセンタ値ずれの補正においては、他のデータとして
例えば角速度センサ2の出力データが用いられる。角速
度センサ2では絶対値は求まらないが、時間軸で積分す
ることにより角度を求めることができるのである。セン
タ値がずれた状態でわかっている値は、地磁気センサ1
の出力データ(Ll、V)、一回転補正により求められ
ている半径r及び角速度センサ2の出力データであり、
これら値は次式(4)の関係となっている。In the correction of this center value deviation, for example, output data of the angular velocity sensor 2 is used as other data. Although the angular velocity sensor 2 cannot determine the absolute value, it can determine the angle by integrating on the time axis. The known value when the center value is shifted is geomagnetic sensor 1.
output data (Ll, V), the radius r determined by one rotation correction, and the output data of the angular velocity sensor 2,
These values have the relationship expressed by the following equation (4).
U=r−3inθ+UO V−r−cosθ+V。U=r-3inθ+UO V−r−cosθ+V.
(4)式の変形により、次式(5)が得られる。By transforming the equation (4), the following equation (5) is obtained.
Uo =U−r −sinθ
Vo =V−r−cosθ
よって、(5)式から現在のセンタ値(Uo、VO)を
求めることができるのである。Uo =Ur-sinθ Vo =Vr-cosθ Therefore, the current center value (Uo, VO) can be obtained from equation (5).
また、角度θを求める他の方法として、現在車両が走行
している道路の角度を地図データを用いて計篩し、この
道路の角度を角度θとすることもできる。すなわち、道
路は2点を結ぶ線(線分)の繋りで表わされ、各点は数
値化されて地図データとして記録媒体10に記憶されて
おり、この地図データから車両が位置する線分の両端(
2点)の値がわかるので、この値から一次関数の傾きを
計篩することにより、角度θを求めることができるので
ある。Further, as another method for determining the angle θ, it is also possible to measure the angle of the road on which the vehicle is currently traveling using map data, and use this road angle as the angle θ. That is, a road is represented by a line (line segment) connecting two points, each point is digitized and stored in the recording medium 10 as map data, and from this map data the line segment where the vehicle is located is determined. Both ends of (
Since the value of point 2) is known, the angle θ can be determined by calculating the slope of the linear function from this value.
続いて、CPLJ7によって実行される本発明による地
磁気セン勺のデータ処理方法の他の実施例の手順を、第
8図及び第9図のフローチャートに従って説明する。Next, the procedure of another embodiment of the geomagnetic sensor data processing method according to the present invention executed by the CPLJ7 will be described with reference to the flowcharts of FIGS. 8 and 9.
CPU7は単位走行距離毎又は中位時間毎に第8図に示
すような割込み処理を行なっている。すなわち、地磁気
センサ1の出力データU、■及び角速度センサ2の出力
データGを取り込み、それぞれ設定されたメモリ(RA
M9)上の配列にセーブするとともに、ポインタ及びカ
ウンタを更新しくステップ540)、続いて地磁気セン
サ1の出力データが先述したウィンドウ(第5図の斜線
部分)に入っているか否かの判断を行なう(ステップ5
41)。ウィンドウに入っている場合は、取り込んだ地
磁気センサ1の出力データから先述した(1)〜(3)
式に基づいて車両の方位を計算する(ステップ542)
。また、ウィンドウに入っている場合には地磁気センサ
1から得られるh位データの信頼性が高いものとし、角
速度センサ2から求められている方位を地磁気センサ1
から求められている方位に一致させる(ステップ543
)。これにより、加速度センサ2から求められる方位の
信頼性を常に地磁気センサ1から求められる方位の信頼
性と同等に維持できることになる。続いて、地磁気セン
サ1の出力データがウィンドウ外になった回数をカウン
トするウィンドウエラーカウンタのカウント値Nを零に
しくステップ544)、割込みルーチンを終了する。The CPU 7 performs interrupt processing as shown in FIG. 8 every unit traveling distance or every intermediate time. That is, the output data U and ■ of the geomagnetic sensor 1 and the output data G of the angular velocity sensor 2 are taken in and stored in the respective set memories (RA
M9) Save in the above array and update the pointer and counter (step 540), then judge whether the output data of the geomagnetic sensor 1 is in the window mentioned above (the shaded area in Fig. 5). (Step 5
41). If it is in the window, perform steps (1) to (3) mentioned above from the output data of the imported geomagnetic sensor 1.
Calculate the vehicle heading based on the formula (step 542)
. In addition, if it is within the window, it is assumed that the reliability of the h position data obtained from the geomagnetic sensor 1 is high, and the direction obtained from the angular velocity sensor 2 is set to the geomagnetic sensor 1.
(step 543).
). As a result, the reliability of the orientation determined by the acceleration sensor 2 can always be maintained at the same level as the reliability of the orientation determined by the geomagnetic sensor 1. Subsequently, the count value N of the window error counter that counts the number of times the output data of the geomagnetic sensor 1 is outside the window is set to zero (step 544), and the interrupt routine is ended.
一方、地磁気センサ1の出力データがウィンドウ内に入
っていない場合には、ウィンドウエラ−カウンタのカウ
ント値Nをインクリメントしくステップ545)、続い
てそのカウント値Nがウィンドウエラー最大値Nmに達
したか否かを判断する(ステップ846)。そして、ウ
ィンドウエラー最大値Nwaに達していない場合には、
過去の方位又は又は角速度センサ2等の補助方位センサ
の出力データから求められる方位を利用しくステップ5
47)、最大値N5axに達した場合には、地磁気セン
サ1の出力データが所定時間連続してウィンドウに入ら
なかったことを監視するための補正フラグをセットしく
ステップ848)、割込みルーチンを終了する。On the other hand, if the output data of the geomagnetic sensor 1 does not fall within the window, the count value N of the window error counter is incremented (step 545), and then the count value N reaches the maximum window error value Nm. It is determined whether or not (step 846). Then, if the window error maximum value Nwa has not been reached,
Step 5: Use the past direction or the direction determined from the output data of the auxiliary direction sensor such as the angular velocity sensor 2.
47) If the maximum value N5ax is reached, set a correction flag to monitor that the output data of the geomagnetic sensor 1 does not fall within the window for a predetermined period of time (Step 848), and end the interrupt routine. .
第9図は、地磁気センサ1及び角速度センサ2の両セン
リ間のデータの相関の検定及び地磁気センサ1の出力デ
ータの補正を行なうためのルーチンであり、本ルーチン
は、一定時間毎又は一定走行距離毎に呼び出されて実行
される。FIG. 9 shows a routine for verifying the correlation between data between the geomagnetic sensor 1 and the angular velocity sensor 2, and correcting the output data of the geomagnetic sensor 1. It is called and executed every time.
CPU7は先ず、上述した補正フラグがセットされてい
るか否かの判断を行ない(ステップ550)、セットさ
れている場合には、地磁気センサ1及び角速度センサ2
の生データU、■及びGから検定のためのデータの演粋
を行なう〈ステップ$51)。この演算では、角速度セ
ンサ2の出力データGは、地磁気センサ1の出力データ
のセンタ値Llo、Vo及び円の半径rを用い、次式で
X。The CPU 7 first determines whether or not the above-mentioned correction flag is set (step 550), and if it is set, the geomagnetic sensor 1 and the angular velocity sensor 2
Data extraction for verification is performed from the raw data U, ■, and G (step $51). In this calculation, the output data G of the angular velocity sensor 2 is expressed as X using the following equation using the center values Llo and Vo of the output data of the geomagnetic sensor 1 and the radius r of the circle.
Y座標系に変換される。Converted to Y coordinate system.
Qx−r−CO3(G)+VO Gy= r−sin(G)+U。Qx-r-CO3(G)+VO Gy=r-sin(G)+U.
これにより、角速度センサ2の出力データが地磁気セン
サ1の出力データの座標系に変換され、通常状態では、
U=Gy、V=Gxとなっている。As a result, the output data of the angular velocity sensor 2 is converted into the coordinate system of the output data of the geomagnetic sensor 1, and in the normal state,
U=Gy, V=Gx.
ここで、車両ボデーがi4されたような場合、第10図
に示すように、地磁気センサ1の出力データは着磁ベク
トルの分だけ平行移動した半径rの円周上に分布するよ
うになる。このため、通常のデータ処理を行なったので
は、誤った方位が検出されることになる。Here, when the vehicle body is moved i4, as shown in FIG. 10, the output data of the geomagnetic sensor 1 will be distributed on the circumference of the radius r that has been translated in parallel by the magnetization vector. Therefore, if normal data processing is performed, an incorrect direction will be detected.
そこで、次のステップ852では、予め定められたリン
プル数n組のデータに関して、X軸方向の変位X d
(i) = V (i)−G x (i)の標準偏差(
7Uを求める。そして、この標準偏差σUと所定の設定
値σthとの比較を行ない(ステップ553)、設定値
σth以内の場合には、次のステップ854に進む。こ
こでは、Y軸方向の変位Yd(i) =U(i)−G
y(i)の標準偏差σVを求める。そして、この標準偏
差σVと所定設定値σthとの比較を行ない(ステップ
555)、設定値σth以内の場合には、センタ値Uo
、Voを推定値Uon 、V。Therefore, in the next step 852, the displacement in the X-axis direction
(i) = V (i) - Standard deviation of G x (i) (
Find 7U. Then, this standard deviation σU is compared with a predetermined set value σth (step 553), and if it is within the set value σth, the process proceeds to the next step 854. Here, the displacement in the Y-axis direction Yd(i) = U(i) - G
Find the standard deviation σV of y(i). Then, this standard deviation σV is compared with a predetermined set value σth (step 555), and if it is within the set value σth, the center value Uo
, Vo as the estimated value Uon , V.
。に更新しくステップ856)続いて補正フラグをリセ
ットする(ステップ557)。以降、更新されたセンタ
値Uo、Voを用いて車両方位の計惇が行なわれる。標
+1!偏差σU、σVが設定値内に入らない場合は、デ
ータが更新されて設定値に入るようになるまで、このル
ーチンが繰り返される。. (Step 856) Then, the correction flag is reset (Step 557). Thereafter, the vehicle direction is calculated using the updated center values Uo and Vo. Mark +1! If the deviations σU and σV do not fall within the set values, this routine is repeated until the data is updated so that they fall within the set values.
R1目と1里
以上説明したように、本発明によれば、地磁気センサの
出力データの変動を許容する許容範囲を設定し、地磁気
センサの出力データが所定時間連続してこの許容範囲内
に入らないときは、所定のデータに基づいて地磁気セン
サの出力データの補正を行なうことにより、地磁気セン
サが外乱を受は続けた場合、或は踏切通過などにより車
両ボデーが着磁したような場合でも、その外乱の影響を
耕除して信頼性の^い方位データの信頼性を得ることが
できるので、より正確に車両方位を検出でき、精度の良
いナビゲーシヨンを実現することが可能となる。As explained above, according to the present invention, a tolerance range is set in which fluctuations in the output data of the geomagnetic sensor are allowed, and the output data of the geomagnetic sensor is not continuously within this tolerance range for a predetermined period of time. If not, by correcting the output data of the geomagnetic sensor based on predetermined data, even if the geomagnetic sensor continues to receive disturbances or the vehicle body becomes magnetized due to passing through a railroad crossing, etc. Since reliable azimuth data can be obtained by eliminating the influence of the disturbance, it is possible to detect the vehicle direction more accurately and realize highly accurate navigation.
第1図は本発明による地磁気センサの、データ処理方法
が適用される車載ブビゲーシコン装置の構成を示すブロ
ック図、第2図及び第3図は第1図におけるCPUによ
って実行される基本的な手順を示すフローチャート、第
4図は地磁気センサの出力データが描く軌跡を示す線図
、第5図は地磁気センサの出力データが描く軌跡にウィ
ンドウを設定した状態を示す線図、第6図は第1図にお
けるCPUによって実行される本発明による地磁気セン
サのデータ処理方法の手順を示す70−ヂヤート、第7
図は地磁気センサの出力データが描く軌跡がセンタ値ず
れを生じた状態を示す線図、第8図及び第9図はCPU
によって実行される本発明による地磁気センサのデータ
処理方法の他の実施例の手順を示すフローチャート、第
10図は車両ボデーの着磁によって地磁気センサの出力
データが描く軌跡が着磁ベクトルの分だけずれた状態を
示す線図である。
主要部分の符号の説明FIG. 1 is a block diagram showing the configuration of an in-vehicle video game controller to which the data processing method of the geomagnetic sensor according to the present invention is applied, and FIGS. 2 and 3 show the basic steps executed by the CPU in FIG. 1. 4 is a line diagram showing the locus drawn by the output data of the geomagnetic sensor, Fig. 5 is a line diagram showing the state in which a window is set on the locus drawn by the output data of the geomagnetic sensor, and Fig. 6 is a line diagram showing the locus drawn by the output data of the geomagnetic sensor. 70-D, No. 7 showing the steps of the data processing method of the geomagnetic sensor according to the present invention executed by the CPU in
The figure is a diagram showing the state in which the locus drawn by the output data of the geomagnetic sensor has a center value deviation, and Figures 8 and 9 are for the CPU.
FIG. 10 is a flowchart showing the procedure of another embodiment of the geomagnetic sensor data processing method according to the present invention, which is executed by FIG. Explanation of symbols of main parts
Claims (3)
位データを出力する地磁気センサのデータ処理方法であ
つて、前記地磁気センサの出力データの変動を許容する
許容範囲を設定し、前記地磁気センサの出力データが所
定時間連続して前記許容範囲内に入らないときは、所定
のデータに基づいて前記地磁気センサの出力データの補
正を行なうことを特徴とする地磁気センサのデータ処理
方法。(1) A data processing method for a geomagnetic sensor mounted on a vehicle and outputting azimuth data of the vehicle based on geomagnetism, the geomagnetic sensor A data processing method for a geomagnetic sensor, characterized in that when the output data of the geomagnetic sensor does not fall within the permissible range for a predetermined period of time, the output data of the geomagnetic sensor is corrected based on predetermined data.
る角速度センサの出力データであることを特徴とする特
許請求の範囲第1項記載の地磁気センサのデータ処理方
法。(2) The geomagnetic sensor data processing method according to claim 1, wherein the predetermined data is output data of an angular velocity sensor that detects the angular velocity of the vehicle.
とも前後2点の位置を示す地図データであることを特徴
とする特許請求の範囲第1項記載の地磁気センサのデー
タ処理方法。(3) The data processing method for a geomagnetic sensor according to claim 1, wherein the predetermined data is map data indicating at least two positions in front and behind where the vehicle is located.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP15570186 | 1986-07-01 | ||
JP61-155701 | 1986-07-01 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPS63158408A true JPS63158408A (en) | 1988-07-01 |
Family
ID=15611625
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP25922286A Pending JPS63158408A (en) | 1986-07-01 | 1986-10-30 | Processing method of data of geomagnetism sensor |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS63158408A (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6081230A (en) * | 1994-11-29 | 2000-06-27 | Xanavi Informatics Corporation | Navigation system furnished with means for estimating error of mounted sensor |
CN108091144A (en) * | 2018-01-22 | 2018-05-29 | 迈锐数据(北京)有限公司 | Vehicle speed measuring method and device based on single geomagnetism detecting device |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS58139875A (en) * | 1982-02-12 | 1983-08-19 | Nippon Soken Inc | Detector for traveling azimuth of vehicle |
JPS59104509A (en) * | 1982-12-06 | 1984-06-16 | Mitsubishi Electric Corp | On-vehicle bearing sensor |
JPS6089300A (en) * | 1983-10-21 | 1985-05-20 | 三菱電機株式会社 | Running information display |
JPS6290508A (en) * | 1985-10-17 | 1987-04-25 | Hitachi Ltd | Direction detector of moving body |
-
1986
- 1986-10-30 JP JP25922286A patent/JPS63158408A/en active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS58139875A (en) * | 1982-02-12 | 1983-08-19 | Nippon Soken Inc | Detector for traveling azimuth of vehicle |
JPS59104509A (en) * | 1982-12-06 | 1984-06-16 | Mitsubishi Electric Corp | On-vehicle bearing sensor |
JPS6089300A (en) * | 1983-10-21 | 1985-05-20 | 三菱電機株式会社 | Running information display |
JPS6290508A (en) * | 1985-10-17 | 1987-04-25 | Hitachi Ltd | Direction detector of moving body |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6081230A (en) * | 1994-11-29 | 2000-06-27 | Xanavi Informatics Corporation | Navigation system furnished with means for estimating error of mounted sensor |
CN108091144A (en) * | 2018-01-22 | 2018-05-29 | 迈锐数据(北京)有限公司 | Vehicle speed measuring method and device based on single geomagnetism detecting device |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US4890233A (en) | Vehicle bearing detection and data processing methods applicable to vehicle navigation system | |
US4831563A (en) | Method of processing output data from geomagnetic sensor | |
EP2519803B1 (en) | Technique for calibrating dead reckoning positioning data | |
US5742923A (en) | Method of correcting distance error of navigation apparatus and navigation apparatus | |
JPH0555806B2 (en) | ||
US6766247B2 (en) | Position determination method and navigation device | |
JPH05172575A (en) | Navigation equipment | |
JPH0216446B2 (en) | ||
JPH05113342A (en) | Navigation apparatus | |
JP4316820B2 (en) | On-vehicle navigation device and direction measuring method | |
JP2870258B2 (en) | Magnetization correction method for geomagnetic bearing sensor | |
JPS63158408A (en) | Processing method of data of geomagnetism sensor | |
JP4376738B2 (en) | Apparatus and method for detecting zero point error of angular velocity sensor | |
JPS63113309A (en) | Method for processing data of earth magnetism sensor | |
JP2723352B2 (en) | In-vehicle navigation system | |
JPH11230772A (en) | On-vehicle navigation equipment | |
JP2677390B2 (en) | Vehicle azimuth correction device | |
JP3596939B2 (en) | Current position calculation device | |
JPS63109313A (en) | Method for detecting azimuth of vehicle | |
JPH05312933A (en) | Navigation system | |
JPH0543257B2 (en) | ||
JPH03154820A (en) | Vehicle position detector | |
JPS6311810A (en) | Processing of output data for earth magnetism sensor | |
JPS63109317A (en) | Data processor of earth magnetism sensor | |
JPS63113308A (en) | Method for processing data of earth magnetism sensor |