JP2752117B2 - Vehicle running position display device - Google Patents

Vehicle running position display device

Info

Publication number
JP2752117B2
JP2752117B2 JP32154488A JP32154488A JP2752117B2 JP 2752117 B2 JP2752117 B2 JP 2752117B2 JP 32154488 A JP32154488 A JP 32154488A JP 32154488 A JP32154488 A JP 32154488A JP 2752117 B2 JP2752117 B2 JP 2752117B2
Authority
JP
Japan
Prior art keywords
vehicle
road
traveling
map
calculated
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.)
Expired - Lifetime
Application number
JP32154488A
Other languages
Japanese (ja)
Other versions
JPH02165010A (en
Inventor
元三 池田
潔 鶴見
広保 深谷
浩伸 杉本
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.)
Denso Corp
Toyota Motor Corp
Original Assignee
Denso Corp
Toyota Motor Corp
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 Denso Corp, Toyota Motor Corp filed Critical Denso Corp
Priority to JP32154488A priority Critical patent/JP2752117B2/en
Publication of JPH02165010A publication Critical patent/JPH02165010A/en
Application granted granted Critical
Publication of JP2752117B2 publication Critical patent/JP2752117B2/en
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Description

【発明の詳細な説明】 [産業上の利用分野] 本発明は、走行中の車両の位置を地図上に重ねて表示
する車両走行位置表示装置に関し、詳しくはセンサから
計算される計算位置を目標検定点と比較して表示するも
のに関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a vehicle traveling position display device that displays the position of a traveling vehicle on a map in a superimposed manner. It relates to what is displayed in comparison with the test point.

[従来の技術] 従来より、車両に搭載されたセンサからの検出信号に
基づいて、車両の走行方向と走行距離とを求めて車両の
位置を計算し、この計算位置に基づいて、表示された地
図上に車両の位置を表示するものが知られている。しか
し、走行距離検出手段や方位検出手段の検出値には若干
の誤差が含まれるので、これらの検出値を積算して得ら
れる車両の計算位置には誤差が生じる。
[Prior Art] Conventionally, based on a detection signal from a sensor mounted on a vehicle, a traveling direction and a traveling distance of the vehicle are calculated to calculate a position of the vehicle, and the position of the vehicle is displayed based on the calculated position. 2. Description of the Related Art A device that displays a position of a vehicle on a map is known. However, since the detection values of the traveling distance detection means and the azimuth detection means contain some errors, errors occur in the calculated position of the vehicle obtained by integrating these detection values.

このような誤差を補正するために計算位置と地図上の
検定点とを比較する装置が知られており、例えば特開昭
58−113711号公報に開示されているようなものが提案さ
れている。この装置では、車両の現在位置を、記憶され
た道路地図と比較して、常に車両の走行軌跡が地図道路
上にあるように制御し、車両が右若しくは左に曲がった
場合には、地図から求められる道路の曲率と、方位検出
手段から求められる進行方位の変化による曲率との比較
により、交差点等での車両の走行方位を判定して、車両
の走行軌跡を表示している。
A device that compares a calculated position with a test point on a map in order to correct such an error is known.
One such as disclosed in JP-A-58-113711 has been proposed. In this device, the current position of the vehicle is compared with a stored road map, and control is performed so that the traveling locus of the vehicle is always on the map road. By comparing the obtained curvature of the road with the curvature obtained by the change in the traveling direction obtained by the direction detecting means, the traveling direction of the vehicle at an intersection or the like is determined, and the traveling locus of the vehicle is displayed.

[発明が解決しようとする課題] ところで、こうした従来の装置では、前述した如く、
地図道路と検出される車両の進行方位とによって、地図
道路を選択して車両の位置と地図道路とを一致させて走
行軌跡を表示している。
[Problems to be Solved by the Invention] By the way, in such a conventional device, as described above,
The map road is selected according to the traveling direction of the vehicle detected as the map road, and the traveling locus is displayed by matching the position of the vehicle with the map road.

しかし、交差点等で右左折した際に、外乱が生じて方
位検出手段からの検出信号に検出誤差が生じた場合に
は、また、交差点での分岐路の成す角度が非常に小さ
く、方位検出手段による検出では正確にその侵入路を選
択できない場合には、誤った道路を選択して、その誤っ
た道路上に車両の位置を表示してしまう場合があるとい
う問題があった。更に、方位検出手段に基づく誤った選
択のみならず、走行距離検出手段による距離誤差のため
に、進行道路の選択を誤る場合もあるという問題があっ
た。
However, if a disturbance occurs due to a disturbance when a right or left turn is made at an intersection or the like and a detection error occurs in the detection signal from the azimuth detecting means, the angle formed by the branch road at the intersection is very small, and the azimuth detecting means If the intrusion path cannot be selected accurately by the detection by the method, there is a problem that an erroneous road may be selected and the position of the vehicle may be displayed on the erroneous road. Further, there is a problem that not only an erroneous selection based on the azimuth detecting means but also a selection of a traveling road may be erroneous due to a distance error by the traveling distance detecting means.

そこで本発明は前記の課題を解決することを目的と
し、地図道路の選択を誤ることなく適正な車両の位置を
表示する車両走行位置表示装置を提供することにある。
Therefore, an object of the present invention is to provide a vehicle traveling position display device that displays an appropriate vehicle position without erroneously selecting a map road, with the object of solving the above-mentioned problems.

[課題を解決するための手段] かかる目的を達成すべく、本発明は課題を解決するた
めの手段として次の構成を取った。即ち、第1図に例示
する如く、 車両の走行距離を検出する走行距離検出手段M1と、前
記車両の進行方位を検出する方位検出手段M2と、道路地
図上に設定された複数の検定点を含む地図情報を記憶し
た地図記憶手段M3と、前記走行距離と前記進行方位とに
基づいて計算した車両の計算位置に応じて前記地図情報
と共に表示する位置表示手段M4と、該計算位置を前記車
両が向かいつつある目標検定点に応じて位置補正する位
置補正手段M5とを有する車両走行位置表示装置におい
て、 前記地図記憶手段M3が、前記地図情報として少なくと
も検定点に接続する他の検定点情報を記憶し、 通過した前記検定点に接続し前記計算位置の軌跡と前
記検定点間形状に基づく所定条件にある他の検定点を検
索する検索手段M6と、 該検索手段M6による他の検定点が複数有るときには、
該他の検定点のそれぞれに基づいて前記目標検定点を設
定する複数目標設定手段M7と、 前記複数の目標検定点に基づいて補正したそれぞれの
前記計算位置の内、前記地図道路上から離脱した位置に
ある前記計算位置の計算を停止する離脱手段M8と、 を備えたことを特徴とする車両走行位置表示装置の構
成がそれである。
[Means for Solving the Problems] In order to achieve the object, the present invention has the following configuration as means for solving the problems. That is, as exemplified in FIG. 1, a traveling distance detecting means M1 for detecting a traveling distance of a vehicle, an azimuth detecting means M2 for detecting a traveling azimuth of the vehicle, and a plurality of test points set on a road map. Map storage means M3 for storing map information including the map information, position display means M4 for displaying the map information together with the map information in accordance with the calculated position of the vehicle calculated based on the travel distance and the heading, and the calculated position of the vehicle. And a position correction means M5 for correcting the position according to the target verification point toward which the vehicle is traveling.The map storage means M3 stores at least other verification point information connected to the verification point as the map information. A search means M6 for storing and searching for another test point under predetermined conditions based on the trajectory of the calculated position and the shape between the test points connected to the passed test point, and other test points by the search means M6 are Duplicate When there is,
A plurality of target setting units M7 for setting the target verification points based on each of the other verification points; and a plurality of the calculated positions corrected based on the plurality of target verification points, from the map road. And a departure means M8 for stopping the calculation of the calculated position at the position. This is the configuration of the vehicle traveling position display device.

[作用] 前記構成を有する車両走行位置表示装置は、走行距離
検出手段M1が車両の走行距離を検出し、方位検出手段M2
が車両の進行方位を検出し、地図記憶手段M3が道路地図
上に設定された複数の検定点と少なくとも検定点に接続
する他の検定点情報とを地図情報として記憶する。
[Operation] In the vehicle traveling position display device having the above configuration, the traveling distance detecting means M1 detects the traveling distance of the vehicle, and the azimuth detecting means M2
Detects the traveling direction of the vehicle, and the map storage means M3 stores, as map information, a plurality of test points set on the road map and at least other test point information connected to the test points.

そして、検索手段M6が、通過した前記検定点に接続し
計算位置の軌跡と前記検定点間形状に基づく所定条件に
ある他の検定点を検索し、複数目標設定手段M7が検索手
段M6による他の検定点が複数有るときには、該他の検定
点のそれぞれに基づいて前記目標検定点を設定し、離脱
手段M8が前記複数の目標検定点に基づいて補正したそれ
ぞれの前記計算位置の内、前記地図道路上から離脱した
位置にある前記計算位置の計算を停止する。また、位置
補正手段M5が計算位置を車両が向かいつつある目標検定
点に応じて位置補正し、位置表示手段M4が走行距離と進
行方位とに基づいて計算した車両の計算位置に応じて地
図情報と共に表示する。
Then, the search means M6 connects to the passed test point and searches for another test point under predetermined conditions based on the trajectory of the calculated position and the shape between the test points. When there are a plurality of test points, the target test points are set based on each of the other test points, and among the calculation positions corrected by the departure means M8 based on the plurality of target test points, The calculation of the calculated position at the position departed from the map road is stopped. Further, the position correcting means M5 corrects the calculated position according to the target verification point to which the vehicle is heading, and the position display means M4 calculates the map information according to the calculated position of the vehicle calculated based on the traveling distance and the heading. Display with

[実施例] 以下本発明の実施例を図面に基づいて詳細に説明す
る。
[Example] Hereinafter, an example of the present invention will be described in detail with reference to the drawings.

第3図は本発明の一実施例である車両走行位置表示装
置の概略構成図である。車両には、車速センサ1と、方
位センサ2とが積載されており、車速センサ1は、車両
の走行速度を検出するものである。この走行速度を後述
する電子制御回路20により積分処理することによって、
車両の走行距離が求められる構成となっており、これら
により、走行距離検出手段M1構成している。方位検出手
段M2としての方位センサ2は、車両の走行方位を検出す
るものであり、本実施例では、地磁気を検出して方位を
得るものを用いている。但し、この方位センサ2として
は、ジャイロコンパスによるものや、左右操舵輪の回転
差などから得られる車両のステアリング角を累積して方
位を求めるものなどでもよい。
FIG. 3 is a schematic configuration diagram of a vehicle traveling position display device according to one embodiment of the present invention. The vehicle has a vehicle speed sensor 1 and a direction sensor 2 mounted thereon, and the vehicle speed sensor 1 detects a running speed of the vehicle. The running speed is integrated by an electronic control circuit 20 to be described later.
The traveling distance of the vehicle is determined, and these constitute the traveling distance detecting means M1. The azimuth sensor 2 as the azimuth detecting means M2 detects the traveling azimuth of the vehicle. In the present embodiment, the azimuth sensor 2 detects the terrestrial magnetism to obtain the azimuth. However, the azimuth sensor 2 may be a sensor using a gyro compass or a sensor that obtains the azimuth by accumulating the steering angles of the vehicle obtained from the rotation difference between the left and right steered wheels.

また、地図メモリ4を備えており、これはコンパクト
ディスク等の大容量の記憶装置で構成されている。この
地図記憶手段M3としての地図メモリ4には、例えば東京
都や愛知県あるいは東海地方などの所定範囲の地図デー
タ、及び道路の特徴を書き出した検定点データが記憶さ
れている。地図データは、道路形状、道路幅、道路名、
建物、地名、地形などの地図を再生するためのデータで
ある。検定点データは、表示される車両位置、方位セン
サ2から得られる走行方位、車速センサ1から得られる
走行距離などを補正するために、地図データあるいは実
測に基づいて作成されるデータである。本実施例では、
道路を折れ線の集合により近似し、線の中間点、各折れ
線の端点及び道路の交差点等を検定点としている。そし
て、これらの検定点に関するデータとして下記のような
情報を有している。
Further, a map memory 4 is provided, which comprises a large-capacity storage device such as a compact disk. The map memory 4 serving as the map storage means M3 stores map data in a predetermined range such as Tokyo, Aichi or Tokai region, and test point data in which features of roads are written. Map data includes road shape, road width, road name,
This is data for reproducing maps such as buildings, place names, and terrain. The verification point data is data created based on map data or actual measurement in order to correct the displayed vehicle position, the traveling direction obtained from the direction sensor 2, the traveling distance obtained from the vehicle speed sensor 1, and the like. In this embodiment,
The road is approximated by a set of polygonal lines, and the midpoint of the line, the end point of each polygonal line, the intersection of the roads, and the like are set as test points. Then, it has the following information as data on these test points.

検定点番号 検定点の絶対位置(緯度・経度)Pt 検定点が含まれる領域番号(但し、領域番号とは例え
ば日本全国をいくつかに分割した場合の区画番号) 検定点の両側の折れ線のなす角度(曲率θ) 検定点に接続されている他の検定点の数(i:1〜m) 検定点に接続されている他の検定点の番号 検定点に接続されている他の検定点までの距離(di
si) 検定点に接続されている他の検定点への方位(α) 尚、,,における他の検定点の番号、距離、方
位はの他の検定点の番号に対応した数(i:1〜m)だ
けある。また、の検定点の絶対位置や検定点間距離
は、実測により、若しくは地図から測定される。
Absolute position of the test point number test point (latitude and longitude) P t region number test point is included (however, partition number when the region number several divided e.g. Japan) of the test points on both sides of the fold line Angle (curvature θ) Number of other test points connected to test points (i: 1 to m) Number of other test points connected to test points Other test points connected to test points Distance to (di
s i ) Direction (α i ) to another test point connected to the test point (α i ) where the number, distance, and direction of the other test points in,, are numbers corresponding to the numbers of the other test points (i : 1 to m). Further, the absolute positions of the test points and the distance between the test points are measured by actual measurement or from a map.

更に、コントロールスイッチ6が設けられており、こ
れは、運転者が初期値を入力したり、表示される地図を
選択したりするための各種スイッチで構成されている。
Further, a control switch 6 is provided, which is composed of various switches for the driver to input an initial value and select a map to be displayed.

これらの車速センサ1、方位センサ2、地図メモリ
4、コントロールスイッチ6は、各々電子制御回路20に
接続されている。この電子制御回路20は、周知のCPU2
2、制御用のプログラムやデータを予め格納するROM24、
読み書き可能なRAM26に、入出力回路28がコモンバス30
を介して相互に接続されて構成されている。CPU22は、
車速センサ1、方位センサ2、地図メモリ4、コントロ
ールスイッチ6からの信号を入出力回路28を介して入力
し、これらの信号、ROM24、RAM26内のプログラムやデー
タ等に基づいてCPU22は、入出力回路28、CRTコントロー
ラ32を介してCRT34に駆動信号を出力する。
The vehicle speed sensor 1, the direction sensor 2, the map memory 4, and the control switch 6 are connected to an electronic control circuit 20, respectively. The electronic control circuit 20 includes a well-known CPU 2
2, ROM24 that stores control programs and data in advance,
I / O circuit 28 is connected to common bus 30
And are connected to each other via a. CPU22
Signals from the vehicle speed sensor 1, the azimuth sensor 2, the map memory 4, and the control switch 6 are input via an input / output circuit 28. Based on these signals, programs and data in the ROM 24 and the RAM 26, the CPU 22 The circuit 28 outputs a drive signal to the CRT 34 via the CRT controller 32.

このCRTコントローラ32は、CRT34の表示を制御し、電
子制御回路20から転送される地図データを、CRT34の画
面に地図として再生すると共に、電子制御回路20から転
送される車両の計算位置を、現在表示中の地図上に表示
する構成のものである。
The CRT controller 32 controls the display of the CRT 34, reproduces the map data transferred from the electronic control circuit 20 as a map on the screen of the CRT 34, and displays the calculated position of the vehicle transferred from the electronic control circuit 20 at the present time. It is configured to be displayed on the map being displayed.

尚、電子制御回路20は、車両に搭載することなく、固
定局に設けて、適宜の通信装置によってデータを送受信
して車両位置を再現する構成のものでもよい。
Note that the electronic control circuit 20 may be provided in a fixed station without being mounted on a vehicle, and may be configured to reproduce data of a vehicle position by transmitting and receiving data with an appropriate communication device.

前記電子制御回路20は、図示しない電源スイッチがオ
ンされると、ROM24に予め設定されたプログラムに従っ
て、CPU22が演算処理を実行開始する。
When a power switch (not shown) is turned on, the CPU 22 of the electronic control circuit 20 starts executing arithmetic processing according to a program preset in the ROM 24.

本実施例では、発進前に車両の乗員が、コントロール
スイッチ6を操作して、CRT34に表示される地図を選択
し、この地図上に自らの車両位置を初期位置Pbとして指
示する。あるいは、これ以外にも、前回の車両の運転停
止時の計算位置を不揮発性メモリに格納しておき、この
位置を初期位置Pbとして設定してもよい。
In this embodiment, an occupant of the vehicle before starting operates the control switch 6, to select a map to be displayed on the CRT 34, and instructs the own vehicle position as the initial position P b on this map. Alternatively, other than this, the calculation position upon stopping of the previous vehicle may be stored in non-volatile memory, may be set this position as the initial position P b.

そして、車両が走行を開始すると、車速センサ1から
入力される走行速度を積分して得られる走行距離と、方
位センサ2から得られる進行方位が検出される。車両が
ある距離走行して、検出された走行距離と走行方位とに
基づいて計算された現在の計算位置Vが、CRT34の地図
上に表示される。車両の走行に伴って、地図メモリ4に
予め記憶された検定点Ptを通過すると、計算位置Vの補
正制御処理が行われる。
When the vehicle starts traveling, a traveling distance obtained by integrating the traveling speed input from the vehicle speed sensor 1 and a traveling direction obtained from the direction sensor 2 are detected. The current calculated position V calculated based on the detected traveling distance and the traveling azimuth after the vehicle has traveled a certain distance is displayed on the map of the CRT 34. With the travel of the vehicle, it passes through the pre-stored test point P t in the map memory 4, the correction control process of the computer the position V is performed.

次に、電子制御回路20で行われるこの補正制御処理に
ついて、第3図に示すフローチャートによって説明す
る。
Next, the correction control process performed by the electronic control circuit 20 will be described with reference to the flowchart shown in FIG.

まず、方位センサ2により検出される屈曲後の進行方
位と、屈曲前の進行方位との差及び所定値を比較して、
屈曲か否かを判定する(ステップ100)。屈曲とは、例
えば、交差点で、あるいは大きく曲がった道路で、車両
が左右折する様な場合をいう。本実施例では、例えば、
第7図に示すように、前前回の計算位置Vn-2と前回の計
算位置Vn-1とを結ぶ直線、及び前回の計算位置Vn-1と今
回の計算位置Vnとを結ぶ直線のなす角度である曲率θ
n-1が、所定角度以上となったときに、屈曲したと判定
する。尚、ステアリング操作角度や操作速度等によって
屈曲を判定する構成のものでもよい。
First, a difference between a traveling azimuth after bending detected by the azimuth sensor 2 and a traveling azimuth before bending and a predetermined value are compared.
It is determined whether or not it is bent (step 100). Bending refers to, for example, a case where the vehicle makes a left or right turn at an intersection or a greatly curved road. In this embodiment, for example,
As shown in FIG. 7, a straight line connecting the previous / previous calculation position V n-2 and the previous calculation position V n-1 and connecting the previous calculation position V n-1 and the current calculation position V n Curvature θ, the angle between straight lines
When n-1 is equal to or larger than a predetermined angle, it is determined that the bending is performed. Note that a configuration in which bending is determined based on a steering operation angle, an operation speed, or the like may be used.

ステップ100の処理により屈曲していないと判定され
ると、通過した検定点Pnと後述する追跡処理により設定
される目標検定点Ptとの間の距離disnを走行したか否か
を判定する(ステップ110)。第8図に示すように、本
実施例では、P0P1間、P1P2間、P2P3間、P3P4間、P4P5
等の距離が、それぞれ検定点間距離disnに相当し、予め
地図メモリ4に記憶されている。距離disnを走行したと
判定すると、直進時検定円R1の半径r1が下記式によって
算出される(ステップ120)。
If it is determined not to be bent by the process of step 100, whether the travel distance dis n between the target test point P t, which is set by the tracking processing described below with test point P n passing through determination (Step 110). As shown in FIG. 8, in this embodiment, between P 0 P 1, between P 1 P 2, between P 2 P 3, between P 3 P 4, the distance or the like between the P 4 P 5, respectively test point The distance corresponds to the distance dis n and is stored in the map memory 4 in advance. If it is determined that the vehicle has traveled the distance dis n , the radius r 1 of the straight traveling test circle R 1 is calculated by the following equation (step 120).

r1=K1×disn+e0 ここで、K1は予め実験等によって求められた、主に方
位センサ2の検出誤差による方位誤差係数であり、この
K1×disnは、検定点間を走行した際の方位誤差項であ
る。disnは検定点Pn-1Pn間の距離である。また、e0は地
図誤差等の設定誤差である。
r 1 = K 1 × dis n + e 0 Here, K 1 is an azimuth error coefficient obtained mainly by an experiment or the like, mainly due to a detection error of the azimuth sensor 2.
K 1 × dis n is an azimuth error term when traveling between the verification points. dis n is the distance between the test points P n-1 P n . E 0 is a setting error such as a map error.

続いて、前記ステップ120の距離で算出した半径r1
直進時検定円R1内に計算位置Vがあるか否かを判定する
(ステップ130)。この計算位置Vは、前回通過した検
定点から、車速センサ1及び方位センサ2の検出値に基
づいて算出した位置であり、第8図では、例えば検定点
P0から計算した位置である。
Subsequently, it is determined whether there is calculated the position V in straight running test circle R 1 of the radius r 1 which is calculated by the distance of the step 120 (step 130). The calculated position V is a position calculated based on the detection values of the vehicle speed sensor 1 and the azimuth sensor 2 from the verification point that has passed the previous time. In FIG.
Is a position calculated from P 0.

計算位置Vが直進時検定円R1内にあるときには、検定
点Pnを通過したと判定して、計算位置Vに検定点Pnを引
き込む処理を行って計算位置Vを補正し(ステップ14
0)、例えば、計算位置Vと検定点Pnとの位置の差を求
め、この位置の差に応じた値を計算位置Vから減算して
計算位置Vを補正し、以後はこの補正された計算位置V
に基づいて計算が行われる。例えば、第8図に示す道路
上を走行している場合には、それぞれ検定点P1,P3,P4
おいて引き込み処理が実行される。次に、後述する追跡
処理を実行して(ステップ145)、以後はこの引き込み
処理した検定点Pnからの計算位置Vを算出する。
Calculated when the position V is in the straight running test circle R 1, it is determined to have passed the test point P n, and corrects the calculated position V performs processing to draw the test point P n to calculate the position V (Step 14
0) For example, a difference between the calculated position V and the test point Pn is obtained, and a value corresponding to the difference between the calculated positions is subtracted from the calculated position V to correct the calculated position V. Thereafter, the corrected position is corrected. Calculation position V
The calculation is performed based on For example, when the vehicle is traveling on the road shown in FIG. 8, the pull-in process is executed at the verification points P 1 , P 3 and P 4 respectively. Next, a tracking process described later is executed (step 145), and thereafter, a calculation position V from the test point Pn subjected to the pull-in process is calculated.

一方、前記ステップ130の処理で、計算位置Vが直進
時検定円R1内にないと判定されたときには、離脱処理を
実行する(ステップ150)。この離脱処理では、後述す
る追跡処理において、複数の軌跡を追跡しているときに
は、その追跡中の計算位置Vが直進時検定円R1内にない
ときには、その追跡を中止する。また、追跡中の軌跡が
1本の場合には、車両は地図に示された道路以外の場
所、例えば駐車場等を走行していると判定して、速度セ
ンサ1及び方位センサ2により検出される計算位置Vを
補正せずに、そのままの計算位置Vを表示する処理を実
行する。
On the other hand, in the process of the step 130, calculations position V is when it is determined not to straight running test circle R 1 executes a disengagement process (step 150). In this withdrawal process, the tracking process to be described later, when that track multiple trajectory calculated position V in the tracking when not in straight running test circle R 1 cancels the tracking. In the case where the number of trajectories being tracked is one, it is determined that the vehicle is traveling on a place other than the road indicated on the map, for example, a parking lot, and is detected by the speed sensor 1 and the direction sensor 2. A process of displaying the calculated position V without correcting the calculated position V is performed.

一方、前記ステップ100の処理で、屈曲したと判定さ
れたときには、屈曲時検定円R2の半径r2を下記算出式に
より算出する(ステップ160)。
On the other hand, when it is determined in the process of step 100 that it is bent, the radius r 2 of the bending test circle R 2 is calculated by the following formula (step 160).

r2=K1×disn+K2×Σdis+e1 ここで、K1、disnは、前述した半径r1の算出の際の値
と同じであり、K2は予め実験等により求められた走行距
離の算出に基づく距離誤差係数であり、Σdisは前回屈
曲点からの走行距離、第8図に示す例では検定点P2から
検定点P5までの走行距離である。このK2×Σdisは、前
回屈曲点からの距離誤差項である。e1は方位誤差、距離
誤差等の設定誤差である。
r 2 = K 1 × dis n + K 2 × Σdis + e 1 Here, K 1 and dis n are the same as the values used when calculating the radius r 1 described above, and K 2 is the travel determined in advance by experiments or the like. distance is a distance error coefficient based on the calculation of, Shigumadis the travel distance from the last bending point, in the example shown in FIG. 8 is a traveling distance from the test point P 2 to the test point P 5. This K 2 × Σdis is a distance error term from the previous bending point. e 1 is the setting errors of such azimuthal error, distance error.

次に、この屈曲したとき、例えば交差点、屈折点等で
右若しくは左に曲がったときの曲率最大点Vmaxの算出を
行う(ステップ170)。本実施例では、例えば、第7図
に示すように、前前回の計算位置Vn-2と前回の計算位置
Vn-1とを結ぶ直線、及び前回の計算位置Vn-1と今回の計
算位置Vnとを結ぶ直線とのなす角度である曲率θn-1
算出される。そして、この曲率が最大となる点が曲率最
大点Vmaxとして算出される。
Next, when the bent, for example an intersection, the calculation of the curvature maximum point V max when the turn right or left at the refraction point and the like (step 170). In this embodiment, for example, as shown in FIG. 7, before the previous calculation position V n-2 and the previous compute position
A curvature θ n−1 which is an angle between a straight line connecting V n−1 and a straight line connecting the previous calculation position V n−1 and the current calculation position V n is calculated. The point at which the curvature is maximum is calculated as the curvature maximum point V max.

続いて、前記ステップ160の処理で算出した半径r2
屈曲時検定円R2内に、前記曲率最大点Vmaxがあるか否か
を判定する(ステップ180)。屈曲時検定円R2内にある
と、検定点Pnを通過したと判定して、屈曲点の検定点Pn
を曲率最大点Vmaxに引き込む処理を行い(ステップ19
0)、以後はこの補正された曲率最大点Vmaxに基づいて
計算位置Vの計算が行われる。このように、屈曲点での
補正を行うことにより、積算された距離誤差が解消され
る。尚、第8図に示すような道路である場合に、屈曲時
検定円R2内に複数の検定点Pnが存在する場合には、その
全ての検定点Pnを曲率最大点Vmaxに引き込む処理を行
う。そして、以後はその全ての検定点Pnに基づいて計算
位置Vの計算を行い、走行軌跡の追跡を行う。次に、後
述する追跡処理を実行して(ステップ195)、以後はこ
の引き込み処理した検定点Pnからの計算位置Vを算出す
る。
Subsequently, processing the calculated radius r 2 flexion test within a circle R 2 in the step 160, it is determined whether there is the curvature maximum point V max (step 180). If it is within the flexing test circle R 2 , it is determined that the test point P n has been passed, and the flex point test point P n
The performs processing draw the curvature maximum point V max (step 19
0), thereafter the calculation of calculating the position V is performed based on the corrected curvature maximum point V max. As described above, by performing the correction at the inflection point, the integrated distance error is eliminated. Incidentally, in the case of the road as shown in FIG. 8, when there are a plurality of test points P n in flexion test within a circle R 2 are the all assays point P n of curvature maximum point V max Perform the pull-in process. Thereafter, the calculation position V is calculated based on all the test points Pn , and the traveling locus is tracked. Next, a tracking process described later is executed (step 195), and thereafter, a calculation position V from the test point Pn subjected to the pull-in process is calculated.

一方、ステップ180の処理により、屈曲時検定円R2
に前記曲率最大点Vmaxがないと判定されたときには、前
述した離脱処理を実行して、複数の軌跡を追跡している
ときには、屈曲時検定円R2内に前記曲率最大点Vmaxがな
いと、その検定点Pnからの追跡を中止する。また、追跡
中の軌跡が1本の場合には、車両は地図に示された道路
以外の場所、例えば駐車場等を走行していると判定し
て、速度センサ1及び方位センサ2により検出される計
算位置Vを補正しない処理を行う(ステップ150)。
On the other hand, the process of step 180, when it is determined that there is no time test circle R 2 of curvature maxima V max in the bend, when running a leaving process described above, it is tracking multiple trajectory bends When the curvature maximum point V max is not in time assay in a circle R 2, it stops the track from the test point P n. In the case where the number of trajectories being tracked is one, it is determined that the vehicle is traveling on a place other than the road indicated on the map, for example, a parking lot, and is detected by the speed sensor 1 and the direction sensor 2. A process for not correcting the calculated position V is performed (step 150).

前記ステップ145,150,195の処理を実行すると、若し
くは、ステップ110の処理で、まだ検定点間距離を走行
していないと判定されると、一旦本制御処理を終了す
る。
When the processing in steps 145, 150, and 195 is executed, or when it is determined in the processing in step 110 that the vehicle has not traveled the distance between the verification points, the control processing is temporarily ended.

次に、前述したステップ145,195の追跡処理につい
て、第4図に示すフローチャートによって説明する。
Next, the tracking processing in steps 145 and 195 described above will be described with reference to the flowchart shown in FIG.

まず、ステップ140,190の処理の実行で引き込んだ検
定点Pnに接続する他の検定点が、地図メモリ4に記憶さ
れた検定点データから検索される(ステップ210)。
First, another test point connected to the test point Pn drawn in by executing the processing of steps 140 and 190 is searched from the test point data stored in the map memory 4 (step 210).

次に、引き込んだ検定点Pnと、これに接続する他の検
定点との間の道路距離の内、最小道路距離lminが地図メ
モリ4の検定点データから読み込まれる(ステップ22
0)。そして、車両が前記引き込んだ検定点Pnから最小
道路距離lminの半分(lmin/2)を走行したか否かが判定
される(ステップ230)。最小道路距離lminの半分を走
行していないときには、速度センサ1及び方位センサ2
による検出値から計算した計算位置VをCRT34に表示す
る(ステップ240)。
Next, the minimum road distance l min among the road distances between the drawn verification point P n and other verification points connected thereto is read from the verification point data in the map memory 4 (step 22).
0). Then, it is determined whether or not the vehicle has traveled half the minimum road distance l min (l min / 2) from the pulled-in verification point P n (step 230). When the vehicle is not traveling on a half of the minimum road distance l min , the speed sensor 1 and the direction sensor 2
Is displayed on the CRT 34 (step 240).

最小道路距離lminの半分を走行したと判定されると、
前記引き込んだ検定点Pnと現在の計算位置Vとを結ぶ直
線の車両方位、及び前記引き込んだ検定点Pnとこれに接
続した他の検定点とを結んだ道路方位の差の絶対値が、
所定角度α(例えば30度)より小さいか否かを判定する
(ステップ250)。即ち、所定角度αより小さい道路が
存在するか否かを判定する。所定角度αより小さな道路
が存在する場合には、その道路数が1であるか否かを判
定する(ステップ260)。尚、本実施例では最小道路距
離lminの半分を走行したときに方位を判定しているが、
最小道路距離lminの半分に限らず、車両方位と道路方位
との比較を適正に行うことができる所定距離走行後であ
れば実施可能である。
When it is determined that the vehicle has traveled half of the minimum road distance l min ,
The absolute value of the difference between the vehicle direction of a straight line connecting the retracted test point Pn and the current calculated position V and the road direction connecting the retracted test point Pn and another test point connected thereto is ,
It is determined whether the angle is smaller than a predetermined angle α (for example, 30 degrees) (step 250). That is, it is determined whether a road smaller than the predetermined angle α exists. If there is a road smaller than the predetermined angle α, it is determined whether or not the number of roads is 1 (step 260). In this embodiment, the azimuth is determined when the vehicle travels half of the minimum road distance l min .
The present invention is not limited to a half of the minimum road distance l min , and can be implemented as long as the vehicle travels a predetermined distance at which the comparison between the vehicle direction and the road direction can be properly performed.

道路数が1であるときには、その検定点Pnを目標検定
点Ptとする(ステップ270)。即ち、第9図に示すよう
な分岐路の成す角度が大きい道路である場合には、検定
点P22を通過した後、最小道路距離lmin(この場合に
は、P22P23間距離)の半分を走行したときに、車両方位
P22V及び検定点間の道路方位P22P23及びP22P24の差の絶
対値が、所定角度αより小さい道路P22P24の検定点P24
を目標検定点Ptとして設定する。そして、前述した補正
制御処理の実行の際、ステップ110の処理において、直
前に通過した検定点P22と目標検定点Ptとの間の距離を
走行したか否かが判定される。
When the number of roads is 1, and its test points P n and the target test point P t (step 270). That is, when the angle formed by the branch path, as shown in FIG. 9 is a great road, after passing through the test point P 22, the minimum road distance l min (in this case, the distance between P 22 P 23) When traveling half of the
The absolute value of the difference between the road direction P 22 P 23 and P 22 P 24 between P 22 V and assay points, test points P 24 of a predetermined angle α is smaller than the road P 22 P 24
Is set as the target test point Pt. Then, during the execution of the above-described correction control process, in the process of step 110, whether the vehicle has traveled the distance between the test point P 22 and the target test point P t that has passed immediately before it is determined.

一方、道路数が複数ある場合には、既に追跡していた
追跡数に新たな道路数を加えてその値から1を減算し、
新たな追跡数とする(ステップ280)。そして、この追
跡数だけの追跡道路に応じた検定点を全て目標検定点Pt
として設定する(ステップ290)。即ち、第10図に示す
ような分岐路の成す角度が小さい道路である場合には、
車両方位P32Vと、検定点間の道路方位P32P33及びP32P34
との差の絶対値が小さく、共に所定角度αより小さいの
で、検定点P32を通過した後、最小道路距離lmin(この
場合には、P32P34間距離)の半分を走行したときに、検
定点P33及びP34を共に目標検定点Ptとして設定する。
On the other hand, when there are a plurality of roads, the new number of roads is added to the number of tracks already tracked, and 1 is subtracted from the value.
A new tracking number is set (step 280). Then, all the verification points corresponding to the tracked roads of this number of tracks are set as the target verification points P t
(Step 290). That is, when the road formed by the forked road as shown in FIG. 10 has a small angle,
Vehicle direction P 32 V and road direction P 32 P 33 and P 32 P 34 between the verification points
The absolute value is small, both less than a predetermined angle α of the difference between, after passing through the test point P 32, the minimum road distance l min (in this case, between the distance P 32 P 34) when traveling along one half of to set the test points P 33 and P 34 as the target test point P t together.

そして、この設定した目標検定点Ptの全てについて、
前述した補正制御処理により設定した全ての目標検定点
Ptについて繰り返し実行して、車両の走行軌跡を追跡
し、前記ステップ150の離脱処理が実行された際に、離
脱条件に合致した目標検定点Ptは消去してそれ以後の追
跡を止める。
And, for all of the target test point P t was this setting,
All target test points set by the correction control process described above
Repeatedly performed for P t, track the travel path of the vehicle, when the withdrawal process of the step 150 is executed, the target test point P t that matches the withdrawal conditions stop subsequent track erased.

一方、ステップ250の処理の実行で、所定角度αより
小さな道路が存在しないと判定されると、通過した検定
点Pnに接続している他の検定点が直線道路上であるか否
かを判定する(ステップ300)。接続する他の検定点が
直線道路上である場合には、前記ステップ150の処理と
同様に、離脱処理を実行する(ステップ130)。あるい
は、接続する他の検定点が直線道路上でない場合、即
ち、屈曲路等である場合には、距離誤差走行か否かを判
定する(ステップ320)。即ち、第11図に示すようなT
字路を走行して道路に突き当たって曲がった場合で、計
算位置Vの軌跡が検定点間距離よりも長い場合に、屈曲
が検出される前に(ステップ100)、検定点間距離を走
行後は(ステップ110)、検定点P52の引き込み処理が実
行される(ステップ140)。その場合には、一旦、所定
角度αより小さな道路が存在しないと判定され(ステッ
プ250)、また、通過検定点P52は直線道路ではないと判
定される(ステップ300)。このような場合には、すぐ
に離脱と判定するのではなく、距離誤差走行であると判
定して、ステップ230以下の処理を実行して、最小道路
距離lminの半分を走行するまで、計算位置VをCRT34に
表示する(ステップ240)。最小道路距離lminの半分を
走行後に、ステップ250以下の処理を実行して、屈曲時
の処理(ステップ100〜195)を実行する。最小道路距離
lminの半分を走行後に、所定角度αより小さな道路が存
在しない場合に、離脱処理を実行する(ステップ31
0)。
On the other hand, when it is determined in the execution of the process of step 250 that there is no road smaller than the predetermined angle α, it is determined whether another verification point connected to the passed verification point Pn is on a straight road. A determination is made (step 300). If the other verification point to be connected is on a straight road, a departure process is executed as in the process of step 150 (step 130). Alternatively, if the other verification point to be connected is not on a straight road, that is, a curved road or the like, it is determined whether or not the vehicle is traveling with a distance error (step 320). That is, T as shown in FIG.
In the case where the vehicle travels along a lane and hits the road and turns, and the locus of the calculated position V is longer than the distance between the verification points, the vehicle travels over the distance between the verification points before the bending is detected (step 100). (step 110), pull-in process of the test point P 52 is performed (step 140). In that case, once it is determined that a small road is not present than the predetermined angle alpha (step 250), also passing test point P 52 is determined not to be a straight road (Step 300). In such a case, rather than immediately determining that the vehicle has left, it is determined that the vehicle is traveling with a distance error, and the processing of step 230 and subsequent steps is performed until the vehicle travels half of the minimum road distance l min. The position V is displayed on the CRT 34 (step 240). After traveling the half of the minimum road distance l min , the processing of step 250 and thereafter is executed to execute the processing at the time of bending (steps 100 to 195). Minimum road distance
After traveling half of l min , if there is no road smaller than the predetermined angle α, a departure process is executed (step 31).
0).

前記ステップ270,290,310の処理を実行すると、一旦
本追跡処理を終了する。
When the processes of steps 270, 290, and 310 are executed, the tracking process ends once.

前述した処理の実行により、追跡する目標検定点Pt
複数存在することになり、離脱処理(ステップ150,31
0)の実行による消去だけでは、追跡する数が多くなる
場合がある。追跡数が多くなると補正制御処理、追跡処
理等の負担となるので、誤り率を用いて、追跡数を制限
することとしてもよい。この誤り率を用いた処理につい
て、第5図のフローチャートによって説明する。
The execution of the process described above, the target test point P t to track is that there exist a plurality of withdrawal (step 150,31
If only the erasure is performed by executing (0), the number to be tracked may increase. If the number of tracings increases, the burden on correction control processing, tracing processing, and the like increases. Therefore, the number of tracings may be limited using the error rate. The processing using this error rate will be described with reference to the flowchart of FIG.

まず、ステップ280の処理による追跡数が1より大き
いか否かを判定し(ステップ400)、追跡数が1より大
きい場合に、前記ステップ140,190の引き込み処理を実
施したか否かを判定する(ステップ410)。引き込み処
理を実行したときには、下記式により追跡している複数
の軌跡の各々について誤り率Re(N)を算出する(ステ
ップ420)。
First, it is determined whether or not the tracking number in the process of step 280 is greater than 1 (step 400). If the tracking number is greater than 1, it is determined whether or not the pull-in process of steps 140 and 190 has been performed (step 400). 410). When the pull-in process is executed, the error rate Re (N) is calculated for each of the plurality of trajectories tracked by the following equation (step 420).

Re(N)=ΣΔd/Σl ここで、ΣΔdは、第12図に示すように、積算距離Σ
lを走行している間に、各検定点での計算位置Vを補正
する際、計算位置Vと各検定点との差Δdnの総和であ
る。Nは追跡している複数の軌跡に付された連続番号で
ある。
Re (N) = ΣΔd / Σl Here, ΣΔd is, as shown in FIG.
while traveling l, when correcting the calculated position V at each test point is the calculation position V sum of differences [Delta] d n between each test point. N is a serial number assigned to a plurality of tracks being tracked.

誤り率Re(N)を算出すると、この誤り率Re(N)
が、後述する最小誤り率Reminに係数Kを乗算した値よ
り大きいか否かを判定する(ステップ430)。誤り率Re
(N)が、最小誤り率Reminに係数Kを乗算した値より
大きいと、番号Nの追跡軌跡を追跡リストから削除する
(ステップ440)。そして、番号N及び追跡数をそれぞ
れインクリメントし(ステップ450)、削除した番号N
の追跡軌跡以降の追跡データを順次シフトして追跡リス
トの詰め替えを行う(ステップ460)。
When the error rate Re (N) is calculated, the error rate Re (N)
Is greater than a value obtained by multiplying a minimum error rate Re min, which will be described later, by a coefficient K (step 430). Error rate Re
If (N) is larger than the value obtained by multiplying the minimum error rate Re min by the coefficient K, the tracking trajectory with the number N is deleted from the tracking list (step 440). Then, the number N and the tracking number are respectively incremented (step 450), and the deleted number N
The tracking data after the tracking trajectory is sequentially shifted to refill the tracking list (step 460).

一方、前記ステップ430の処理により、誤り率Re
(N)が、最小誤り率Reminに係数Kを乗算した値以下
であると判定されると、誤り率Re(N)が、最小誤り率
Reminより小さいか否かを判定する(ステップ470)。誤
り率Re(N)が最小誤り率Reminより小さいと、最小誤
り率Reminをこの誤り率Re(N)として、最小誤り率Re
minを更新する(ステップ480)。
On the other hand, the error rate Re
When it is determined that (N) is equal to or smaller than the value obtained by multiplying the minimum error rate Re min by the coefficient K, the error rate Re (N) is set to the minimum error rate Re (N).
It is determined whether it is smaller than Re min (step 470). And an error rate Re (N) is less than the minimum error rate Re min, the minimum error rate Re min as the error rate Re (N), the minimum error rate Re
The min is updated (step 480).

前記ステップ460,480の処理を終了すると、若しく
は、ステップ470の処理により、誤り率Re(N)が最小
誤り率Remin以上であると判定されると、あるいは、ス
テップ410の処理により引き込み処理を実行していない
と判定されると、番号Nに1を加える(ステップ49
0)。続いて、番号Nが追跡数より大きいか否かを判定
し(ステップ500)、番号Nが追跡数より大きいときに
は、一旦全ての誤り率Re(N)の検定を終了したと判断
して、再び番号Nを1とする(ステップ510)。一方、
番号Nが追跡数以下であるときには、全ての誤り率Re
(N)の検定を終了していないと判定して、一旦本制御
処理を終了し、他の制御処理と共に、本制御処理を繰り
返し実行して、全ての番号Nの誤り率Re(N)の検定を
行う。
When the processing in steps 460 and 480 is completed, or when it is determined in step 470 that the error rate Re (N) is equal to or greater than the minimum error rate Re min , or in step 410, the pull-in processing is executed. If it is determined that the number is not present, 1 is added to the number N (step 49).
0). Subsequently, it is determined whether or not the number N is larger than the tracking number (step 500). If the number N is larger than the tracking number, it is once determined that all the error rate Re (N) tests have been completed, and again. The number N is set to 1 (step 510). on the other hand,
When the number N is equal to or less than the tracking number, all error rates Re
It is determined that the test of (N) has not been completed, the control process is temporarily terminated, and this control process is repeatedly executed together with other control processes, so that the error rates Re (N) of all the numbers N are obtained. Perform the test.

このように、追跡している全ての軌跡について、誤り
率Re(N)を算出し、誤り率Re(N)が所定値K×Re
minより大きいときには、その番号Nの追跡軌跡の追跡
を止めて、追跡数を制限する。尚、本実施例では、所定
値K×Reminより大きいときに追跡を中止しているが、
誤り率Re(N)が小さいものから順に所定数のみ追跡を
すこることとしても実施可能である。
As described above, the error rate Re (N) is calculated for all the trajectories being tracked, and the error rate Re (N) is set to the predetermined value K × Re.
When it is larger than min, the tracking of the tracking locus of the number N is stopped, and the number of tracking is limited. In this embodiment, the tracking is stopped when it is larger than the predetermined value K × Re min ,
It is also feasible to track only a predetermined number in ascending order of the error rate Re (N).

こうして、前述した処理により求められた計算位置V
は、第6図に示す表示割込処理を実行して、車両の現在
の計算位置VをCRT34に表示する。
Thus, the calculated position V obtained by the above-described processing
Executes the display interruption process shown in FIG. 6 and displays the current calculated position V of the vehicle on the CRT 34.

まず、車両の現在の誤り率Re(N)が最も小さい計算
位置Vに応じた、地図上の位置が算出される(ステップ
600)。次に、CRT34上に表示している地図を、スクロー
ルする必要があるか否かを判定する(ステップ610)。
必要があるときには、表示する地図の範囲を変更し(ス
テップ620)、CRT34上に地図を表示して(ステップ63
0)、この地図上に、前記追跡処理を行っている車両軌
跡の内、誤り率Re(N)が最も小さい計算位置Vに応じ
た車両の現在位置の軌跡が表示される(ステップ64
0)。この現在位置の表示の際に、複数の軌跡を追跡中
であるときには、位置マークの色を変えてもよい。ま
た、2〜3個程度であれば、誤り率Re(N)が小さい複
数の位置マークを同時に表示することとしてもよい。
First, a position on the map is calculated according to the calculated position V where the current error rate Re (N) of the vehicle is the smallest (step S1).
600). Next, it is determined whether the map displayed on the CRT 34 needs to be scrolled (step 610).
When necessary, the range of the map to be displayed is changed (step 620), and the map is displayed on the CRT 34 (step 63).
0), the locus of the current position of the vehicle corresponding to the calculated position V with the smallest error rate Re (N) among the locus of the vehicle on which the tracking process is being performed is displayed on this map (step 64).
0). In displaying the current position, the color of the position mark may be changed when a plurality of trajectories are being tracked. In addition, if the number is about two or three, a plurality of position marks having a small error rate Re (N) may be simultaneously displayed.

尚、前記ステップ600〜640の処理の実行が位置表示手
段M4として働き、ステップ100〜190の処理の実行が位置
補正手段M5として働き、ステップ210〜230,250の処理の
実行が検索手段M6として働き、ステップ190,260〜290の
処理の実行が複数目標設定手段M7として働き、ステップ
150,310の処理の実行が離脱手段M8として働く。
The execution of the processing of steps 600 to 640 functions as the position display means M4, the execution of the processing of steps 100 to 190 functions as the position correction means M5, and the execution of the processing of steps 210 to 230, 250 functions as the search means M6, The execution of the processing of steps 190, 260 to 290 functions as the multi-target setting means M7,
Execution of the processing of 150 and 310 functions as the detachment means M8.

前述した如く、本実施例の車両走行位置表示装置は、
屈曲時に(ステップ100)、屈曲時検定円R2内にある全
ての検定点を引き込む処理(ステップ190)を行う。ま
た、最小道路距離lminの半分を走行したと判定されると
(ステップ230)、車両方位及び道路方位の差の絶対値
が、所定角度αより小さいか否かを判定する(ステップ
250)。道路数が複数ある場合には、既に追跡していた
追跡数に新たな道路数を加えてその値から1を減算し
て、新たな追跡数とする(ステップ280)。即ち、通過
した検定点に接続する計算位置の軌跡と、交差点や分岐
路等などの検定点間形状に基づく所定条件にある検定点
からの追跡処理を行うために、この追跡数だけの追跡道
路に応じた目標検定点Ptを設定する(ステップ290)。
そして、この設定した目標検定点Ptの全てについて、前
述した補正制御処理を繰り返し実行して、車両の走行軌
跡を追跡し、誤り率の小さな車両の計算位置に応じて車
両の位置をCRT34に表示する(ステップ600〜640)。
尚、前記ステップ150の離脱処理が実行された際に、そ
の離脱処理に合致した目標検定点Ptは消去してそれ以後
の追跡を止める(ステップ150,310)。
As described above, the vehicle traveling position display device according to the present embodiment includes:
During bending (step 100), performs processing to draw all assays point in the flexion test within a circle R 2 (step 190). When it is determined that the vehicle has traveled half of the minimum road distance l min (step 230), it is determined whether the absolute value of the difference between the vehicle direction and the road direction is smaller than a predetermined angle α (step 230).
250). If there are a plurality of roads, the new number of roads is added to the number of tracks already tracked, and 1 is subtracted from the value to obtain a new number of tracks (step 280). In other words, in order to perform tracking processing from the trajectory of the calculation position connected to the passed verification point and the verification point under a predetermined condition based on the shape between the verification points such as an intersection or a branch road, the number of tracking roads equal to the number of tracks is required. to set a target test point P t in accordance with the (step 290).
Then, all of the set target test point P t, then repeat the correction control process described above to track the traveling path of the vehicle, the position of the vehicle according to the calculated position of the small vehicle error rate CRT34 It is displayed (steps 600 to 640).
Incidentally, when the withdrawal process of the step 150 is executed, the target test point P t that meet the withdrawal process stop subsequent track erased (step 150,310).

従って、車両が走行している道路を選択しなければな
らないときには、走行距離や進行方位の検出結果に従っ
て一本の道路のみにその後の追跡を絞るのではなく、車
両が走行している可能性のある道路を全て追跡し、走行
距離や進行方位等の誤差による誤った道路の選択を防止
する。また、その後に車両の計算位置Vと道路形状が一
致しなくなったときに、若しくは誤り率を用いてその追
跡を止める。よって、走行距離の累積誤差のために、誤
った道路の選択を行うことがなく、また、進行方位の検
出に誤差があっても、誤った道路への侵入を選択するこ
とがない。
Therefore, when it is necessary to select the road on which the vehicle is traveling, it is not possible to narrow down subsequent tracking to only one road in accordance with the detection results of the traveling distance and the traveling direction, but rather the possibility that the vehicle is traveling. It tracks all roads and prevents erroneous road selection due to errors such as mileage and heading. Further, when the calculated position V of the vehicle and the road shape no longer match, the tracking is stopped using the error rate. Therefore, an erroneous road is not selected due to the accumulated error of the traveling distance, and even if there is an error in the detection of the traveling direction, an erroneous road is not selected.

以上本発明はこの様な実施例に同等限定されるもので
はなく、本発明の要旨を逸脱しない範囲において種々な
る態様で実施し得る。
As described above, the present invention is not limited to such embodiments, and can be implemented in various modes without departing from the gist of the present invention.

[発明の効果] 以上詳述したように本発明の車両走行位置表示装置
は、車両が走行している道路を選択しなければならない
ときには、車両が走行している可能性のある道路を全て
追跡し、走行距離や進行方位等の誤差による誤った道路
の選択を防止する。よって、走行距離の累積誤差のため
に、誤った道路の選択を行うことがなく、また、進行方
位の検出に誤差があっても、誤った道路への侵入を選択
することがないという効果を奏する。
[Effects of the Invention] As described in detail above, the vehicle traveling position display device of the present invention tracks all the roads on which the vehicle may be traveling when it is necessary to select the road on which the vehicle is traveling. In addition, an erroneous selection of a road due to an error such as a traveling distance or a traveling direction is prevented. Therefore, an erroneous road is not selected due to the accumulated error of the traveling distance, and even if there is an error in the detection of the traveling direction, an entry to an erroneous road is not selected. Play.

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

第1図は本発明の車両走行位置表示装置の基本的構成を
例示するブロック図、第2図は本発明の一実施例として
の車両走行位置表示装置の概略構成図、第3図は本実施
例の電子制御回路において行われる補正制御処理の一例
を示すフローチャート、第4図は同じく追跡処理の一例
を示すフローチャート、第5図は同じく誤り率制御処理
の一例を示すフローチャート、第6図は同じく表示割込
処理の一例を示すフローチャート、第7図は本実施例の
屈曲時の曲率を説明する説明図、第8図は本実施例の車
両の作動の一例を示す説明図、第9図は本実施例の分岐
路走行時の作動の一例を示す説明図、第10図は本実施例
の角度の小さな分岐路走行時の作動の一例を示す説明
図、第11図は本実施例の屈曲路での作動の一例を示す説
明図、第12図は本実施例の誤り率算出の説明図である。 M1……走行距離検出手段 M2……方位検出手段、M3……地図記憶手段 M4……位置表示手段、M5……位置補正手段 M6……検索手段 M7……複数目標設定手段 M8……離脱手段 1……車速センサ、2……方位センサ 4……地図メモリ、20……電子制御回路 34……CRT
FIG. 1 is a block diagram illustrating the basic configuration of a vehicle travel position display device according to the present invention, FIG. 2 is a schematic configuration diagram of a vehicle travel position display device as one embodiment of the present invention, and FIG. 4 is a flowchart illustrating an example of a correction control process performed in the electronic control circuit of the example, FIG. 4 is a flowchart illustrating an example of the tracking process, FIG. 5 is a flowchart illustrating an example of the error rate control process, and FIG. FIG. 7 is a flowchart showing an example of a display interruption process, FIG. 7 is an explanatory diagram for explaining the curvature at the time of bending in the present embodiment, FIG. 8 is an explanatory diagram for showing an example of the operation of the vehicle in the present embodiment, and FIG. FIG. 10 is an explanatory view showing an example of the operation of the present embodiment at the time of traveling on a forked road, FIG. 10 is an explanatory view showing an example of the operation of the present embodiment at the time of traveling at a small angle on a branched road, and FIG. Explanatory diagram showing an example of operation on a road, FIG. Of an illustration of the error rate calculation. M1… running distance detecting means M2… azimuth detecting means, M3… map storing means M4… position displaying means, M5… position correcting means M6… searching means M7… multiple target setting means M8… detaching means 1 ... vehicle speed sensor, 2 ... direction sensor 4 ... map memory, 20 ... electronic control circuit 34 ... CRT

───────────────────────────────────────────────────── フロントページの続き (72)発明者 深谷 広保 愛知県刈谷市昭和町1丁目1番地 日本 電装株式会社内 (72)発明者 杉本 浩伸 愛知県豊田市トヨタ町1番地 トヨタ自 動車株式会社 (56)参考文献 特開 昭61−180400(JP,A) 特開 昭61−57982(JP,A) 特開 昭63−127113(JP,A) 特開 昭63−148115(JP,A) 特開 昭63−196813(JP,A) 特開 昭63−196814(JP,A) 特開 平1−41817(JP,A) 特開 平1−250817(JP,A) 特開 平1−277716(JP,A) 特開 平2−140615(JP,A) 実開 平1−71610(JP,U) ──────────────────────────────────────────────────続 き Continuing from the front page (72) Inventor Hiroyasu Fukaya 1-1-1, Showa-cho, Kariya-shi, Aichi Japan Inside Denso Co., Ltd. (72) Inventor Hironobu Sugimoto 1-Toyota-cho, Toyota-shi, Aichi Prefecture Toyota Motor Corporation (56) References JP-A-61-180400 (JP, A) JP-A-61-57982 (JP, A) JP-A-63-127113 (JP, A) JP-A-63-148115 (JP, A) JP-A-63-196813 (JP, A) JP-A-63-196814 (JP, A) JP-A-1-41817 (JP, A) JP-A-1-250817 (JP, A) JP-A-1-277716 (JP JP, A) JP-A-2-140615 (JP, A) JP-A-1-71610 (JP, U)

Claims (1)

(57)【特許請求の範囲】(57) [Claims] 【請求項1】車両の走行距離を検出する走行距離検出手
段と、前記車両の進行方位を検出する方位検出手段と、
道路地図上に設定された複数の検定点を含む地図情報を
記憶した地図記憶手段と、前記走行距離と前記進行方位
とに基づいて計算した車両の計算位置に応じて前記地図
情報と共に表示する位置表示手段と、該計算位置を前記
車両が向かいつつある目標検定点に応じて位置補正する
位置補正手段とを有する車両走行位置表示装置におい
て、 前記地図記憶手段が、前記地図情報として少なくとも検
定点に接続する他の検定点情報を記憶し、 通過した前記検定点に接続し前記計算位置の軌跡と前記
検定点間形状に基づく所定条件にある他の検定点を検索
する検索手段と、 該検索手段による他の検定点が複数有るときには、該他
の検定点のそれぞれに基づいて前記目標検定点を設定す
る複数目標設定手段と、 前記複数の目標検定点に基づいて補正したそれぞれの前
記計算位置の内、前記地図道路上から離脱した位置にあ
る前記計算位置の計算を停止する離脱手段と、 を備えたことを特徴とする車両走行位置表示装置。
A traveling distance detecting means for detecting a traveling distance of the vehicle; a direction detecting means for detecting a traveling direction of the vehicle;
Map storage means for storing map information including a plurality of verification points set on a road map, and a position to be displayed together with the map information according to a calculated position of the vehicle calculated based on the traveling distance and the heading. A vehicle travel position display device having display means and position correction means for correcting the calculated position according to a target verification point to which the vehicle is heading, wherein the map storage means includes at least a verification point as the map information. Search means for storing information of other test points to be connected, connecting to the passed test points, and searching for other test points under predetermined conditions based on the trajectory of the calculated position and the shape between the test points; When there are a plurality of other test points, a plurality of target setting means for setting the target test points based on each of the other test points; and correcting based on the plurality of target test points. And a departure means for stopping the calculation of the calculated position at a position deviated from the map road among the calculated positions.
JP32154488A 1988-12-20 1988-12-20 Vehicle running position display device Expired - Lifetime JP2752117B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP32154488A JP2752117B2 (en) 1988-12-20 1988-12-20 Vehicle running position display device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP32154488A JP2752117B2 (en) 1988-12-20 1988-12-20 Vehicle running position display device

Publications (2)

Publication Number Publication Date
JPH02165010A JPH02165010A (en) 1990-06-26
JP2752117B2 true JP2752117B2 (en) 1998-05-18

Family

ID=18133743

Family Applications (1)

Application Number Title Priority Date Filing Date
JP32154488A Expired - Lifetime JP2752117B2 (en) 1988-12-20 1988-12-20 Vehicle running position display device

Country Status (1)

Country Link
JP (1) JP2752117B2 (en)

Also Published As

Publication number Publication date
JPH02165010A (en) 1990-06-26

Similar Documents

Publication Publication Date Title
JP2526876B2 (en) Vehicle traveling position display device
JPH0342679B2 (en)
JPH0561410A (en) Vehicle position detecting device
JP2811520B2 (en) How to correct the position of vehicle navigation
JPH10300492A (en) Locator
JP2002318122A (en) Device and method for measuring azimuth
JPH0560566A (en) Method for modifying vehicle position
JP2752117B2 (en) Vehicle running position display device
JP2502432B2 (en) Vehicle position detection device
JP2653859B2 (en) Vehicle running position display device
JP2752113B2 (en) Vehicle running position display device
JPH07109366B2 (en) Current position display of mobile
JP2702529B2 (en) Vehicle running position display device
JP2725901B2 (en) Vehicle position correction method
JPH0561408A (en) Vehicle position correcting method
JP2645479B2 (en) Vehicle running position display device
JPH0467300A (en) Vehicle position determining method
JP2897440B2 (en) Vehicle running position display device
JP3551473B2 (en) Vehicle travel position estimation device
JP2586439B2 (en) Travel position display device for vehicles
JP3284773B2 (en) Vehicle running position display device
JPH0670568B2 (en) Driving route display device
JP2630265B2 (en) Travel route display device for vehicles
JP3046389B2 (en) Vehicle position detection device for in-vehicle navigator
JP2800534B2 (en) Vehicle position detection device

Legal Events

Date Code Title Description
EXPY Cancellation because of completion of term