JPH0694471A - Navigation system - Google Patents

Navigation system

Info

Publication number
JPH0694471A
JPH0694471A JP4246741A JP24674192A JPH0694471A JP H0694471 A JPH0694471 A JP H0694471A JP 4246741 A JP4246741 A JP 4246741A JP 24674192 A JP24674192 A JP 24674192A JP H0694471 A JPH0694471 A JP H0694471A
Authority
JP
Japan
Prior art keywords
current position
self
navigation
radio
position determined
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.)
Granted
Application number
JP4246741A
Other languages
Japanese (ja)
Other versions
JP3164659B2 (en
Inventor
Yoshiyuki Kobayashi
禎之 小林
Zenichi Hirayama
善一 平山
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
ZANABUI INFUOMATEIKUSU KK
Original Assignee
ZANABUI INFUOMATEIKUSU KK
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 ZANABUI INFUOMATEIKUSU KK filed Critical ZANABUI INFUOMATEIKUSU KK
Priority to JP24674192A priority Critical patent/JP3164659B2/en
Priority to US08/122,867 priority patent/US5422639A/en
Publication of JPH0694471A publication Critical patent/JPH0694471A/en
Application granted granted Critical
Publication of JP3164659B2 publication Critical patent/JP3164659B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)
  • Traffic Control Systems (AREA)
  • Instructional Devices (AREA)

Abstract

PURPOSE:To correct a self-navigation device when the self-navigation device makes an error in position measurement. CONSTITUTION:A position correction processing part 5 selectively outputs the measurement position determined by a self-navigation processing part 4 as an output present position when the flag from the self-navigation processing part 4 shows that the measurement position of the self-navigation processing part is situated on or near a road in road map information. In other cases, the distance between the measurement position determined by a radio navigation processing part 1 and the measurement position determined by the self- navigation processing part 4 is calculated, and when the distance between the two coordinates is a determined value or more, the measurement position determined by the radio navigation processing part 1 is taken as the present position, and the traveling start coordinate managed by the self-navigation processing part 4 is corrected to the determined present position.

Description

【発明の詳細な説明】Detailed Description of the Invention

【0001】[0001]

【産業上の利用分野】本発明は、自動車等の移動体用航
法装置(ナビゲーション装置)における位置測定の技術
に関するものである。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a technique for position measurement in a navigation system for a mobile body such as an automobile.

【0002】[0002]

【従来の技術】従来の自動車用航法装置における位置測
定の技術としては、特開平1−316607号公報に記
載の航法装置が知られている。
2. Description of the Related Art As a conventional technique for position measurement in a navigation system for a vehicle, a navigation system disclosed in Japanese Patent Laid-Open No. 1-316607 is known.

【0003】この航法装置は、人口衛星よりの電波を利
用して自身の位置の測定を行う電波航法装置と、各種セ
ンサと道路地図情報等を用いて自身の位置の測定を行う
自立航法装置とを有し、電波航法装置が求めた測定位置
と自立航法装置が求めた測定位置との差が予め定めた値
を越えた場合には、自立航法装置による測定結果または
自立航法装置による測定結果を所定のフィルタで処理し
た結果を位置の推定値として電波航法装置による測定値
のオフセットを補正し、逆に、前記差が予め定められた
値を越えない場合には、電波航法装置による測定結果ま
たは、電波航法装置による測定結果を所定のフィルタで
処理した結果を位置の推定値として自立航法装置による
測定値のドリフトを補正する。
This navigation device includes a radio navigation device that measures its own position by using radio waves from artificial satellites, and a self-contained navigation device that measures its own position by using various sensors and road map information. If the difference between the measurement position obtained by the radio navigation device and the measurement position obtained by the self-contained navigation device exceeds a predetermined value, the measurement result by the self-contained navigation device or the measurement result by the self-contained navigation device is Correct the offset of the measurement value by the radio navigation device using the result of processing with a predetermined filter as the estimated value of the position, and conversely, if the difference does not exceed the predetermined value, the measurement result by the radio navigation device or The drift of the measurement value by the self-contained navigation device is corrected by using the result obtained by processing the measurement result by the radio navigation device by a predetermined filter as an estimated value of the position.

【0004】[0004]

【発明が解決しようとする課題】特開平1−31660
7号公報記載の航法装置によれば、電波航法装置が求め
た測定位置と自立航法装置が求めた測定位置との差が予
め定めた値を越えた場合には、自立航法装置による測定
結果を重視し、前記差が予め定められた値を越えない場
合には、電波航法装置による測定結果を重視する。
DISCLOSURE OF THE INVENTION Problems to be Solved by the Invention
According to the navigation device described in Japanese Patent Publication No. 7, when the difference between the measurement position obtained by the radio navigation device and the measurement position obtained by the self-contained navigation device exceeds a predetermined value, the measurement result by the self-contained navigation device is displayed. If the difference does not exceed a predetermined value, the measurement result by the radio navigation device is emphasized.

【0005】このため、たとえば、地理的な要因等によ
り電波航法装置による位置測定が利用できずに、自立航
法装置だけを用いて走行している期間中に、自立航法装
置による測定位置が間違ってしまった場合等には次のよ
うな問題が生じる。
For this reason, for example, the position measurement by the radio navigation device cannot be used due to geographical factors, etc., and the position measured by the self-contained navigation device is erroneous during the period of traveling only by the self-contained navigation device. If it happens, the following problems will occur.

【0006】すなわち、この場合、その後、電波航法装
置による位置測定が再開されたときには電波航法装置に
よる測定位置と自立航法装置による測定位置との差が、
予め定められた値を越えてしまうが、このとき、前記装
置は、自立航法装置による測定結果を重視して、電波航
法装置による測定値のオフセットを誤って補正してしま
うため、正確な位置測定動作に復帰できないという問題
があった。
That is, in this case, when the position measurement by the radio navigation device is resumed thereafter, the difference between the measurement position by the radio navigation device and the measurement position by the self-contained navigation device is
Although it exceeds a predetermined value, at this time, since the device attaches importance to the measurement result by the self-contained navigation device and erroneously corrects the offset of the measurement value by the radio navigation device, accurate position measurement is performed. There was a problem that it could not return to operation.

【0007】そこで、本発明は、多様な状況下において
も、より正確に位置の測定を行うことのできる航法装置
を提供することを目的とする。
Therefore, it is an object of the present invention to provide a navigation device capable of more accurately measuring a position even under various circumstances.

【0008】[0008]

【課題を解決するための手段】前記目的達成のために、
本発明は、移動体上に搭載され、移動体の現在位置を出
力する航法装置であって、人工衛星よりの電波に基づい
て移動体の現在位置を測定する電波航法手段と、角速度
もしくは地磁気角度のうちの少なくとも一方に基づいて
移動体の進行方位を計測する方位計測手段と、移動体の
走行距離を計測する距離計測手段と、道路地図情報を記
憶する記憶手段と、与えられた走行始点位置から現在に
至るまでの間に前記方位計測手段が計測した進行方位と
前記距離計測手段が計測した走行距離とを用いて、移動
体の仮現在位置もしくは走行来歴を求め、求めた仮現在
位置もしくは走行来歴を前記記憶手段から読み出した前
記道路地図情報と照合し、移動体の現在位置を決定する
自立航法手段と、前記自立航法手段が決定した現在位置
と前記電波航法手段が決定した現在位置とが所定距離以
上離れていない場合に、前記自立航法手段が決定した現
在位置を最終的な現在位置として出力し、所定距離以上
離れている場合に、前記電波航法手段が決定した最終的
な現在位置を出力すると共に、前記自立航法手段に、前
記電波航法手段が決定した現在位置を新たな走行始点と
して与える位置修正手段とを有することを特徴とする航
法装置を提供する。
[Means for Solving the Problems] To achieve the above object,
The present invention is a navigation device that is mounted on a moving body and outputs the current position of the moving body, and a radio navigation means that measures the current position of the moving body based on radio waves from an artificial satellite, and an angular velocity or a geomagnetic angle. Direction measuring means for measuring the traveling direction of the moving body based on at least one of the following, distance measuring means for measuring the traveling distance of the moving body, storage means for storing road map information, and given traveling start point position From the present to the present, using the traveling azimuth measured by the azimuth measuring means and the traveling distance measured by the distance measuring means, the provisional present position or traveling history of the moving body is obtained, and the obtained provisional present position or Self-contained navigation means for determining the current position of the moving body by collating the travel history with the road map information read out from the storage means, and the current position and the radio navigation operator determined by the self-contained navigation means. When the current position determined by is not separated by a predetermined distance or more, the current position determined by the self-contained navigation means is output as the final current position, and when it is separated by a predetermined distance or more, the radio navigation means is determined. In addition to outputting the final current position, the navigation device is provided with position correction means for providing the self-contained navigation means with the current position determined by the radio navigation means as a new traveling start point.

【0009】なお、望ましくは、移動体の走行速度を測
定する走行速度測定手段を備え、かつ、前記電波航法手
段は、人工衛星よりの電波に基づいて移動体の移動方向
をも測定し、前記位置修正手段が、前記電波航法手段が
決定した最終的な現在位置を出力すると共に、前記自立
航法手段に、前記電波航法手段が決定した現在位置を新
たな走行始点として与える場合に、前記走行速度測定手
段が測定した走行速度が、所定値以上か否かを判定し、
所定値以上であった場合に、前記電波航法手段が測定し
た移動体の移動方向を現進行方位として、前記方位計測
手段を補正する方位修正手段を備えるようにするのがよ
い。
Desirably, the vehicle is equipped with traveling speed measuring means for measuring the traveling speed of the moving body, and the radio navigation means also measures the moving direction of the moving body on the basis of radio waves from an artificial satellite. When the position correction means outputs the final current position determined by the radio navigation means and gives the self-contained navigation means the current position determined by the radio navigation means as a new traveling start point, the traveling speed The traveling speed measured by the measuring means determines whether or not a predetermined value or more,
When the value is equal to or more than a predetermined value, it is preferable to include an azimuth correcting unit that corrects the azimuth measuring unit with the moving direction of the moving body measured by the radio navigation unit as the current traveling azimuth.

【0010】[0010]

【作用】本発明に係る位置修正手段は、電波航法による
位置と自立航法による位置のずれを判定し自立航法の位
置を修正し、航法装置の位置誤差が所定距離未満になる
ようにする。また、望ましくは、電波航法による位置と
自立航法による位置のずれ、および、自立航法と道路地
図情報との関係、および、自立航法による位置の来歴か
ら判断する自立航法の正確さを判定し自立航法の位置を
修正することにより、道路地図情報にある道路を走行し
ているときは、航法装置の位置誤差が走行距離に対する
位置の誤差以内にあり、それ以外の道路を走行したとき
は所定距離未満になるようにする。また、望ましくは、
電波航法による位置と自立航法による位置のずれ、およ
び、自立航法と道路地図情報との関係、および、自立航
法による位置の来歴から判断する自立航法の正確さを判
定し自立航法の位置を修正し、道路地図情報にある道路
を走行しているときでも間違った位置を示している可能
性が高いときは航法装置の位置誤差が所定距離未満にな
るようにする。また、のぞましくは、電波航法による位
置の来歴から電波航法の正確さをも合わせて判定し自立
航法の位置を修正すれば、電波航法の誤りから間違った
位置に修正することがなくなるようにすることができ
る。
The position correcting means according to the present invention corrects the position of the self-contained navigation by judging the deviation between the position of the radio navigation and the position of the self-contained navigation so that the position error of the navigation device becomes less than the predetermined distance. In addition, it is desirable to determine the accuracy of the self-contained navigation determined from the deviation between the position by radio navigation and the position by self-contained navigation, the relationship between self-contained navigation and road map information, and the history of the position by self-contained navigation. By correcting the position of, the position error of the navigation device is within the position error with respect to the travel distance when traveling on the road indicated in the road map information, and less than the predetermined distance when traveling on other roads. Try to be. Also, preferably,
Correct the position of self-contained navigation by judging the deviation between the position by radio navigation and the position by self-contained navigation, the relationship between self-contained navigation and road map information, and the accuracy of self-contained navigation judged from the history of position by self-contained navigation. The position error of the navigation device is set to be less than the predetermined distance when there is a high possibility that the wrong position is indicated even when traveling on the road indicated by the road map information. Also, it is desirable to correct the position of self-contained navigation by judging the accuracy of the radio navigation from the position history of the radio navigation and correct the position of the self-contained navigation so that it will not be corrected to the wrong position. Can be

【0011】一方、方位修正手段は、自立航法の位置を
修正したときに合わせて移動体の進行方位を修正し、自
立航法の走行始点を修正した後の自立航法の精度を高め
る。
On the other hand, the azimuth correcting means corrects the traveling azimuth of the moving body in time when the position of the self-contained navigation is corrected, and improves the accuracy of the self-contained navigation after correcting the traveling start point of the self-contained navigation.

【0012】[0012]

【実施例】以下、本発明に係る航法装置の実施例を、自
動車に搭載する場合を例にとり説明する。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS An embodiment of the navigation device according to the present invention will be described below by taking it as an example when it is mounted on an automobile.

【0013】まず、本発明に係る航法装置の第1の実施
例を説明する。
First, a first embodiment of the navigation system according to the present invention will be described.

【0014】図1に、本第1実施例に係る航法装置の構
成を示す。
FIG. 1 shows the configuration of the navigation system according to the first embodiment.

【0015】図中、1は電波航法処理部であり、人工衛
星(図示せず)の信号により三角測量の技術を利用して
現在位置(Gx,Gy)を決定する。2は方位計測処理
部であり、角速度センサ(図示せず)からの角速度デー
タ、あるいは、地磁気センサ(図示せず)からの地磁気
データ、あるいは、両方のセンサからのデータを用いて
車両の進行方位を演算し出力する。3は距離計測処理部
であり、距離センサ(図示せず)から入力するパルスに
基づいて車両の走行距離を計測し出力する。
In the figure, reference numeral 1 is a radio-navigation processing unit, which determines a current position (Gx, Gy) by using a triangulation technique based on a signal from an artificial satellite (not shown). Reference numeral 2 denotes an azimuth measurement processing unit, which uses angular velocity data from an angular velocity sensor (not shown), geomagnetic data from a geomagnetic sensor (not shown), or data from both sensors to detect the traveling direction of the vehicle. Is calculated and output. A distance measurement processing unit 3 measures and outputs the traveling distance of the vehicle based on a pulse input from a distance sensor (not shown).

【0016】また、4は自立航法処理部であり、手動あ
るいは自動的に設定されたある走行始点を管理し、この
走行始点からの距離計測処理部2の距離データおよび方
位計測処理部3の方位データを積分し、現在の推測位置
を演算するとともに、推測位置もしくは推測位置を終点
とする現在までの走行来歴を、記憶装置(図示せず)か
ら読み出した道路地図情報と照合して測定位置(Mx,
My)を決定する。
Reference numeral 4 denotes a self-contained navigation processing unit, which manages a certain traveling start point set manually or automatically, and the distance data of the distance measurement processing unit 2 and the azimuth of the azimuth measurement processing unit 3 from this traveling start point. The data is integrated to calculate the current estimated position, and the estimated position or the driving history up to the present with the estimated position as the end point is compared with the road map information read from the storage device (not shown) to measure the position ( Mx,
My) is determined.

【0017】5は、位置修正処理部であり、電波航法処
理部1による位置(Gx,Gy)と自立航法処理部4に
よる位置(Mx,My)とを入力し、所定の判定方法に
基づき位置(Gx,Gy)または位置(Mx,My)を
出力現在位置(X,Y)として選択出力する。また、電
波航法処理部1による位置(Gx,Gy)を出力現在位
置(X,Y)として選択したとき、自立航法処理部4の
管理する走行始点を出力現在位置(X,Y)により更新
する。
Reference numeral 5 denotes a position correction processing unit which inputs the position (Gx, Gy) by the radio navigation processing unit 1 and the position (Mx, My) by the self-contained navigation processing unit 4 and inputs the position based on a predetermined determination method. (Gx, Gy) or position (Mx, My) is selectively output as the output current position (X, Y). Further, when the position (Gx, Gy) by the radio navigation processing unit 1 is selected as the output current position (X, Y), the traveling start point managed by the self-contained navigation processing unit 4 is updated by the output current position (X, Y). .

【0018】次に、本第1実施例に係る航法装置の動作
を説明する。
Next, the operation of the navigation system according to the first embodiment will be described.

【0019】まず、図2に、本第1実施例に係る航法装
置の位置修正処理部5の行う処理手順を示す。
First, FIG. 2 shows a processing procedure performed by the position correction processing section 5 of the navigation device according to the first embodiment.

【0020】図示するように、位置修正処理部5は、処
理S1で、電波航法処理部1において現在位置(Gx,
Gy)が求められたかどうか判定し、現在位置(Gx,
Gy)が求められていれば処理S2に進み、現在位置
(Gx,Gy)が求められていなければ処理S3に進
む。
As shown in the figure, the position correction processing unit 5 performs the process S1 in the radio navigation processing unit 1 at the current position (Gx,
Gy) is determined, and the current position (Gx,
If Gy) is obtained, the process proceeds to step S2, and if the current position (Gx, Gy) is not obtained, the process proceeds to step S3.

【0021】そして、処理S2では、電波航法処理部1
による位置(Gx,Gy)と自立航法処理部4による位
置(Mx,My)との間の距離を計算し、2つの座標の
間の距離が所定値α以上と判定されたときは処理S4に
進み、所定値α未満と判定されたときは処理S3に進
む。
Then, in step S2, the radio navigation processing section 1
The position (Gx, Gy) by the self-contained navigation processing unit 4 and the position (Mx, My) by the self-contained navigation processing unit 4 are calculated. If it is determined that the value is less than the predetermined value α, the process proceeds to step S3.

【0022】一方、処理S3では、自立航法処理部4に
よる位置(Mx,My)を出力現在位置(X,Y)とし
て選択出力し、一連の処理を終了する。
On the other hand, in the process S3, the position (Mx, My) by the self-contained navigation processing unit 4 is selectively output as the output current position (X, Y), and the series of processes is ended.

【0023】処理S4では、電波航法処理部1が求めた
(Gx,Gy)を出力現在位置(X,Y)として選択出
力し、処理S5に進み、自立航法処理部4の管理する自
立航法の走行始点座標を処理S4で選択した位置(X,
Y)で修正し新たな走行始点とし、一連の処理を終了す
る。
In step S4, (Gx, Gy) obtained by the radio navigation processing section 1 is selected and output as the output current position (X, Y), and the procedure proceeds to step S5, in which the self-contained navigation controlled by the self-contained navigation processing section 4 is executed. The position (X,
The correction is made in Y) and a new traveling start point is set, and a series of processing is ended.

【0024】さて、このような処理手順によって、本第
1実施例に係る航法装置の位置測定動作は次のようにな
る。
By the above processing procedure, the position measuring operation of the navigation system according to the first embodiment is as follows.

【0025】図3に、本第1実施例に係る航法装置の動
作例を示す。
FIG. 3 shows an operation example of the navigation device according to the first embodiment.

【0026】図3において、Giは電波航法処理部1が
求めた(Gx,Gy)を表し、Miは自立航法処理部4
が求めた(Mx,My)を表す。また、i(i=1,
2,・・・,n)は時刻に対応する位置を表す。実線は
実際の走行軌跡を表し、点線は航法装置による走行軌跡
を表す。
In FIG. 3, Gi represents (Gx, Gy) obtained by the radio navigation processing unit 1, and Mi represents the self-contained navigation processing unit 4.
Represents (Mx, My). Also, i (i = 1,
2, ..., N) represent the position corresponding to the time. The solid line represents the actual travel path, and the dotted line represents the travel path by the navigation device.

【0027】まず、i=1の地点ではG1,M1間の距離
1は所定値α未満であるため自立航法処理部4によっ
て求めた位置(Mx1,My1)を出力現在位置(X1
1)として出力する。
Firstly, i = G 1 is 1 point, the distance d 1 between M 1 is outputted current position the position obtained by autonomous navigation processing unit 4 for less than the predetermined value α (Mx 1, My 1) ( X 1 ,
Output as Y 1 ).

【0028】次に、i=2の地点は電波航法処理部1が
求めた(Gx,Gy)が求められていないため、自立航
法処理部2によって求めた位置(Mx2,My2)を出力
現在位置(X2,Y2)として出力する。
Next, at the point of i = 2, since the (Gx, Gy) obtained by the radio navigation processing unit 1 is not obtained, the position (Mx 2 , My 2 ) obtained by the self-contained navigation processing unit 2 is output. Output as the current position (X 2 , Y 2 ).

【0029】また、i=3の地点ではG3,M3間の距離
3は所定値α以上であるため、電波航法処理部1によ
って求めた入力位置(Gx3,Gy3)を出力現在位置
(X3,Y3)として出力し、同時に自立航法処理部2の
管理する走行始点位置(Mx3,My3)を位置(X3
3)で修正し新たな走行始点とする。すなわち、自立
航法は位置M3aの位置から再出発することになる。
Further, since the point i = 3 is a distance d 3 between the G 3, M 3 is equal to or higher than the predetermined value alpha, the input position determined by radio navigation unit 1 (Gx 3, Gy 3) an output current The position (X 3 , Y 3 ) is output, and at the same time, the traveling start point position (Mx 3 , My 3 ) managed by the self-contained navigation processing unit 2 is calculated as the position (X 3 ,
Correct with Y 3 ) and make a new starting point. That is, the self-contained navigation will restart from the position of the position M 3 a.

【0030】この結果、自立航法処理部4の現在までの
測定誤りは成分を解消され、i=4の地点ではG4,M4
間の距離d4は所定値α未満となり、出力現在位置
(X4,Y4)として、自立航法処理部4が求めた(Mx
4,My4)を出力する。
As a result, the component of the measurement error up to the present in the self-contained navigation processing unit 4 has been eliminated, and G 4 and M 4 at the point of i = 4.
The distance d 4 between them becomes less than the predetermined value α, and the self-contained navigation processing unit 4 obtains the output current position (X 4 , Y 4 ) (Mx
4 , My 4 ) is output.

【0031】このように、実際の走行軌跡と自立航法に
よる走行軌跡がずれていても(方位計測処理部による車
両の進行方位がずれていても)航法装置の位置誤差を所
定距離未満に収束させることができる。
As described above, even if the actual traveling locus and the traveling locus by the self-contained navigation are deviated (even if the traveling azimuth of the vehicle is deviated by the azimuth measurement processing unit), the position error of the navigation device is converged to less than the predetermined distance. be able to.

【0032】なお、所定値αは固定値としてもよく、ま
た、何らかのパラメータに対応して変化する可変値とし
てもよい。
The predetermined value α may be a fixed value or a variable value that changes according to some parameter.

【0033】以下、本発明に係る航法装置の第2の実施
例を説明する。
A second embodiment of the navigation system according to the present invention will be described below.

【0034】次に、第2の実施例を図4、図5にて説明
する。
Next, a second embodiment will be described with reference to FIGS.

【0035】図4に、本第2実施例に係る航法装置の構
成を示す。図示するように、本第2実施例に係る航法装
置の構成は、前述した第1実施例に係る航法装置の構成
(図1参照)において、自立航法処理部2からフラグを
出力するようにしたものである。このフラグは、自立航
法処理部4で測定した位置(Mx,My)が道路地図情
報における道路上またはその近傍に在るときは値を1、
無いときは0を示すフラグであり、自立航法処理部4
が、測定した位置(Mx,My)と前記道路地図情報と
を比較することにより生成する。
FIG. 4 shows the structure of the navigation system according to the second embodiment. As shown in the figure, in the configuration of the navigation device according to the second embodiment, in the configuration of the navigation device according to the first embodiment (see FIG. 1), the self-contained navigation processing unit 2 outputs a flag. It is a thing. This flag has a value of 1 when the position (Mx, My) measured by the self-contained navigation processing unit 4 is on or near the road in the road map information,
When there is no flag, the flag indicates 0, and the self-contained navigation processing unit 4
Is generated by comparing the measured position (Mx, My) with the road map information.

【0036】次に、本第2実施例に係る航法装置の動作
を説明する。
Next, the operation of the navigation system according to the second embodiment will be described.

【0037】図5に、本第2実施例に係る位置修正処理
部5の行う処理の処理手順を示す。
FIG. 5 shows a processing procedure of processing performed by the position correction processing unit 5 according to the second embodiment.

【0038】図示するように、位置修正処理部5は、電
波航法処理部1において現在位置(Gx,Gy)が求め
られたかどうか判定し、現在位置(Gx,Gy)が求め
られていれば処理S6に進み、現在位置(Gx,Gy)
が求められていなければ処理S3に進む。
As shown in the figure, the position correction processing unit 5 determines whether or not the current position (Gx, Gy) has been obtained by the radio navigation processing unit 1, and if the current position (Gx, Gy) has been obtained, the processing is performed. Proceed to S6, current position (Gx, Gy)
If is not required, the process proceeds to step S3.

【0039】処理S6では、自立航法処理部4からのフ
ラグを判定し、フラグが1のとき(自立航法処理部の測
定位置が道路地図情報における道路上またはその近傍に
あるとき)は自立航法処理部4の測定位置(Mx,M
y)の信頼性が高いので処理S3に進み、自立航法処理
部4が求めた(Mx,My)を出力現在位置(X,Y)
として選択出力し、一連の処理を終了する。一方、フラ
グが0のときは処理S2に進む。
In process S6, the flag from the self-contained navigation processing unit 4 is determined, and when the flag is 1 (when the measurement position of the self-contained navigation processing unit is on or near the road in the road map information), the self-contained navigation process is performed. Measurement position (Mx, M
y) is highly reliable, the process proceeds to step S3, and (Mx, My) obtained by the self-contained navigation processor 4 is output. Current position (X, Y)
Is selected and output, and a series of processing is ended. On the other hand, when the flag is 0, the process proceeds to step S2.

【0040】処理S2では、電波航法処理部1が求めた
(Gx,Gy)と自立航法処理部4が求めた(Mx,M
y)との間の距離を計算し、2つの座標の間の距離が所
定値α以上と判定されたときは処理S4に進み、所定値
α未満と判定されたときは処理S3に進む。
In step S2, the radio navigation processing unit 1 obtains (Gx, Gy) and the self-contained navigation processing unit 4 obtains (Mx, M).
y) is calculated, and if the distance between the two coordinates is determined to be equal to or greater than the predetermined value α, the process proceeds to step S4, and if it is determined to be less than the predetermined value α, the process proceeds to step S3.

【0041】処理S4では、電波航法処理部1が求めた
(Gx,Gy)を出力現在位置(X,Y)として選択出
力し、処理S5に進む。
In step S4, (Gx, Gy) determined by the radio navigation processing section 1 is selected and output as the output current position (X, Y), and the flow advances to step S5.

【0042】処理S5では、自立航法での走行始点座標
を処理S4で選択した位置(X,Y)で修正し新たな走
行始点とし、一連の処理を終了する。
In step S5, the coordinates of the starting point of the self-contained navigation are corrected at the position (X, Y) selected in step S4 to make a new starting point of the running, and the series of processes is completed.

【0043】このように、本第2実施例によれば、自立
航法処理部の測定位置が道路地図情報における道路上ま
たはその近傍にあるときは、自立航法処理部4の測定位
置(Mx,My)を信頼することにより、もし、電波航
法処理部3が誤った位置を測定した場合でも確な位置を
決定することができる。
As described above, according to the second embodiment, when the measurement position of the self-contained navigation processing unit is on or near the road in the road map information, the measurement position (Mx, My) of the self-contained navigation processing unit 4 is obtained. By trusting), even if the radio navigation processing unit 3 measures an erroneous position, the accurate position can be determined.

【0044】次に、本発明に係る航法装置の第3の実施
例を明する。
Next, a third embodiment of the navigation system according to the present invention will be described.

【0045】図6に、本第3実施例に係る航法装置の構
成を示す。図示するように、本第2実施例に係る航法装
置の構成は、前述した第2実施例に係る航法装置の構成
(図4参照)において、自立航法処理部2から、前述し
たフラグに加え、自立航法が求めた(Mx,My)が道
路地図情報における道路上またはその近傍にある確度を
数値として出力するようにしたものである。この確度
は、過去の所定走行距離に対する、当該所定走行距離中
において測定位置が道路上もしくは道路の近傍にあった
距離の比を求め、現在の測定位置が道路上もしくは道路
の近傍に無い場合には、最後に道路上もしくは道路の近
傍にあった地点よりの走行距離もしくは走行時間に応じ
た値を前記比より減ずることにより求める。もしくは、
単純に前記比を確度とする。
FIG. 6 shows the configuration of the navigation system according to the third embodiment. As shown in the figure, the configuration of the navigation device according to the second embodiment is the same as the configuration of the navigation device according to the second embodiment described above (see FIG. 4). (Mx, My) obtained by the self-contained navigation is output as a numerical value of the probability of being on or near the road in the road map information. This accuracy is obtained by calculating the ratio of the distance that the measurement position was on or near the road during the predetermined travel distance to the predetermined travel distance in the past, and when the current measurement position is not on or near the road. Is calculated by subtracting a value corresponding to the travel distance or the travel time from the last point on or near the road from the above ratio. Or
The ratio is simply taken as the accuracy.

【0046】図7に、位置修正処理部5の行う処理手順
を示す。
FIG. 7 shows a processing procedure performed by the position correction processing section 5.

【0047】図示するように、本第3実施例において
は、まず、処理S1で、電波航法処理部1において現在
位置(Gx,Gy)が求められたかどうか判定し、現在
位置(Gx,Gy)が求められていれば処理S6に進
み、現在位置(Gx,Gy)が求められていなければ処
理S3に進む。
As shown in the figure, in the third embodiment, first, in step S1, it is determined whether or not the current position (Gx, Gy) has been obtained by the radio navigation processing unit 1, and the current position (Gx, Gy) is determined. If the current position (Gx, Gy) has not been calculated, the process proceeds to step S6.

【0048】処理S6では、自立航法処理部4からのフ
ラグを判定し、フラグ1のとき(自立航法が求めた(M
x,My)が道路地図情報における道路上またはその近
傍にあるとき)は処理S7、フラグが0のときは処理S
2に進む。
In step S6, the flag from the self-contained navigation processing unit 4 is judged, and when the flag is 1, the self-contained navigation is calculated (M
(x, My) is on or near the road in the road map information), the process S7, and when the flag is 0, the process S7.
Go to 2.

【0049】処理S7では、自立航法処理部4からの確
度を判定し、確度が所定値β以上なら(自立航法が求め
た(Mx,My)がβ以上の確度で求められていると
き)処理S3、確度がβ未満なら道路上もしくは近傍に
あるという判定を信頼しないこととし、処理S2に進
む。
In step S7, the accuracy from the self-contained navigation processing unit 4 is determined, and if the accuracy is equal to or higher than a predetermined value β (when (Mx, My) obtained by self-contained navigation is calculated with the accuracy equal to or higher than β), the processing is executed. If the accuracy is less than β in S3, the determination that the vehicle is on or near the road is not trusted, and the process proceeds to S2.

【0050】処理S2では、電波航法処理部1が求めた
(Gx,Gy)と自立航法処理部4が求めた(Mx,M
y)との間の距離を計算し、2つの座標の間の距離が所
定値α以上と判定されたときは処理S4に進み、所定値
α未満と判定されたときは、処理S3に進む。
In step S2, the radio navigation processing section 1 obtains (Gx, Gy) and the self-contained navigation processing section 4 obtains (Mx, M).
y), the process proceeds to step S4 when the distance between the two coordinates is determined to be greater than or equal to the predetermined value α, and proceeds to process S3 when determined to be less than the predetermined value α.

【0051】処理S3では、自立航法処理部4が求めた
(Mx,My)を出力現在位置(X,Y)として選択出
力し、一連の処理を終了する。
In step S3, (Mx, My) obtained by the self-contained navigation processing section 4 is selected and output as the output current position (X, Y), and a series of processing ends.

【0052】処理S4では、電波航法処理部1が求めた
(Gx,Gy)を出力現在位置(X,Y)として選択出
力し、処理S5に進む。
In step S4, (Gx, Gy) obtained by the radio navigation processing section 1 is selected and output as the output current position (X, Y), and the flow advances to step S5.

【0053】処理S5では、自立航法での走行始点座標
を処理S4で選択した位置(X,Y)でセットし新たな
走行始点とし、一連の処理を終了する。
In process S5, the coordinates of the traveling start point in self-contained navigation are set at the position (X, Y) selected in process S4 to set a new traveling start point, and the series of processes is terminated.

【0054】このように、本第3実施例によれば、前記
第2実施例に係る航法装置に加え、さらに自立航法処理
部4の測定位置の確からしさまでをも考慮して、出力現
在位置の決定を行うことができ、より正確に位置を決す
ることができる。
As described above, according to the third embodiment, in addition to the navigation device according to the second embodiment, the output current position is considered in consideration of the certainty of the measurement position of the self-contained navigation processing unit 4. Can be determined, and the position can be determined more accurately.

【0055】以下、本発明に係る航法装置の第4の実施
例を説明する。
The fourth embodiment of the navigation system according to the present invention will be described below.

【0056】本第4実施例に係る航法装置の構成を図8
に示す。
FIG. 8 shows the configuration of the navigation system according to the fourth embodiment.
Shown in.

【0057】図示するように、本第2実施例に係る航法
装置の構成は、前述した第1実施例に係る航法装置の構
成(図1参照)において、電波航法処理部1から離散度
数を出力するようにしたものである。離散度数は、電波
航法による測定位置(Gx,Gy)が過去の電波航法が
求めたの来歴から判断し、離散的か連続的かを判定して
生成する。離散度数は、離散的であるほど大きな数値と
して出力される。
As shown in the figure, the configuration of the navigation device according to the second embodiment is the same as the configuration of the navigation device according to the first embodiment (see FIG. 1), in which a discrete frequency is output from the radio navigation processing unit 1. It is something that is done. The discrete frequency is generated by judging whether the measurement position (Gx, Gy) by the radio navigation is the history obtained by the past radio navigation and whether it is discrete or continuous. The discrete frequency is output as a larger numerical value as it is more discrete.

【0058】図9に、位置修正処理部5の行う処理手順
を示す。
FIG. 9 shows a processing procedure performed by the position correction processing section 5.

【0059】位置修正処理部5は、図示するように、処
理S1で、電波航法処理部1において現在位置(Gx,
Gy)が求められたかどうか判定し、現在位置(Gx,
Gy)が求められていれば処理S8に進み、現在位置
(Gx,Gy)が求められていなれば処理S3に進む。
As shown in the figure, the position correction processing unit 5 is the current position (Gx,
Gy) is determined, and the current position (Gx,
If Gy) is obtained, the process proceeds to step S8, and if the current position (Gx, Gy) is not obtained, the process proceeds to step S3.

【0060】処理S8では、離散度数を判定し、所定値
γより大きければ、現在位置(Gx,Gy)の信頼度は
低いので、位置(Gx,Gy)を出力現在位置として採
用しないこととし、処理S3に進む。所定値γより小さ
い場合はS2に進む。
In step S8, the discrete frequency is judged, and if it is larger than the predetermined value γ, the position (Gx, Gy) is not adopted as the output current position because the reliability of the current position (Gx, Gy) is low. The process proceeds to step S3. When it is smaller than the predetermined value γ, the process proceeds to S2.

【0061】処理S2では、電波航法処理部1が求めた
(Gx,Gy)と自立航法処理部4が求めた(Mx,M
y)との間の距離を計算し、2つの座標の間の距離が所
定値α以上と判定されたときは処理S4に進み、所定値
α未満と判定されたときは処理S3に進む。
In step S2, the radio navigation processing section 1 obtains (Gx, Gy) and the self-contained navigation processing section 4 obtains (Mx, My).
y) is calculated, and if the distance between the two coordinates is determined to be equal to or greater than the predetermined value α, the process proceeds to step S4, and if it is determined to be less than the predetermined value α, the process proceeds to step S3.

【0062】一方、処置S3では、自立航法処理部4が
求めた(Mx,My)を出力現在位置(X,Y)として
選択出力し、一連の処理を終了する。
On the other hand, in procedure S3, (Mx, My) obtained by the self-contained navigation processing unit 4 is selectively output as the output current position (X, Y), and a series of processing is ended.

【0063】処理S4では、電波航法処理部1が求めた
(Gx,Gy)を出力現在位置(X,Y)として選択出
力し、処理S5に進む。
In step S4, (Gx, Gy) obtained by the radio navigation processing section 1 is selected and output as the output current position (X, Y), and the flow advances to step S5.

【0064】処理S5では、自立航法での走行始点座標
を処理S4で選択した位置(X,Y)でリセットし新た
な走行始点とし、一連の処理を終了する。
In process S5, the coordinates of the starting point of the self-contained navigation are reset at the position (X, Y) selected in step S4 to make a new starting point of the running, and the series of processes is completed.

【0065】このように、本第4実施例によれば、電波
航法処理部1の測定位置の信頼度をも考慮して出力現在
位置の決定を行うことができ、より正確に位置を決する
ことができる。
As described above, according to the fourth embodiment, the output current position can be determined in consideration of the reliability of the measurement position of the radio navigation processing unit 1, and the position can be determined more accurately. You can

【0066】なお、本実施例で用いた電波航法処理部1
から得られる離散度数による判定処理(処理S8)は、
前記各実施例においても利用することができる。
Note that the radio navigation processing section 1 used in this embodiment is
The determination process (process S8) based on the discrete frequency obtained from
It can also be used in each of the above embodiments.

【0067】以下、本発明に係る航法装置の第5の実施
例について説明する。
The fifth embodiment of the navigation system according to the present invention will be described below.

【0068】図10に、本第5の実施例に係る航法装置
の構成を示す。
FIG. 10 shows the structure of a navigation system according to the fifth embodiment.

【0069】図中、1は電波航法処理部であり、人工衛
星(図示せず)の信号により三角測量の技術を利用して
現在位置(Gx,Gy)、及び移動方位θGを求める。
In the figure, reference numeral 1 denotes a radio-navigation processing unit, which obtains a current position (Gx, Gy) and a moving direction θG by using a triangulation technique using a signal from an artificial satellite (not shown).

【0070】2は方位計測処理部であり、角速度センサ
(図示せず)から角速度のデータ、あるいは、地磁気セ
ンサ(図示せず)からの地磁気データ、あるいは、両方
のセンサからのデータにより車両の進行方位を演算し出
力する。
Reference numeral 2 denotes an azimuth measurement processing unit, which advances the vehicle based on angular velocity data from an angular velocity sensor (not shown), geomagnetic data from a geomagnetic sensor (not shown), or data from both sensors. Compute and output the azimuth.

【0071】3は距離計測処理部であり、距離センサ
(図示せず)から入力するパルスにお基づいて車両の走
行距離を計測し出力する。
Reference numeral 3 denotes a distance measurement processing unit, which measures and outputs the traveling distance of the vehicle based on a pulse input from a distance sensor (not shown).

【0072】4は自立航法処理部であり、手動あるいは
自動的に設定されたある走行始点からの距離計測処理部
2の距離データおよび方位計測処理部3の方位データを
積分し、推測位置を演算するとともに、推測位置又は推
測位置による走行来歴を、記憶装置(図示せず)から読
み出した道路地図情報と照合して測定位置(Mx,M
y)を決定する。
Reference numeral 4 denotes a self-contained navigation processing unit, which integrates the distance data of the distance measurement processing unit 2 and the azimuth measurement data of the azimuth measurement processing unit 3 from a certain traveling start point set manually or automatically to calculate an estimated position. At the same time, the estimated position or the travel history based on the estimated position is compared with the road map information read from the storage device (not shown) to measure the position (Mx, M).
y) is determined.

【0073】5は、位置修正処理部であり、電波航法処
理部1が求めた(Gx,Gy)と自立航法処理部4が求
めた(Mx,My)とを入力し、所定の判定方法に基づ
き位置(Gx,Gy)または位置(Mx,My)を出力
現在位置(X,Y)として選択出力する。また、電波航
法処理部1が求めた(Gx,Gy)を出力現在位置座標
(X,Y)として選択したとき、自立航法処理部4の走
行始点を出力現在位置(X,Y)により修正し、同時
に、方位修正処理部6に対して方位修正要求を出力す
る。
Reference numeral 5 denotes a position correction processing unit which inputs (Gx, Gy) obtained by the radio navigation processing unit 1 and (Mx, My) obtained by the self-contained navigation processing unit 4 to enter a predetermined determination method. Based on this, the position (Gx, Gy) or the position (Mx, My) is selectively output as the output current position (X, Y). When (Gx, Gy) obtained by the radio navigation processing unit 1 is selected as the output current position coordinates (X, Y), the traveling start point of the self-contained navigation processing unit 4 is corrected by the output current position (X, Y). At the same time, an azimuth correction request is output to the azimuth correction processing unit 6.

【0074】6は、方位修正処理部であり、位置修正処
理部4からの方位修正要求があるとき方位修正処理部2
による進行方位θを電波航法処理部1により求められた
移動方位θGにより修正する。
The azimuth correction processing unit 6 is provided when the azimuth correction processing unit 4 issues a azimuth correction processing request.
The traveling azimuth θ is corrected by the moving azimuth θG obtained by the radio navigation processing unit 1.

【0075】次に、図11に、本第5実施例に係る航法
装置の位置修正処理部5が行う処理手順を示す。
Next, FIG. 11 shows a processing procedure performed by the position correction processing section 5 of the navigation device in the fifth embodiment.

【0076】図示するように、まず、処理S1で、電波
航法処理部1において現在位置(Gx,Gy)が求めら
れたかどうか判定し、現在位置(Gx,Gy)が求めら
れていれば処理S3に進み、現在位置(Gx,Gy)が
求められていなれば処理S2に進む。
As shown in the figure, first, in step S1, it is determined whether or not the current position (Gx, Gy) has been obtained by the radio navigation processing section 1, and if the current position (Gx, Gy) has been obtained, step S3. If the current position (Gx, Gy) has not been obtained, the process proceeds to step S2.

【0077】処理S2では、電波航法処理部1が求めた
(Gx,Gy)と自立航法処理部4が求めた(Mx,M
y)との間の距離を計算し、2つの座標の間の距離が所
定値α以上と判定されたときは処理S4に進み、所定値
α未満と判定されたときは処理S3に進む。
In step S2, the radio navigation processing section 1 obtains (Gx, Gy) and the self-contained navigation processing section 4 obtains (Mx, M).
y) is calculated, and if the distance between the two coordinates is determined to be equal to or greater than the predetermined value α, the process proceeds to step S4, and if it is determined to be less than the predetermined value α, the process proceeds to step S3.

【0078】処理S3では、自立航法処理部4が求めた
(Mx,My)を出力現在位置(X,Y)として選択出
力し、一連の処理を終了する。
In step S3, (Mx, My) obtained by the self-contained navigation processing section 4 is selected and output as the output current position (X, Y), and a series of processing ends.

【0079】処理S4では、電波航法処理部1が求めた
(Gx,Gy)を出力現在位置(X,Y)として選択出
力し、処理S5に進む。
In step S4, (Gx, Gy) obtained by the radio navigation processing section 1 is selected and output as the output current position (X, Y), and the flow advances to step S5.

【0080】処理S5では、自立航法処理部4での走行
始点座標を処理S4で選択した位置(X,Y)で修正し
た新たな走行始点とし、処理S9に進む。
In the process S5, the coordinates of the starting point of the traveling in the self-contained navigation processing unit 4 are set as the new starting point of the vehicle corrected at the position (X, Y) selected in the step S4, and the process proceeds to the step S9.

【0081】処理S9では、自立航法処理部4から得ら
れる車両速度を判定し、速度Vが所定値δ以上なら、進
行方位のずれの影響が大きいので、これを修正するため
に、処理S10に進み、速度Vが所定値δ未満なら一連
の処理を終了する。
In processing S9, the vehicle speed obtained from the self-contained navigation processing unit 4 is determined. If the speed V is equal to or higher than the predetermined value δ, the influence of the deviation of the traveling direction is large. If the speed V is less than the predetermined value δ, the series of processing is terminated.

【0082】処理S10では、方位計測処理部2での進
行方位θを電波航法処理部1での移動方位θGで修正
し、一連の処理を終了する。
In process S10, the traveling azimuth θ in the azimuth measurement processing unit 2 is corrected by the moving azimuth θG in the radio navigation processing unit 1, and the series of processes is ended.

【0083】なお、本第5実施例で用いた車両速度Vが
所定値δ以上のときに方位計測処理部2での進行方位θ
を電波航法処理部1で求めた移動方位θGで修正し、以
降の進行方位をθ=θGとする処理(処理S9および処
理S10)は、前記各実施例においても利用することが
できる。
The traveling azimuth θ in the azimuth measurement processing unit 2 when the vehicle speed V used in the fifth embodiment is not less than the predetermined value δ.
The processing for correcting the traveling direction θG obtained by the radio navigation processing unit 1 and setting the traveling direction thereafter as θ = θG (processing S9 and processing S10) can also be used in each of the above-described embodiments.

【0084】さて、このような図11の処理によって、
本航法装置の動作は次のようになる。
By the processing of FIG. 11 as described above,
The operation of this navigation system is as follows.

【0085】図12に、本第5実施例に係る航法装置に
動作系を示す。
FIG. 12 shows the operation system of the navigation system according to the fifth embodiment.

【0086】図12において、Giは電波航法処理部1
が求めた(Gx,Gy)を表し、Miは自立航法処理部
4が求めた(Mx,My)を表す。また、i(i=1,
2,・・・,n)は時刻に対応する位置を表す。実線は
実際の走行軌跡を表し、点線は航法装置による走行軌跡
を表す。なお、説明を簡単にするため車両は同一方向に
直進しているものとする。
In FIG. 12, Gi is the radio navigation processing section 1
Represents the (Gx, Gy), and Mi represents the (Mx, My) calculated by the self-contained navigation processing unit 4. Also, i (i = 1,
2, ..., N) represent the position corresponding to the time. The solid line represents the actual travel path, and the dotted line represents the travel path by the navigation device. It should be noted that, for simplicity of explanation, it is assumed that the vehicles are traveling straight in the same direction.

【0087】i=1の地点ではG1,M1間の距離d1
所定値α未満であるため出力現在位置(X2,Y2)は自
立航法処理部4が求めた(Mx1,My1)を出力する。
[0087] i = the distance d 1 between G 1, M 1 is 1 point output current position for less than a predetermined value α (X 2, Y 2) is autonomous navigation processing unit 4 is determined (Mx 1, My 1 ) is output.

【0088】i=2の地点はi=1の地点での処理と同
様にG2,M2間の距離d2は所定値α未満であるため出
力現在位置(X2,Y2)は自立航法処理部2が求めた
(Mx2,My2)を出力する。
[0088] i = 2 points is a distance d 2 between G 2, M 2 in the same manner as the processing at the point of i = 1 is output a current position for less than a predetermined value α (X 2, Y 2) is self-supporting It outputs (Mx 2 , My 2 ) obtained by the navigation processing unit 2.

【0089】i=3の地点ではG3,M3間の距離d3
所定値α以上であるため出力現在位置(X3,Y3)は電
波航法処理部1による入力位置(Gx3,Gy3)を出力
し、同時に自立航法での走行始点位置(Mx3,My3
を位置(X3,Y3)で修正し新たな走行始点とする。し
たがい、自立航法はM3aの位置から再出発することに
なる。さらに、方位計測処理部2での進行方位θを電波
航法処理部1で求めた移動方位θGで修正し、以降の進
行方位をθ=θGとする。
[0089] i = G 3 is 3 points, M distance d 3 between the 3 outputs the current position for a predetermined value or more α (X 3, Y 3) is input position by radio navigation unit 1 (Gx 3, Gy 3 ) is output, and at the same time, the start position of the self-contained navigation (Mx 3 , My 3 )
Is corrected at the position (X 3 , Y 3 ) to make a new running start point. Therefore, the self-contained navigation will restart from the position of M3a. Further, the traveling azimuth θ in the azimuth measurement processing unit 2 is corrected by the moving azimuth θG obtained in the radio navigation processing unit 1, and the subsequent traveling azimuth is set to θ = θG.

【0090】i=4の地点ではG4,M4間の距離d4
所定値α未満であるため出力現在位置(X4,Y4)は自
立航法処理部4が求めた(Mx4,My4)を出力する。
[0090] i = the 4 point G 4, the distance d 4 between M 4 is output a current position for less than a predetermined value α (X 4, Y 4) has autonomous navigation processing unit 4 was determined (Mx 4, My 4 ) is output.

【0091】このように、本第5実施例によれば、実際
の走行軌跡と自立航法による走行軌跡がずれていても
(方位計測処理部による車両の進行方位がずれていて
も)航法装置の位置誤差が所定距離未満になる。また、
車両の速度がある所定値δ以上であれば、進行方位θを
も修正するため以降の自立航法の精度を高めることがで
きる。
As described above, according to the fifth embodiment, even if the actual traveling locus is deviated from the traveling locus by the self-contained navigation (even if the traveling azimuth of the vehicle is deviated by the azimuth measurement processing unit), the navigation device The position error is less than the predetermined distance. Also,
If the speed of the vehicle is greater than or equal to a predetermined value δ, the traveling direction θ is also corrected, so that the accuracy of subsequent self-contained navigation can be improved.

【0092】以上のように本発明の各実施例によれば、
電波航法と自立航法との位置のずれを見て、ずれが大き
くなったときには電波航法が求めた現在位置でで自立航
法の位置を修正することにより、常に航法装置の位置誤
差が所定距離未満になる正確な位置を提供できる。ま
た、自立航法での精度、電波航法での精度を見極めて必
要以上に電波航法を用いないようにすることで、さらに
正確な位置を提供できる。さらに、電波航法が求めたで
自立航法の位置を修正するとき、車両の方位も合わせて
修正する様にすることで以降の自立航法での位置をより
正確にできる。
As described above, according to the embodiments of the present invention,
By looking at the difference between the positions of the radio navigation and the self-contained navigation, and when the deviation becomes large, the position error of the navigation device is always kept below the predetermined distance by correcting the position of the self-contained navigation at the current position obtained by the radio navigation. Can provide a precise position. Further, it is possible to provide a more accurate position by carefully checking the accuracy of the self-contained navigation and the accuracy of the radio navigation and not using the radio navigation more than necessary. Further, when the position of the self-contained navigation is corrected by the radio navigation, the position of the vehicle can be corrected more accurately by correcting the direction of the vehicle.

【0093】[0093]

【発明の効果】以上にように、本発明によれば、多様な
状況下においても、より正確に位置の測定を行うことの
できる航法装置を提供することができる。
As described above, according to the present invention, it is possible to provide a navigation device capable of more accurately measuring a position even under various circumstances.

【図面の簡単な説明】[Brief description of drawings]

【図1】本発明の第1実施例に係る航法装置の構成を示
すブロック図である。
FIG. 1 is a block diagram showing a configuration of a navigation device according to a first embodiment of the present invention.

【図2】第1実施例に係る航法装置の処理手順を示すフ
ローチャートである。
FIG. 2 is a flowchart showing a processing procedure of the navigation device according to the first embodiment.

【図3】第1実施例に係る航法装置の動作例を示す説明
図である。
FIG. 3 is an explanatory diagram showing an operation example of the navigation device according to the first embodiment.

【図4】第2実施例に係る航法装置の構成を示すブロッ
ク図である。
FIG. 4 is a block diagram showing a configuration of a navigation device according to a second embodiment.

【図5】第2実施例に係る航法装置の処理手順を示すフ
ローチャートである。
FIG. 5 is a flowchart showing a processing procedure of the navigation device according to the second embodiment.

【図6】第3実施例に係る航法装置の構成を示すブロッ
ク図である。
FIG. 6 is a block diagram showing a configuration of a navigation device according to a third embodiment.

【図7】第3実施例に係る航法装置の処理手順を示すフ
ローチャートである。
FIG. 7 is a flowchart showing a processing procedure of a navigation device according to a third embodiment.

【図8】第4実施例に係る航法装置の構成を示すブロッ
ク図である。
FIG. 8 is a block diagram showing a configuration of a navigation device according to a fourth embodiment.

【図9】第4実施例に係る航法装置の処理手順を示すフ
ローチャートである。
FIG. 9 is a flowchart showing a processing procedure of the navigation device according to the fourth embodiment.

【図10】第5実施例に係る航法装置の構成を示すブロ
ック図である。
FIG. 10 is a block diagram showing a configuration of a navigation device according to a fifth embodiment.

【図11】第5実施例に係る航法装置の処理手順を示す
フローチャートである。
FIG. 11 is a flowchart showing a processing procedure of the navigation device according to the fifth embodiment.

【図12】第5実施例に係る航法装置の動作例を示す説
明図である。
FIG. 12 is an explanatory diagram showing an operation example of the navigation device according to the fifth embodiment.

【符号の説明】[Explanation of symbols]

1 電波航法処理部 2 方位計測処理部 3 距離計測処理部 4 自立航法処理部 5 位置修正処理部 6 方位修正処理部 1 Radio-navigation processing unit 2 Direction measurement processing unit 3 Distance measurement processing unit 4 Autonomous navigation processing unit 5 Position correction processing unit 6 Direction correction processing unit

Claims (7)

【特許請求の範囲】[Claims] 【請求項1】移動体上に搭載され、移動体の現在位置を
出力する航法装置であって、 人工衛星よりの電波に基づいて移動体の現在位置を測定
する電波航法手段と、 角速度もしくは地磁気角度のうちの少なくとも一方に基
づいて移動体の進行方位を計測する方位計測手段と、 移動体の走行距離を計測する距離計測手段と、 道路地図情報を記憶する記憶手段と、 与えられた走行始点位置から現在に至るまでの間に前記
方位計測手段が計測した進行方位と前記距離計測手段が
計測した走行距離とを用いて、移動体の仮現在位置もし
くは走行来歴を求め、求めた仮現在位置もしくは走行来
歴を前記記憶手段から読み出した前記道路地図情報と照
合し、移動体の現在位置を決定する自立航法手段と、 前記自立航法手段が決定した現在位置と前記電波航法手
段が決定した現在位置とが所定距離以上離れていない場
合に、前記自立航法手段が決定した現在位置を最終的な
現在位置として出力し、所定距離以上離れている場合
に、前記電波航法手段が決定した最終的な現在位置を出
力すると共に、前記自立航法手段に、前記電波航法手段
が決定した現在位置を新たな走行始点として与える位置
修正手段とを有することを特徴とする航法装置。
1. A navigation device mounted on a mobile body for outputting the current position of the mobile body, the radio navigation means for measuring the current position of the mobile body based on radio waves from an artificial satellite, and an angular velocity or geomagnetism. A direction measuring means for measuring the traveling direction of the moving body based on at least one of the angles, a distance measuring means for measuring the traveling distance of the moving body, a storing means for storing road map information, and a given traveling start point. From the position to the present, using the traveling azimuth measured by the azimuth measuring means and the traveling distance measured by the distance measuring means, the provisional present position or traveling history of the moving body is obtained, and the obtained provisional present position Alternatively, the self-sustained navigation means for determining the current position of the moving body by collating the travel history with the road map information read from the storage means, and the current position and the radio wave determined by the self-sustained navigation means If the current position determined by the navigation means is not more than a predetermined distance away, the current position determined by the self-contained navigation means is output as the final current position, and if the distance is more than the predetermined distance, the radio navigation means is provided. And a position correcting means for outputting to the self-contained navigation means the current position determined by the radio navigation means as a new traveling start point, as well as outputting the final current position determined by.
【請求項2】請求項1記載の航法装置であって、 前記位置修正手段は、前記自立航法手段が決定した現在
位置と前記電波航法手段が決定した現在位置とが所定距
離以上離れている場合であっても、前記自立航法手段が
決定した現在位置が、前記道路地図情報上、道路または
その近傍に在るときは、前記自立航法手段が決定した現
在位置を最終的な現在位置として出力し、前記自立航法
手段に、前記電波航法手段が決定した現在位置を新たな
走行始点として与えないことを特徴とする航法装置。
2. The navigation device according to claim 1, wherein the position correcting means separates the current position determined by the self-contained navigation means from the current position determined by the radio navigation means by a predetermined distance or more. Even if the current position determined by the self-contained navigation means is on or near the road on the road map information, the current position determined by the self-contained navigation means is output as the final current position. The navigation device, wherein the self-contained navigation means is not given the current position determined by the radio navigation means as a new traveling start point.
【請求項3】特許請求項1記載の航法装置であって、 前記位置修正手段は、前記自立航法手段が決定した現在
位置と前記電波航法手段が決定した現在位置とが所定距
離以上離れている場合であっても、前記自立航法手段が
決定した現在位置が、前記道路地図情報上、道路または
その近傍に在って、かつ、道路またはその近傍に在る確
度が所定値以上のときは、前記自立航法手段が決定した
現在位置を最終的な現在位置として出力し、前記自立航
法手段に、前記電波航法手段が決定した現在位置を新た
な走行始点として与えないことを特徴とする航法装置。
3. The navigation device according to claim 1, wherein in the position correcting means, the current position determined by the self-contained navigation means and the current position determined by the radio navigation means are separated by a predetermined distance or more. Even in this case, the current position determined by the self-contained navigation means is on the road map information, on the road or in the vicinity thereof, and when the accuracy of being on the road or in the vicinity thereof is a predetermined value or more, A navigation device, wherein the current position determined by the self-contained navigation means is output as a final current position, and the current position determined by the radio navigation means is not given to the self-contained navigation means as a new traveling start point.
【請求項4】請求項3記載の航法装置であって、 前記確度は、過去の所定走行距離に対する、当該所定走
行距離中において自立航法手段の決定した現在位置が道
路上もしくは道路の近傍にあった距離の比であることを
特徴とする航法装置。
4. The navigation device according to claim 3, wherein the accuracy is such that the current position determined by the self-contained navigation means during the predetermined traveling distance with respect to the past traveling distance is on or near the road. Navigation device characterized by a ratio of different distances.
【請求項5】請求項3記載の航法装置であって、 前記確度は、過去の所定走行距離に対する、当該所定走
行距離中において自立航法手段が決定した過去の現在位
置が道路上もしくは道路の近傍にあった距離の比を求
め、自立航法手段の決定した現在位置が道路上もしくは
道路の近傍に無い場合には、最後に道路上もしくは道路
の近傍にあった地点よりの走行距離もしくは走行時間に
応じた値を前記比より減ずることにより求めた値である
ことを特徴とする航法装置。
5. The navigation device according to claim 3, wherein the certainty is the past current position determined by the self-contained navigation means during the predetermined travel distance on the road or near the road. If the current position determined by the self-contained navigation means is not on or near the road, the distance or travel time from the last point on or near the road is calculated. A navigation device characterized by being a value obtained by subtracting a corresponding value from the ratio.
【請求項6】請求項1、2、3、4または6記載の航法
装置であって、 前記位置修正手段は、前記電波航法手段が決定してきた
現在位置の来歴を求め、求めた来歴が離散的であるとき
は、前記自立航法手段が決定した現在位置と前記電波航
法手段が決定した現在位置とが所定距離以上離れている
場合であっても、前記自立航法手段が決定した現在位置
を最終的な現在位置として出力し、前記自立航法手段
に、前記電波航法手段が決定した現在位置を新たな走行
始点として与えないことを特徴とする航法装置。
6. The navigation device according to claim 1, 2, 3, 4, or 6, wherein the position correction means obtains a history of the current position determined by the radio navigation means, and the obtained history is discrete. When the current position determined by the self-contained navigation means and the current position determined by the radio navigation means are separated by a predetermined distance or more, the current position determined by the self-contained navigation means is final. Navigation device, wherein the current position determined by the radio navigation means is not provided as a new traveling start point to the self-contained navigation means.
【請求項7】請求項1、2、3、4、5または6記載の
航法装置であって、 移動体の走行速度を測定する走行速度測定手段を備え、
かつ、 前記電波航法手段は、人工衛星よりの電波に基づいて移
動体の移動方向をも測定し、 前記位置修正手段が、前記電波航法手段が決定した最終
的な現在位置を出力すると共に、前記自立航法手段に、
前記電波航法手段が決定した現在位置を新たな走行始点
として与える場合に、前記走行速度測定手段が測定した
走行速度が、所定値以上か否かを判定し、所定値以上で
あった場合に、前記電波航法手段が測定した移動体の移
動方向を現進行方位として、前記方位計測手段を補正す
る方位修正手段を備えることを特徴とする航法装置。
7. A navigation device according to claim 1, 2, 3, 4, 5 or 6, further comprising a traveling speed measuring means for measuring a traveling speed of the moving body,
And, the radio navigation means also measures the moving direction of the moving body based on the radio waves from the artificial satellite, the position correction means, while outputting the final current position determined by the radio navigation means, For autonomous navigation means,
When the current position determined by the radio navigation means is given as a new traveling start point, the traveling speed measured by the traveling speed measuring means determines whether or not a predetermined value or more, and if the predetermined value or more, A navigation device comprising an azimuth correcting means for correcting the azimuth measuring means, with the moving direction of the moving body measured by the radio navigation means as the current traveling azimuth.
JP24674192A 1992-09-16 1992-09-16 Navigation equipment Expired - Fee Related JP3164659B2 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP24674192A JP3164659B2 (en) 1992-09-16 1992-09-16 Navigation equipment
US08/122,867 US5422639A (en) 1992-09-16 1993-09-16 Navigation equipment which determines current position dependent on difference between calculated value of self-contained navigation and measured value of radio navigation

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP24674192A JP3164659B2 (en) 1992-09-16 1992-09-16 Navigation equipment

Publications (2)

Publication Number Publication Date
JPH0694471A true JPH0694471A (en) 1994-04-05
JP3164659B2 JP3164659B2 (en) 2001-05-08

Family

ID=17152964

Family Applications (1)

Application Number Title Priority Date Filing Date
JP24674192A Expired - Fee Related JP3164659B2 (en) 1992-09-16 1992-09-16 Navigation equipment

Country Status (2)

Country Link
US (1) US5422639A (en)
JP (1) JP3164659B2 (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009229295A (en) * 2008-03-24 2009-10-08 Fujitsu Ltd Positional information processor, positional information processing program, and moving object terminal
CN102401905A (en) * 2010-09-15 2012-04-04 卡西欧计算机株式会社 Positioning apparatus, positioning method
JP2015127674A (en) * 2013-12-27 2015-07-09 株式会社ビートソニック GPS smart system

Families Citing this family (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE4332945A1 (en) * 1993-09-28 1995-03-30 Bosch Gmbh Robert Positioning and navigation device with satellite support
US5941934A (en) * 1995-06-09 1999-08-24 Xanavi Informatics Corporation Current position calculating device
US5898390A (en) * 1995-09-14 1999-04-27 Zexel Corporation Method and apparatus for calibration of a distance sensor in a vehicle navigation system
JP3449240B2 (en) * 1998-09-24 2003-09-22 株式会社デンソー Vehicle current position detection device, vehicle current position display device, navigation device, and recording medium
US6192312B1 (en) 1999-03-25 2001-02-20 Navigation Technologies Corp. Position determining program and method
US6360165B1 (en) 1999-10-21 2002-03-19 Visteon Technologies, Llc Method and apparatus for improving dead reckoning distance calculation in vehicle navigation system
US6282496B1 (en) 1999-10-29 2001-08-28 Visteon Technologies, Llc Method and apparatus for inertial guidance for an automobile navigation system
US6502033B1 (en) 2000-10-05 2002-12-31 Navigation Technologies Corp. Turn detection algorithm for vehicle positioning
US6317683B1 (en) 2000-10-05 2001-11-13 Navigation Technologies Corp. Vehicle positioning using three metrics
JP4601033B2 (en) * 2000-12-27 2010-12-22 株式会社エクォス・リサーチ Light distribution control device
JP4229358B2 (en) * 2001-01-22 2009-02-25 株式会社小松製作所 Driving control device for unmanned vehicles
JP2002333332A (en) * 2001-05-08 2002-11-22 Pioneer Electronic Corp Hybrid processing method and device thereof, navigation system, and computer program
US6631321B1 (en) 2001-10-29 2003-10-07 Navigation Technologies Corp. Vehicle heading change determination using compensated differential wheel speed
US7848881B2 (en) * 2005-07-05 2010-12-07 Containertrac, Inc. Automatic past error corrections for location and inventory tracking
US8838374B2 (en) * 2005-07-05 2014-09-16 Mi-Jack Products, Inc. Automatic correction of past position errors for location and inventory tracking
DE102006056761A1 (en) * 2006-12-01 2008-06-12 Audi Ag Method for controlling an operating or functional component of a motor vehicle based on position data determined via a navigation system
US8556430B2 (en) * 2007-06-27 2013-10-15 Prysm, Inc. Servo feedback control based on designated scanning servo beam in scanning beam display systems with light-emitting screens
US20090319186A1 (en) * 2008-06-24 2009-12-24 Honeywell International Inc. Method and apparatus for determining a navigational state of a vehicle
JP5609073B2 (en) * 2009-06-16 2014-10-22 カシオ計算機株式会社 Positioning device, positioning method and program
JP4793479B2 (en) * 2009-07-09 2011-10-12 カシオ計算機株式会社 Positioning device, positioning method and program
US8700324B2 (en) * 2010-08-25 2014-04-15 Caterpillar Inc. Machine navigation system having integrity checking
US9423506B2 (en) * 2011-09-16 2016-08-23 Saab Ab Tactical differential GPS

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA1235782A (en) * 1984-05-09 1988-04-26 Kazuo Sato Apparatus for calculating position of vehicle
JPH0644184B2 (en) * 1985-03-11 1994-06-08 日産自動車株式会社 Vehicle route guidance device
JPH01214711A (en) * 1988-02-23 1989-08-29 Toshiba Corp Navigation apparatus
JPH01316607A (en) * 1988-03-30 1989-12-21 Furuno Electric Co Ltd Navigation system
US5179519A (en) * 1990-02-01 1993-01-12 Pioneer Electronic Corporation Navigation system for vehicle
JPH049710A (en) * 1990-04-27 1992-01-14 Pioneer Electron Corp Navigation apparatus for vehicle
JP3062301B2 (en) * 1991-07-10 2000-07-10 パイオニア株式会社 GPS navigation device
US5283575A (en) * 1991-11-08 1994-02-01 Zexel Corporation System and method for locating a travelling vehicle

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009229295A (en) * 2008-03-24 2009-10-08 Fujitsu Ltd Positional information processor, positional information processing program, and moving object terminal
CN102401905A (en) * 2010-09-15 2012-04-04 卡西欧计算机株式会社 Positioning apparatus, positioning method
US8692709B2 (en) 2010-09-15 2014-04-08 Casio Computer Co., Ltd. Positioning apparatus, positioning method, and storage medium for measuring position using both autonomous navigation and GPS
JP2015127674A (en) * 2013-12-27 2015-07-09 株式会社ビートソニック GPS smart system

Also Published As

Publication number Publication date
JP3164659B2 (en) 2001-05-08
US5422639A (en) 1995-06-06

Similar Documents

Publication Publication Date Title
JP3164659B2 (en) Navigation equipment
EP0640207B1 (en) Calibration method for a relative heading sensor
US6658353B2 (en) Vehicle navigation apparatus providing rapid correction for excessive error in dead reckoning estimates of vehicle travel direction by direct application of position and direction information derived from gps position measurement data
US6226591B1 (en) Vehicle present position detection apparatus, vehicle present position display apparatus, navigation system and recording medium
US9273966B2 (en) Technique for calibrating dead reckoning positioning data
JP2002333331A (en) Navigation device
JPH0621792B2 (en) Hybrid position measuring device
JPH0518774A (en) Vehicle position-azimuth computing device
JP3402383B2 (en) Vehicle current position detection device
JPH02501855A (en) Navigation method for vehicles with electronic compass
JP2647342B2 (en) Vehicle mileage detection device
JP4316820B2 (en) On-vehicle navigation device and direction measuring method
JP4797901B2 (en) Current position display device, navigation device, program
JPS62140017A (en) Present position recognition apparatus for vehicle
JP3451636B2 (en) Speed sensor coefficient calculation device
JPH05142996A (en) Navigation device
JP3126751B2 (en) Automatic correction device for distance correction coefficient
JP4268581B2 (en) Car navigation system
JP2958020B2 (en) Travel control device for mobile vehicles
JP3076088B2 (en) Automatic correction device for distance correction coefficient
JPH08338733A (en) Device for calculating direction of travel of vehicle
WO2022070458A1 (en) Vehicle position estimation device and vehicle position estimation method
JP3263437B2 (en) Vehicle navigation device
JPH0777571A (en) On-vehicle navigation system
JPH03291519A (en) Navigation system for moving body

Legal Events

Date Code Title Description
R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees