JP2003337029A - Position detecting device - Google Patents

Position detecting device

Info

Publication number
JP2003337029A
JP2003337029A JP2002142595A JP2002142595A JP2003337029A JP 2003337029 A JP2003337029 A JP 2003337029A JP 2002142595 A JP2002142595 A JP 2002142595A JP 2002142595 A JP2002142595 A JP 2002142595A JP 2003337029 A JP2003337029 A JP 2003337029A
Authority
JP
Japan
Prior art keywords
vehicle
information
vehicle position
map
gps
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
JP2002142595A
Other languages
Japanese (ja)
Other versions
JP3932975B2 (en
Inventor
Nobuaki Miki
修昭 三木
Takashi Naito
貴 内藤
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.)
Aisin AW Co Ltd
Original Assignee
Aisin AW Co Ltd
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 Aisin AW Co Ltd filed Critical Aisin AW Co Ltd
Priority to JP2002142595A priority Critical patent/JP3932975B2/en
Publication of JP2003337029A publication Critical patent/JP2003337029A/en
Application granted granted Critical
Publication of JP3932975B2 publication Critical patent/JP3932975B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Position Fixing By Use Of Radio Waves (AREA)
  • Navigation (AREA)
  • Traffic Control Systems (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To accurately detect an actual relative positional relation between own vehicle and another vehicle by receiving positional information, which is used to detect the position of a vehicle, from the other vehicles traveling near the its own vehicle and specifying positions of its own vehicle and the other vehicles. <P>SOLUTION: The position detecting device is provided with an own vehicle information generating section 12 which generates positional information of its own vehicle, an other vehicle information receiving section 13 which receives positional information of the other vehicles generated by the other vehicles, a map reading section which reads a map, and a position specifying section 14 which calculates the relative positional relation between its own vehicle and the other vehicles based on both GPS information contained in the positional information of its own vehicle and GPS information contained in the positional information of the other vehicles, makes the positions of its own vehicle and the other vehicles match with the read map and specifies them while keeping the relative positional relation. <P>COPYRIGHT: (C)2004,JPO

Description

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

【0001】[0001]

【発明の属する技術分野】本発明は、位置検出装置に関
するものである。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a position detecting device.

【0002】[0002]

【従来の技術】従来、交通事故が多数発生しており、交
通事故による死傷者も多数に上っている。また、交通事
故にまでは至らなくても、交通事故を引き起こしかねな
い危険な状態、例えば、車両同士が異常に接近する状態
等は、より多く発生していると考えられ、このような危
険な状態になることを未然に防止することが、交通事故
の減少につながるものである。
2. Description of the Related Art Conventionally, a large number of traffic accidents have occurred, and a large number of casualties have been caused by the traffic accidents. Moreover, even if a traffic accident does not occur, it is considered that more dangerous situations that may cause a traffic accident, such as a situation where vehicles are abnormally approaching each other, occur. Preventing a situation from occurring will reduce the number of traffic accidents.

【0003】そして、交通事故の原因を分析すると、死
者が発生した交通事故の約半分が車両の発見の遅れによ
って引き起こされた事故であるとされている。このこと
から、車両の運転者同士が互いの車両の位置を的確に把
握することが交通事故を減少させるために必要なことが
明らかである。そのため、車両の運転者が、自車周辺を
走行する他車位置を的確に把握することができるととも
に、自車位置を自車周辺を走行する他車の運転者が的確
に把握することができるようにする装置が、運転を支援
するための装置として必要とされている。
Analysis of the causes of traffic accidents suggests that about half of the traffic accidents that cause fatalities are caused by delays in finding vehicles. From this, it is clear that it is necessary for the drivers of the vehicles to accurately grasp the positions of the vehicles with each other in order to reduce traffic accidents. Therefore, the driver of the vehicle can accurately grasp the position of another vehicle traveling around the own vehicle, and the driver of another vehicle traveling around the own vehicle can accurately grasp the position of the own vehicle. What is needed is a device to assist driving.

【0004】そこで、GPS(Global Posi
tioning System)を利用した位置検出装
置が提案されている(特開平8−43517号公報参
照)。この場合、該位置検出装置は、他車が送信した他
車の位置情報を受信し、該位置情報に基づいて他車の位
置を特定し、一方、自車が受信したGPS情報に基づい
て自車の位置を特定する。そして、自車及び他車の現在
地を特定し、運転者に自車と他車との位置関係を表示し
て報知するようになっている。
Therefore, GPS (Global Posi)
There is proposed a position detecting device that utilizes a positioning system (see Japanese Patent Laid-Open No. 8-43517). In this case, the position detection device receives the position information of the other vehicle transmitted by the other vehicle, identifies the position of the other vehicle based on the position information, and on the other hand, based on the GPS information received by the own vehicle. Locate the car. Then, the current locations of the own vehicle and the other vehicle are specified, and the driver is displayed and notified of the positional relationship between the own vehicle and the other vehicle.

【0005】[0005]

【発明が解決しようとする課題】しかしながら、前記従
来の位置検出装置においては、誤差が大きく自車と他車
との位置関係を正確に検出することができない。この場
合、位置検出装置は、他車が送信した他車位置情報を受
信し、該他車位置情報に基づいて他車位置を特定し、自
車位置をGPS衛星から受信したGPS情報に基づいて
特定することで自車と他車との位置関係を特定してい
る。この際、自車と他車において異なる算出方法で位置
情報を算出し、送信を行っている。ここで、位置情報の
算出方法が異なる場合には、GPS情報にもともと含ま
れている誤差に加えて、算出方法が異なることによる誤
差が発生してしまう。そのため、自車と他車との位置情
報の誤差が大きくなってしまう。
However, in the above-mentioned conventional position detecting device, there is a large error and the positional relationship between the own vehicle and the other vehicle cannot be accurately detected. In this case, the position detection device receives the other vehicle position information transmitted by the other vehicle, identifies the other vehicle position based on the other vehicle position information, and determines the own vehicle position based on the GPS information received from the GPS satellite. By specifying, the positional relationship between the own vehicle and another vehicle is specified. At this time, position information is calculated and transmitted for the own vehicle and the other vehicle by different calculation methods. Here, when the calculation method of the position information is different, in addition to the error originally included in the GPS information, an error occurs due to the different calculation method. Therefore, the error in the positional information between the own vehicle and the other vehicle becomes large.

【0006】本発明は、前記従来の位置検出装置の問題
点を解決して、自車周辺を走行する他車から、車両の位
置を検出するための情報である測位情報を受信して、自
車位置及び他車位置を特定することによって、自車と他
車との実際の相対位置関係を高い精度で検出することが
できる位置検出装置を提供することを目的とする。
The present invention solves the problems of the conventional position detecting device described above, and receives positioning information, which is information for detecting the position of a vehicle, from another vehicle traveling around the own vehicle, An object of the present invention is to provide a position detection device that can detect the actual relative positional relationship between the own vehicle and another vehicle with high accuracy by specifying the vehicle position and the other vehicle position.

【0007】[0007]

【課題を解決するための手段】そのために、本発明の位
置検出装置においては、自車位置情報を作成する自車情
報作成部と、他車が作成した他車位置情報を受信する他
車情報受信部と、地図を読み込む地図読込部と、前記自
車位置情報に含まれるGPS情報と他車位置情報に含ま
れるGPS情報とに基づいて、自車と他車との相対位置
関係を算出し、該相対位置関係を維持しながら、自車位
置及び他車位置を読み込んだ地図上に合致させて特定す
る位置特定部とを有する。
Therefore, in the position detecting device of the present invention, the own vehicle information creating section for creating the own vehicle position information and the other vehicle information for receiving the other vehicle position information created by another vehicle. The relative positional relationship between the own vehicle and the other vehicle is calculated based on the receiving unit, the map reading unit that reads the map, and the GPS information included in the own vehicle position information and the GPS information included in the other vehicle position information. A position specifying unit that specifies the own vehicle position and the other vehicle position by matching them on the read map while maintaining the relative positional relationship.

【0008】本発明の他の位置検出装置においては、さ
らに、前記自車位置情報に含まれるGPS情報と他車位
置情報に含まれるGPS情報とは、共通の衛星からのG
PS情報である。
In another position detecting apparatus of the present invention, the GPS information included in the own vehicle position information and the GPS information included in the other vehicle position information are G from a common satellite.
This is PS information.

【0009】本発明の更に他の位置検出装置において
は、さらに、前記自車位置情報は、ヨーレート情報、車
速情報又は走行軌跡情報に基づいて自車位置情報を作成
する。
In still another position detecting device of the present invention, the own vehicle position information is based on yaw rate information, vehicle speed information or traveling locus information.

【0010】本発明の更に他の位置検出装置において
は、さらに、前記自車位置情報を他車に送信する自車情
報送信部を有する。
[0010] In still another position detecting device of the present invention, it further has an own vehicle information transmitting section for transmitting the own vehicle position information to another vehicle.

【0011】本発明の更に他の位置検出装置において
は、さらに、前記位置特定部は、共通の衛星からのGP
S情報に基づいて、自車と他車との相対位置関係を算出
し、ヨーレート情報、車速情報又は走行軌跡情報に基づ
いて自車位置及び他車位置を補正する。
In still another position detecting device of the present invention, the position specifying unit further comprises a GP from a common satellite.
The relative positional relationship between the own vehicle and the other vehicle is calculated based on the S information, and the own vehicle position and the other vehicle position are corrected based on the yaw rate information, the vehicle speed information, or the traveling locus information.

【0012】本発明の更に他の位置検出装置において
は、さらに、前記位置特定部は、前記自車位置及び他車
位置がともに実際の道路上にあると判断した場合、前記
自車と他車との相対位置関係を維持しながら、前記自車
位置が地図上の道路上に合致するように前記自車位置及
び他車位置を補正し、該他車位置が地図上の道路上に合
致するように前記自車位置及び他車位置を補正する。
In still another position detecting device of the present invention, when the position specifying unit determines that both the own vehicle position and the other vehicle position are on an actual road, the own vehicle and the other vehicle are While maintaining the relative positional relationship with, the vehicle position and other vehicle position are corrected so that the vehicle position matches the road on the map, and the other vehicle position matches the road on the map. Thus, the position of the own vehicle and the position of the other vehicle are corrected.

【0013】本発明の更に他の位置検出装置において
は、さらに、前記位置特定部は、前記自車位置又は他車
位置のいずれかが実際の道路上にあると判断した場合、
前記自車と他車との相対位置関係を維持しながら、前記
自車位置又は他車位置のいずれかを地図上の道路上に合
致するように前記自車位置及び他車位置を補正する。
In still another position detecting device of the present invention, when the position specifying unit determines that either the own vehicle position or the other vehicle position is on an actual road,
While maintaining the relative positional relationship between the own vehicle and the other vehicle, the own vehicle position and the other vehicle position are corrected so that either the own vehicle position or the other vehicle position matches the road on the map.

【0014】本発明の更に他の位置検出装置において
は、さらに、前記位置特定部は、前記自車位置及び他車
位置がともに実際の道路上になく、かつ、車速が所定値
以上であると判断した場合、地図上の前記自車位置があ
ると判断された地点のマッチング候補点を選択し、前記
自車と他車との相対位置関係を維持しながら、地図上の
ペナルティの最も小さいマッチング候補点に前記自車位
置が合致するように前記自車位置及び他車位置を補正す
る。
In still another position detecting device of the present invention, further, in the position specifying unit, both the own vehicle position and the other vehicle position are not on an actual road, and the vehicle speed is equal to or higher than a predetermined value. When it is determined, the matching candidate point of the point determined to have the own vehicle position on the map is selected, and the matching with the smallest penalty on the map is maintained while maintaining the relative positional relationship between the own vehicle and another vehicle. The own vehicle position and the other vehicle position are corrected so that the own vehicle position matches the candidate point.

【0015】本発明の更に他の位置検出装置において
は、さらに、前記位置特定部は、前記自車位置及び他車
位置がともに実際の道路上になく、かつ、車速が所定値
以上でないと判断した場合、前記自車と他車との相対位
置関係を維持しながら、地図上の前記自車位置があると
判断された地点に合致するように前記自車位置及び他車
位置を補正する。
In still another position detecting device of the present invention, the position specifying unit determines that neither the own vehicle position nor the other vehicle position is on an actual road and the vehicle speed is not higher than a predetermined value. In this case, while maintaining the relative positional relationship between the own vehicle and the other vehicle, the own vehicle position and the other vehicle position are corrected so as to match the point on the map where the own vehicle position is determined to be.

【0016】本発明の更に他の位置検出装置において
は、さらに、前記位置特定部が特定した自車位置及び他
車位置を画像又は音によって報知する報知部を有する。
In still another position detecting device of the present invention, there is further provided a notifying unit for notifying the position of the own vehicle and the position of the other vehicle specified by the position specifying unit by an image or a sound.

【0017】本発明の位置検出方法においては、自車位
置情報を作成し、他車が作成した他車位置情報を受信
し、地図を読み込み、前記自車位置情報に含まれるGP
S情報と前記他車位置情報に含まれるGPS情報とに基
づいて、自車と他車との相対位置関係を算出し、該相対
位置関係を維持しながら、読み込んだ地図上に自車位置
及び他車位置を合致させて、該自車位置及び他車位置を
特定する。
In the position detecting method of the present invention, the own vehicle position information is created, the other vehicle position information created by another vehicle is received, the map is read, and the GP included in the own vehicle position information is received.
Based on the S information and the GPS information included in the other vehicle position information, the relative positional relationship between the own vehicle and the other vehicle is calculated, and while maintaining the relative positional relationship, the own vehicle position and the The other vehicle position is matched and the own vehicle position and the other vehicle position are specified.

【0018】本発明の位置検出プログラムにおいては、
コンピュータを、自車位置情報を作成する自車情報作成
部、他車が作成した他車位置情報を受信する他車情報受
信部、地図を読み込む地図読込部、並びに、前記自車位
置情報に含まれるGPS情報と他車位置情報に含まれる
GPS情報とに基づいて、自車と他車との相対位置関係
を算出し、該相対位置関係を維持しながら、自車位置及
び他車位置を読み込んだ地図上に合致させて特定する位
置特定部として機能させる。
In the position detecting program of the present invention,
A computer is included in the own vehicle information creating unit that creates the own vehicle position information, the other vehicle information receiving unit that receives the other vehicle position information created by another vehicle, the map reading unit that reads the map, and the own vehicle position information. The relative position relationship between the own vehicle and the other vehicle is calculated based on the GPS information included in the other vehicle position information and the other vehicle position information, and the own vehicle position and the other vehicle position are read while maintaining the relative positional relationship. It is made to function as a position specifying unit that matches and specifies on the map.

【0019】[0019]

【発明の実施の形態】以下、本発明の実施の形態につい
て図面を参照しながら詳細に説明する。
BEST MODE FOR CARRYING OUT THE INVENTION Hereinafter, embodiments of the present invention will be described in detail with reference to the drawings.

【0020】図1は本発明の実施の形態における位置検
出装置の構成を機能の観点から示すブロック図、図2は
本発明の実施の形態における位置検出装置の詳細な構成
を示す図である。
FIG. 1 is a block diagram showing the configuration of the position detecting device according to the embodiment of the present invention from the viewpoint of function, and FIG. 2 is a diagram showing the detailed configuration of the position detecting device according to the embodiment of the present invention.

【0021】図2において、11は道路を走行する乗用
車、トラック、バス、オートバイ、作業車等の車両であ
る自車、31は該自車11の周辺を走行する他の車両、
すなわち、他車であり、第1の他車31−1及び第2の
他車31−2を含んでいる。また、41は地球の周囲の
軌道上を周回してGPS情報を発信するGPS衛星であ
る。
In FIG. 2, 11 is a vehicle such as a passenger car, a truck, a bus, a motorcycle, a work vehicle or the like traveling on a road, 31 is another vehicle traveling around the vehicle 11,
That is, it is the other vehicle and includes the first other vehicle 31-1 and the second other vehicle 31-2. Reference numeral 41 is a GPS satellite that orbits around the earth and transmits GPS information.

【0022】ここで、自車11の周辺を走行する他車3
1の数はいくつであってもよく、単数であっても、三台
以上であってもよいが、図2においては、前記第1の他
車31−1及び第2の他車31−2が、自車11の周辺
を走行するすべての周辺車両としての他車31を代表す
るものとして示されている。また、GPS衛星は、実際
には複数(例えば、6軌道上に24個)であるが、図2
においては、単一のGPS衛星41がすべてのGPS衛
星を代表するものとして示されている。さらに、前記第
1の他車31−1及び第2の他車31−2も、自車11
と同様に位置検出装置を有するものであるが、本実施の
形態においては、自車11の位置検出装置20の構成に
ついて説明し、前記第1の他車31−1及び第2の他車
31−2の位置検出装置の構成についての説明は省略す
る。
Here, another vehicle 3 traveling around the own vehicle 11
The number of 1 may be any number, and may be one or three or more, but in FIG. 2, the first other vehicle 31-1 and the second other vehicle 31-2 are shown. However, it is shown as a representative of the other vehicle 31 as all the peripheral vehicles traveling around the own vehicle 11. Moreover, although there are actually a plurality of GPS satellites (for example, 24 in 6 orbits),
In, a single GPS satellite 41 is shown as representative of all GPS satellites. Further, the first other vehicle 31-1 and the second other vehicle 31-2 are also the own vehicle 11
However, in the present embodiment, the configuration of the position detection device 20 of the own vehicle 11 will be described, and the first other vehicle 31-1 and the second other vehicle 31 will be described. The description of the configuration of the position detecting device No. 2 will be omitted.

【0023】そして、自車11の位置検出装置20にお
いて、21は、地図の表示、自車11の現在位置の認
識、経路案内等のナビゲーション装置としての基本処理
を実行するナビ制御装置である。また、22は、自車1
1及び他車31の位置を検出するための処理を実行する
位置検出制御装置であり、前記ナビ制御装置21と各種
情報の送受信を行うようになっている。そして、23
は、自車11が受信したGPS情報、自車11の状態を
示す各種車両状態情報等の情報を、前記位置検出制御装
置22の指令に応じて、無線によって発信する信号発信
装置である。また、24は、GPS衛星41からのGP
S情報を受信して、ナビ制御装置21に送信するGPS
受信装置であり、通常のナビゲーション装置において使
用されるものと同様の構成を有する。なお、前記車両状
態情報は、アクセル開度、運転者が操作するブレーキペ
ダルの動き、運転者が操作するステアリングの舵(だ)
角、運転者が操作するウィンカースイッチの動き、運転
者が操作する変速機のシフトレバーの動き、車両の走行
速度、すなわち、車速、車両の加速度、車両の向いてい
る方位の変化を示すヨーレイト等を含んでいる。
In the position detecting device 20 of the own vehicle 11, reference numeral 21 is a navigation control device for executing basic processing as a navigation device such as displaying a map, recognizing the current position of the own vehicle 11, route guidance and the like. Further, 22 is the own vehicle 1
This is a position detection control device that executes processing for detecting the positions of the vehicle 1 and the other vehicle 31, and is configured to transmit and receive various information to and from the navigation control device 21. And 23
Is a signal transmission device that wirelessly transmits information such as GPS information received by the vehicle 11 and various vehicle state information indicating the state of the vehicle 11 in response to a command from the position detection control device 22. Further, 24 is the GP from the GPS satellite 41.
GPS that receives S information and sends it to the navigation control device 21
The receiving device has the same configuration as that used in a normal navigation device. The vehicle state information includes accelerator opening, movement of the brake pedal operated by the driver, and steering of the steering wheel operated by the driver.
Angle, movement of the winker switch operated by the driver, movement of the shift lever of the transmission operated by the driver, vehicle traveling speed, that is, vehicle speed, vehicle acceleration, yaw rate indicating changes in the direction in which the vehicle is heading, etc. Is included.

【0024】ここで、25は、他車31が発信したGP
S情報、前記他車31の状態を示す各種車両状態情報等
の情報を受信して、前記位置検出制御装置22に送信す
る信号受信装置である。そして、26は、ランプ、ブザ
ー、スピーカ等を備え、前記位置検出制御装置22の指
令に応じて自車11の運転者に対して警報を発する警報
装置である。また、27は、CRT、液晶ディスプレ
イ、LED(LightEmitting Diod
e)ディスプレイ、ホログラフィー装置等を備え、前記
位置検出制御装置22の指令に応じて自車11及び他車
31の位置、地図、経路等を表示する表示装置である。
Here, 25 is the GP transmitted by the other vehicle 31.
The signal receiving device receives information such as S information and various vehicle state information indicating the state of the other vehicle 31 and transmits the information to the position detection control device 22. An alarm device 26 includes a lamp, a buzzer, a speaker, and the like, and issues an alarm to the driver of the own vehicle 11 in response to a command from the position detection control device 22. 27 is a CRT, a liquid crystal display, an LED (Light Emitting Diode)
e) A display device that includes a display, a holographic device, etc., and displays the position, map, route, etc. of the own vehicle 11 and the other vehicle 31 in response to a command from the position detection control device 22.

【0025】そして、28は、自車11の状態を示す各
種車両状態情報を各種センサから受信して、前記位置検
出制御装置22に送信するセンサ情報受信装置である。
この場合、前記センサには、アクセル開度を検出するア
クセル開度センサ、運転者が操作するブレーキペダルの
動きを検出するブレーキスイッチ、運転者が操作するス
テアリングの舵(だ)角を検出するステアリングセン
サ、運転者が操作するウィンカースイッチの動きを検出
するウィンカーセンサ、運転者が操作する変速機のシフ
トレバーの動きを検出するシフトレバーセンサ、自車1
1の走行速度、すなわち、車速を検出する車速センサ、
自車11の加速度を検出する加速度センサ、自車11の
向いている方位の変化を示すヨーレイトを検出するヨー
レイトセンサ等が含まれる。
Reference numeral 28 denotes a sensor information receiving device that receives various vehicle state information indicating the state of the own vehicle 11 from various sensors and sends it to the position detection control device 22.
In this case, the sensor includes an accelerator opening sensor for detecting an accelerator opening, a brake switch for detecting a movement of a brake pedal operated by a driver, and a steering wheel for detecting a steering angle of a steering wheel operated by a driver. Sensor, winker sensor for detecting movement of winker switch operated by driver, shift lever sensor for detecting movement of shift lever of transmission operated by driver, own vehicle 1
A traveling speed of 1, that is, a vehicle speed sensor for detecting the vehicle speed,
An acceleration sensor that detects the acceleration of the vehicle 11 and a yaw rate sensor that detects the yaw rate indicating the change in the direction in which the vehicle 11 is heading are included.

【0026】ここで、前記ナビ制御装置21は、CP
U、MPU等の演算手段、半導体メモリ、磁気ディスク
等の記憶手段、通信インターフェイス等を備える。そし
て、前記記憶手段は、地図データファイル、交差点デー
タファイル、ノードデータファイル、道路データファイ
ル、及び、各地域のホテル、ガソリンスタンド等の施設
の情報が記録された施設情報データファイルから成るデ
ータベースを備える。そして、前記記憶手段には、経路
を探索するためのデータの他、前記表示装置27の画面
に、探索された経路に沿って案内図を表示したり、次の
交差点までの距離、次の交差点における進行方向等を表
示したり、他の案内情報を表示したりするための各種デ
ータが記録される。なお、前記記憶手段には、所定の情
報を音声出力するための各種データも記録される。ま
た、前記記憶手段は、磁気テープ、磁気ディスク、磁気
ドラム、フラッシュメモリ、CD−ROM、MD、DV
D−ROM、光ディスク、MO、ICカード、光カー
ド、メモリカード等、あらゆる形態の記録媒体を含むも
のであり、取り外し可能な外部記憶媒体を使用すること
もできる。
Here, the navigation control device 21 uses the CP
U, MPU and the like computing means, semiconductor memory, magnetic disk and other storage means, communication interface and the like. The storage means includes a database including a map data file, an intersection data file, a node data file, a road data file, and a facility information data file in which information on facilities such as hotels and gas stations in each region is recorded. . Then, in the storage means, in addition to data for searching a route, a guide map is displayed along the searched route on the screen of the display device 27, a distance to the next intersection, a next intersection, etc. Various data for displaying the traveling direction and the like and other guidance information are recorded. The storage means also stores various data for outputting predetermined information by voice. The storage means is a magnetic tape, magnetic disk, magnetic drum, flash memory, CD-ROM, MD, DV.
It includes a recording medium of any form such as a D-ROM, an optical disc, an MO, an IC card, an optical card, and a memory card, and a removable external storage medium can also be used.

【0027】そして、前記交差点データファイルには交
差点データが、ノードデータファイルにはノードデータ
が、道路データファイルには道路データがそれぞれ記録
され、前記交差点データ、ノードデータ及び道路データ
によって道路状況が前記表示装置27の画面に表示され
る。なお、前記交差点データには、交差点の種類、すな
わち、交通信号灯器の設置されている交差点であるか又
は交通信号灯器の設置されていない交差点であるが含ま
れる。また、前記ノードデータは、前記地図データファ
イルに記録された地図データにおける少なくとも道路の
位置及び形状を構成するものであり、実際の道路の分岐
点(交差点、T字路等を含む)、ノード点、及び各ノー
ド点間を連結するリンクを示すデータから成る。さら
に、前記ノード点は、少なくとも道路の屈曲点の位置を
示す。
Then, intersection data is recorded in the intersection data file, node data is recorded in the node data file, road data is recorded in the road data file, and the road condition is recorded by the intersection data, the node data and the road data. It is displayed on the screen of the display device 27. The intersection data includes the type of intersection, that is, an intersection where a traffic signal light device is installed or an intersection where a traffic signal light device is not installed. The node data constitutes at least the position and shape of the road in the map data recorded in the map data file, and includes actual road branch points (including intersections, T-junctions, etc.), node points. , And data indicating links connecting the respective node points. Further, the node point indicates at least the position of the bending point of the road.

【0028】また、前記道路データには、道路自体につ
いて、幅員、勾(こう)配、カント、高度、バンク、道
路の車線数、該車線数の減少する地点、幅員の狭くなる
地点等のデータが含まれる。なお、高速道路や幹線道路
の場合、対向方向の車線のそれぞれが別個の道路データ
として格納され、2条化道路として処理される。例え
ば、片側2車線以上の幹線道路の場合、2条化道路とし
て処理され、上り方向の車線と下り方向の車線は、それ
ぞれ、独立した道路として道路データに格納される。ま
た、コーナについては、曲率半径、交差点、T字路、コ
ーナの入口等のデータが含まれる。さらに、道路属性に
ついては、踏切、高速道路出入口ランプウェイ、高速道
路の料金所、道路種別(国道、主要地方道、一般道、高
速道路等)等のデータが含まれる。
The road data includes, for the road itself, width, gradient, cant, altitude, bank, number of lanes on the road, a point where the number of lanes is reduced, a point where the width is narrowed, and the like. Is included. In the case of a highway or a main road, each of the lanes in the opposite direction is stored as separate road data and processed as a two-way road. For example, in the case of a highway having two or more lanes on each side, it is processed as a two-lane road, and the up lane and the down lane are stored in the road data as independent roads. Further, regarding the corner, data such as a radius of curvature, an intersection, a T-shaped road, and a corner entrance are included. Further, the road attributes include data such as level crossings, highway entrance / exit ramp ways, highway toll gates, road types (national roads, major local roads, general roads, highways, etc.).

【0029】さらに、前記ナビ制御装置21の通信イン
ターフェイスは、位置検出制御装置22との間で通信を
行うとともに、FM送信装置、電話回線網、インターネ
ット、携帯電話網等との間で各種データの送受信を行う
ことができるものであることが望ましい。例えば、図示
されない情報センサ等によって受信した渋滞等の道路情
報、交通事故情報、GPSセンサの検出誤差を検出する
D−GPS情報等の各種データを受信するようになって
いることが望ましい。
Further, the communication interface of the navigation control device 21 communicates with the position detection control device 22 and exchanges various data with the FM transmission device, telephone line network, Internet, mobile phone network and the like. It is desirable that it can transmit and receive. For example, it is desirable to receive various kinds of data such as road information such as traffic jam received by an information sensor (not shown), traffic accident information, D-GPS information for detecting a detection error of the GPS sensor, and the like.

【0030】そして、前記ナビ制御装置21は、目的地
までの経路の探索、経路中の走行案内、特定区間の決
定、地点、施設等の検索等の各種処理を実行し、地図を
表示装置27の画面に表示し、前記地図上に車両の現在
位置、該現在位置から目的地までの経路、該経路に沿っ
た案内情報等を表示する。なお、該案内情報は、発音手
段によって音声出力されるようにしてもよい。さらに、
前記ナビ制御装置21は、信号受信装置25が受信した
他車31からのGPS情報、走行軌跡、各種センサの信
号等の情報に基づいて、前記他車31の現在位置を検出
することができる。
Then, the navigation control device 21 executes various processes such as searching for a route to a destination, driving guidance on the route, determining a specific section, searching for a point, facility, etc., and displaying the map on the display device 27. On the map, the current position of the vehicle, the route from the current position to the destination, guidance information along the route, and the like are displayed. The guidance information may be output as voice by a sounding unit. further,
The navigation control device 21 can detect the current position of the other vehicle 31 based on the information such as the GPS information from the other vehicle 31 received by the signal receiving device 25, the traveling locus, and the signals of various sensors.

【0031】また、位置検出制御装置22は、CPU、
MPU等の演算手段、半導体メモリ、磁気ディスク等の
記憶手段、通信インターフェイス等を備える。ここで、
前記記憶手段は、磁気テープ、磁気ディスク、磁気ドラ
ム、フラッシュメモリ、CD−ROM、MD、DVD−
ROM、光ディスク、MO、ICカード、光カード、メ
モリカード等、あらゆる形態の記録媒体を含むものであ
り、取り外し可能な外部記憶媒体を使用することもでき
る。
The position detection control device 22 includes a CPU,
An arithmetic unit such as an MPU, a semiconductor memory, a storage unit such as a magnetic disk, and a communication interface are provided. here,
The storage means is a magnetic tape, a magnetic disk, a magnetic drum, a flash memory, a CD-ROM, an MD, a DVD-.
It includes all types of recording media such as ROM, optical disk, MO, IC card, optical card, and memory card, and a removable external storage medium can also be used.

【0032】そして、前記位置検出制御装置22は、前
記記憶手段に格納された制御プログラムに従って、GP
S衛星41からGPS受信装置24を介して受信したG
PS情報やセンサ情報受信装置28から受信した各種車
両状態情報、及び、信号受信装置25を介して受信し
た、他車31が送信するGPS情報や各種車両状態情報
に基づいて、自車11と他車31との相対位置、相対距
離等を出力する。この場合、マップマッチングを行うこ
とによって、前記自車11と他車31との相対位置、相
対距離等を補正するようになっている。
Then, the position detection control device 22 follows the GP according to the control program stored in the storage means.
G received from the S satellite 41 via the GPS receiver 24
Based on various vehicle state information received from the PS information and the sensor information receiving device 28, and the GPS information and various vehicle state information transmitted by the other vehicle 31 received via the signal receiving device 25, the own vehicle 11 and others The relative position and relative distance to the vehicle 31 are output. In this case, by performing map matching, the relative position and relative distance between the own vehicle 11 and the other vehicle 31 are corrected.

【0033】本実施の形態において、位置検出装置20
は、図1に示されるように、機能の観点から、自車位置
情報としての自車11の測位情報を作成する自車情報作
成部12、他車31が作成した他車位置情報としての自
車31の測位情報を受信する他車情報受信部13、自車
位置情報に含まれるGPS情報と他車位置情報に含まれ
るGPS情報とに基づいて、自車11と他車31との相
対位置関係を算出し、該相対位置関係を維持しながら、
自車位置及び他車位置を読み込んだ地図上に合致させて
特定する位置特定部14、該位置特定部14が特定した
自車位置及び他車位置を画像又は音によって報知する報
知部15、自車11の測位情報を他車31に送信する自
車情報送信部16、及び、地図を読み込む図示されない
地図読込部を有するものである。
In the present embodiment, the position detecting device 20
As shown in FIG. 1, from the viewpoint of function, the own vehicle information creation unit 12 that creates the positioning information of the own vehicle 11 as the own vehicle position information, and the own vehicle information created by the other vehicle 31 as the other vehicle position information. The other vehicle information receiving unit 13 that receives the positioning information of the vehicle 31, the relative position of the own vehicle 11 and the other vehicle 31 based on the GPS information included in the own vehicle position information and the GPS information included in the other vehicle position information. While calculating the relationship and maintaining the relative positional relationship,
A position specifying unit 14 that specifies the own vehicle position and the other vehicle position by matching them on the read map, an informing unit 15 that notifies the own vehicle position and the other vehicle position specified by the position specifying unit 14 by image or sound, It has a vehicle information transmission unit 16 for transmitting the positioning information of the vehicle 11 to another vehicle 31, and a map reading unit (not shown) for reading a map.

【0034】ここで、測位情報が走行状態情報である場
合、センサ情報受信装置28及びナビ制御装置21が自
車情報作成部12として機能し、測位情報がGPS情報
を含む場合には、GPS受信装置24も自車情報作成部
12として機能する。そして、信号受信装置25が他車
情報受信部13として機能する。また、ナビ制御装置2
1及び位置検出制御装置22が位置特定部14として機
能する。さらに、警報装置26及び表示装置27が報知
部15として機能し、信号発信装置23が自車情報送信
部16として機能する。
Here, when the positioning information is the traveling state information, the sensor information receiving device 28 and the navigation control device 21 function as the own vehicle information creating section 12, and when the positioning information includes the GPS information, the GPS reception is performed. The device 24 also functions as the own vehicle information creation unit 12. Then, the signal reception device 25 functions as the other vehicle information reception unit 13. In addition, the navigation control device 2
1 and the position detection control device 22 function as the position specifying unit 14. Further, the alarm device 26 and the display device 27 function as the notification unit 15, and the signal transmission device 23 functions as the own vehicle information transmission unit 16.

【0035】なお、前記走行状態情報は、ヨーレート情
報、車速情報又は走行軌跡情報である。この場合、前記
ヨーレート情報には、振動ジャイロ、ガスレートジャイ
ロ、光ファイバジャイロ等のヨーレートセンサが検出す
るヨーレートに加え、地磁気センサ等が検出する絶対方
位又は絶対進行方向も含まれる。さらに、ステアリング
の舵角、CCD、レーザ探知器等によって検出された道
路上の白線からのズレに基づいて算出されるヨーレート
に似た情報も、前記ヨーレート情報に含まれる。また、
前記車速情報には、車速に加え、車両の走行距離等の車
両の移動距離を算出するための情報が含まれる。さら
に、前記走行軌跡情報は、前記ヨーレート情報がヨーレ
ートである場合、走行軌跡であるが、前記ヨーレート情
報が絶対方位又は絶対進行方向である場合、直前に車両
が位置していた点を一意に定めることができる位置情報
であればいかなる情報であってもよい。
The traveling state information is yaw rate information, vehicle speed information or traveling locus information. In this case, the yaw rate information includes the yaw rate detected by a yaw rate sensor such as a vibration gyro, a gas rate gyro, or an optical fiber gyro, as well as an absolute azimuth or an absolute traveling direction detected by a geomagnetic sensor or the like. Further, the yaw rate information also includes information similar to the yaw rate calculated based on the deviation from the white line on the road detected by the steering angle of the steering wheel, the CCD, the laser detector, and the like. Also,
The vehicle speed information includes, in addition to the vehicle speed, information for calculating a moving distance of the vehicle such as a traveling distance of the vehicle. Further, the traveling locus information is a traveling locus when the yaw rate information is a yaw rate, but when the yaw rate information is an absolute azimuth or an absolute traveling direction, the point where the vehicle was located immediately before is uniquely determined. Any information may be used as long as it is possible position information.

【0036】次に、前記構成の位置検出装置20の動作
について説明する。
Next, the operation of the position detecting device 20 having the above structure will be described.

【0037】図3は本発明の実施の形態における位置検
出装置の動作の概略を示す第1の図、図4は本発明の実
施の形態における位置検出装置の動作の概略を示す第2
の図、図5は本発明の実施の形態における位置検出装置
の動作を示すフローチャートである。なお、図3におい
て、41−1〜41−5はGPS衛星であり、この場
合、五つのGPS衛星が示されている。
FIG. 3 is a first diagram showing the outline of the operation of the position detecting device according to the embodiment of the present invention, and FIG. 4 is a second diagram showing the outline of the operation of the position detecting device according to the embodiment of the present invention.
5 and FIG. 5 are flowcharts showing the operation of the position detecting device in the embodiment of the present invention. In FIG. 3, 41-1 to 41-5 are GPS satellites, and in this case, five GPS satellites are shown.

【0038】ここでは、位置検出装置20の動作の全体
的な流れについて説明する。まず、位置検出装置20は
ナビゲーション基本処理を実行する。この場合、自車1
1の現在位置の検出、目的地までの経路の探索、経路中
の走行案内、特定区間の決定、地点、施設等の検索等を
行い、地図を表示装置27の画面に表示し、前記地図上
に自車11の現在位置、該現在位置から目的地までの経
路、該経路に沿った案内情報等を表示する。
Here, the overall flow of the operation of the position detection device 20 will be described. First, the position detecting device 20 executes basic navigation processing. In this case, own vehicle 1
1 detection of the current position, search for a route to the destination, driving guidance on the route, determination of a specific section, search for points, facilities, etc., display the map on the screen of the display device 27, and display on the map. The current position of the vehicle 11, the route from the current position to the destination, guidance information along the route, and the like are displayed.

【0039】次に、前記位置検出装置20は自車位置特
定処理及び車両情報送受信処理を実行する。なお、該自
車位置特定処理及び車両情報送受信処理の一部は、前記
ナビゲーション基本処理と重複している。この場合、G
PS受信装置24が受信したGPS情報、センサ情報受
信装置28が検出した車速等の車両状態情報、ナビ制御
装置21の記録する自車11の走行軌跡等の情報に基づ
いて、自車11の現在位置、すなわち、自車位置を特定
する。また、前記GPS受信装置24が受信したGPS
情報、センサ情報受信装置28が検出した車両状態情
報、ナビ制御装置21の記録する自車11の走行軌跡等
の情報は、信号発信装置23を介して、図3に示される
ように、自車11の周辺を走行する他車31に対して送
信される。さらに、該他車31が送信する他車31が受
信したGPS情報、他車31の車両状態情報及び走行軌
跡等の情報が、信号受信装置25を介して、図3に示さ
れるように、受信される。
Next, the position detecting device 20 executes the own vehicle position specifying process and the vehicle information transmitting / receiving process. A part of the own vehicle position specifying process and the vehicle information transmitting / receiving process overlaps with the navigation basic process. In this case, G
Based on the GPS information received by the PS receiving device 24, the vehicle state information such as the vehicle speed detected by the sensor information receiving device 28, and the traveling locus of the own vehicle 11 recorded by the navigation control device 21, the current state of the own vehicle 11 The position, that is, the vehicle position is specified. In addition, the GPS received by the GPS receiving device 24
The information, the vehicle state information detected by the sensor information receiving device 28, the information such as the traveling locus of the own vehicle 11 recorded by the navigation control device 21, is transmitted via the signal transmitting device 23 as shown in FIG. It is transmitted to another vehicle 31 traveling around 11. Further, as shown in FIG. 3, the GPS information transmitted by the other vehicle 31, the GPS state information of the other vehicle 31, the information such as the traveling path, and the like received by the other vehicle 31 are received via the signal receiving device 25 as shown in FIG. To be done.

【0040】次に、前記位置検出装置20は相対位置演
算処理を実行する。この場合、図4に示されるように、
GPS受信装置24が受信したGPS情報、センサ情報
受信装置28が検出した車両状態情報、ナビ制御装置2
1の記録する自車11の走行軌跡等の情報、及び、信号
受信装置25を介して受信した他車31が受信したGP
S情報、他車31の車両状態情報及び走行軌跡等の情報
に基づいて、自車位置を基準とした他車31の相対的な
位置を算出する。
Next, the position detection device 20 executes a relative position calculation process. In this case, as shown in FIG.
GPS information received by the GPS receiving device 24, vehicle state information detected by the sensor information receiving device 28, navigation control device 2
The information such as the traveling locus of the own vehicle 11 recorded by No. 1 and the GP received by the other vehicle 31 received via the signal receiving device 25.
The relative position of the other vehicle 31 is calculated based on the own vehicle position based on the S information, the vehicle state information of the other vehicle 31, the traveling locus, and other information.

【0041】次に、前記位置検出装置20はマップマッ
チング処理を実行する。この場合、自車位置特定処理及
び車両情報送受信処理によって特定された自車位置、並
びに、相対位置演算処理によって算出された他車31の
相対的な位置をナビ制御装置21の記憶手段に記録され
ている地図データに照らし合わせて、自車位置及び他車
位置が地図における道路上に合致するように、マップマ
ッチングを行うようになっている。なお、前記マップマ
ッチング処理においては、相対位置演算処理によって算
出された自車11と他車31との相対位置及び相対距離
が変更されないようになっている。
Next, the position detecting device 20 executes a map matching process. In this case, the own vehicle position specified by the own vehicle position specifying process and the vehicle information transmitting / receiving process, and the relative position of the other vehicle 31 calculated by the relative position calculating process are recorded in the storage means of the navigation control device 21. Map matching is performed so that the position of the own vehicle and the position of the other vehicle match the road on the map by comparing with the existing map data. In the map matching process, the relative position and relative distance between the own vehicle 11 and the other vehicle 31 calculated by the relative position calculation process are not changed.

【0042】最後に、前記位置検出装置20は報知処理
を実行する。この場合、マップマッチング処理によって
特定された自車位置及び他車位置が、表示装置27の画
面に表示されている地図に重ね合わせて表示される。こ
れにより、自車11の運転者は、自車位置及び他車位置
を的確に把握することができる。また、自車11が周辺
車両と接近する可能性が高い場合には、位置検出制御装
置22の指令に応じて、図3に示されるように、警報装
置26が自車11の運転者に対して警報を発する。これ
により、前記運転者は、他車31と接近しないような措
置を取ることができる。
Finally, the position detecting device 20 executes an informing process. In this case, the own vehicle position and the other vehicle position identified by the map matching process are displayed in a superimposed manner on the map displayed on the screen of the display device 27. As a result, the driver of the own vehicle 11 can accurately grasp the own vehicle position and the other vehicle position. Further, when the own vehicle 11 is highly likely to approach the surrounding vehicles, the warning device 26 notifies the driver of the own vehicle 11 to the driver of the own vehicle 11 as shown in FIG. 3 in response to a command from the position detection control device 22. To issue an alarm. As a result, the driver can take measures so as not to approach the other vehicle 31.

【0043】なお、前記ナビゲーション基本処理、自車
位置特定処理及び車両情報送受信処理、相対位置演算処
理、マップマッチング処理及び報知処理は、所定の周期
(例えば、16〔msec〕)で繰り返し実行される。
The navigation basic process, the own vehicle position specifying process, the vehicle information transmitting / receiving process, the relative position calculating process, the map matching process and the informing process are repeatedly executed in a predetermined cycle (for example, 16 [msec]). .

【0044】次に、フローチャートについて説明する。
ステップS1 ナビゲーション基本処理を実行する。ス
テップS2 自車位置特定処理及び車両情報送受信処理
を実行する。ステップS3 相対位置演算処理を実行す
る。ステップS4 マップマッチング処理を実行する。
ステップS5 報知処理を実行する。
Next, the flow chart will be described.
In step S1, basic navigation processing is executed. In step S2, the own vehicle position specifying process and the vehicle information transmitting / receiving process are executed. Step S3 The relative position calculation process is executed. In step S4, map matching processing is executed.
In step S5, the notification process is executed.

【0045】次に、自車位置特定処理及び車両情報送受
信処理について説明する。
Next, the own vehicle position specifying process and the vehicle information transmitting / receiving process will be described.

【0046】図6は本発明の実施の形態における自車位
置特定処理及び車両情報送受信処理の動作を示すフロー
チャートである。
FIG. 6 is a flowchart showing the operations of the own vehicle position specifying process and the vehicle information transmitting / receiving process in the embodiment of the present invention.

【0047】まず、前記位置検出装置20は、GPS受
信装置24がGPS情報を受信することができたGPS
衛星41の数が四つ以上であるか否かを判断する。そし
て、GPS情報を受信することができたGPS衛星41
の数が四つ以上である場合、前記位置検出装置20は、
四つのGPS衛星41−1〜41−4から受信したGP
S情報に基づいて、自車位置を特定するための自車位置
特定演算処理を実行する。例えば、この場合、GPS情
報に含まれる各種数値を次の式(1)〜(4)で示され
る四元連立方程式に代入し、解くことによって、四つの
未知数である自車位置の座標及び自車11のGPS時計
の時刻を算出する。
First, in the position detecting device 20, the GPS receiving device 24 is capable of receiving GPS information.
It is determined whether the number of satellites 41 is four or more. Then, the GPS satellite 41 that was able to receive the GPS information
Is four or more, the position detection device 20
GP received from four GPS satellites 41-1 to 41-4
Based on the S information, the own vehicle position specifying calculation process for specifying the own vehicle position is executed. For example, in this case, various numerical values included in the GPS information are substituted into the four-dimensional simultaneous equations represented by the following equations (1) to (4) and solved to solve the coordinates of the own vehicle position and the four unknowns. The time of the GPS clock of the car 11 is calculated.

【0048】[0048]

【数1】 [Equation 1]

【0049】ここで、x、y、zは自車位置の座標、t
は自車11のGPS時計の示す時刻である。また、xn
、yn 、zn はn番目のGPS衛星41−nの座標
(n=1、2、3、4)、tn はn番目のGPS衛星4
1−nのGPS時計の示す時刻であり、GPS衛星41
−1〜41−4から受信したGPS情報に含まれてい
る。なお、cは光速を示している。これにより、時刻t
における自車位置の座標(x、y、z)が特定される。
Here, x, y and z are coordinates of the vehicle position, and t
Is the time indicated by the GPS clock of the own vehicle 11. Also, xn
, Yn and nz are the coordinates (n = 1, 2, 3, 4) of the nth GPS satellite 41-n, and tn is the nth GPS satellite 4
It is the time indicated by the 1-n GPS clock, and the GPS satellite 41
It is included in the GPS information received from -1 to 41-4. Note that c indicates the speed of light. As a result, the time t
The coordinates (x, y, z) of the vehicle position at are identified.

【0050】また、GPS情報を受信することができた
GPS衛星41の数が四つ以上でない場合、前記位置検
出装置20は、GPS受信装置24がGPS情報を受信
することができたGPS衛星41の数が三つであるか否
かを判断する。そして、GPS情報を受信することがで
きたGPS衛星41の数が三つである場合、前記位置検
出装置20は、三つのGPS衛星41−1〜41−3か
ら受信したGPS情報に基づいて、自車位置を特定する
ための自車位置特定演算処理を実行する。
If the number of GPS satellites 41 that can receive GPS information is not four or more, the GPS satellite 41 that the GPS receiver 24 of the position detecting device 20 can receive GPS information is. Judge whether the number of is three. Then, when the number of GPS satellites 41 capable of receiving GPS information is three, the position detection device 20 is based on the GPS information received from the three GPS satellites 41-1 to 41-3, A vehicle position specifying calculation process for specifying the vehicle position is executed.

【0051】この場合、算出すべき未知数が、時刻t及
び自車位置の座標(x、y、z)の四つであるのに対
し、GPS情報を受信することができたGPS衛星41
の数が三つしかないので、GPS情報に含まれる数値を
使用した四元連立方程式を解くことができなくなってし
まう。そのため、一般的に、変化量が極めて少ないと考
えられる自車位置における高さ方向の座標成分であるz
の数値に、前回の周期における自車位置特定演算処理で
算出されたzの数値を代入して、既知数として取り扱う
こととする。すなわち、自車位置の高さであるzを固定
する。これにより、GPS情報に含まれる各種数値を前
記式(1)〜(3)から成る三元連立方程式に代入する
ことによって、三つの未知数である自車位置の座標(但
し、zは既知数)及び自車11のGPS時計の時刻を算
出することができる。
In this case, the four unknowns to be calculated are the time t and the coordinates (x, y, z) of the vehicle position, but the GPS satellites 41 that can receive GPS information.
Since there are only three, it becomes impossible to solve the quaternary simultaneous equations using the numerical values included in the GPS information. Therefore, in general, z, which is the coordinate component in the height direction at the vehicle position where the change amount is considered to be extremely small,
The numerical value of z is substituted with the numerical value of z calculated by the own vehicle position specifying calculation process in the previous cycle, and is treated as a known number. That is, the height z of the vehicle position is fixed. Accordingly, by substituting various numerical values included in the GPS information into the three-dimensional simultaneous equations composed of the equations (1) to (3), the coordinates of the own vehicle position, which is three unknowns (where z is a known number). Also, the time of the GPS clock of the own vehicle 11 can be calculated.

【0052】さらに、GPS情報を受信することができ
たGPS衛星41の数が三つでない場合、すなわち、G
PS情報を受信することができたGPS衛星41の数が
二つ以下である場合には、GPS情報に基づいて、自車
位置を正確に特定することができないので、前記位置検
出装置20は、センサ情報受信装置28が検出した車両
状態情報に基づく位置特定処理を実行して、時刻tにお
ける自車位置の座標(x、y、z)を特定する。なお、
車両状態情報に基づく位置特定処理については後述す
る。
Furthermore, when the number of GPS satellites 41 that can receive GPS information is not three, that is, G
When the number of GPS satellites 41 that can receive the PS information is two or less, the position of the vehicle cannot be accurately specified based on the GPS information. The position specifying process based on the vehicle state information detected by the sensor information receiving device 28 is executed to specify the coordinates (x, y, z) of the own vehicle position at time t. In addition,
The position specifying process based on the vehicle state information will be described later.

【0053】そして、時刻tにおける自車位置の座標
(x、y、z)が特定されると、前記位置検出装置20
は、自車データ発信処理を実行する。この場合、GPS
受信装置24が受信したGPS情報、センサ情報受信装
置28が検出した車速、ヨーレイト等の車両状態情報、
ナビ制御装置21の記録する自車11の走行軌跡等の情
報が信号発信装置23によって、他車31に送信され
る。
When the coordinates (x, y, z) of the vehicle position at time t are specified, the position detecting device 20
Executes the own vehicle data transmission process. In this case, GPS
GPS information received by the receiving device 24, vehicle speed information detected by the sensor information receiving device 28, vehicle state information such as yaw rate,
Information such as the traveling locus of the vehicle 11 recorded by the navigation control device 21 is transmitted to the other vehicle 31 by the signal transmission device 23.

【0054】続いて、前記位置検出装置20は、他者デ
ータ受信処理を実行する。この場合、信号受信装置25
は、他車31が受信したGPS情報、他車31のセンサ
が検出した他車31の車速、ヨーレイト等の車両状態情
報、他車31の走行軌跡等の情報を、他車31から受信
する。
Subsequently, the position detecting device 20 executes the other person data receiving process. In this case, the signal receiving device 25
Receives from the other vehicle 31 GPS information received by the other vehicle 31, vehicle speed information of the other vehicle 31 detected by a sensor of the other vehicle 31, vehicle state information such as yaw rate, and traveling locus of the other vehicle 31.

【0055】次に、フローチャートについて説明する。
ステップS2−1 受信することができたGPS衛星4
1の数が四つ以上であるか否かを判断する。受信するこ
とができたGPS衛星41の数が四つ以上である場合は
ステップS2−4に進み、四つより少ない場合はステッ
プS2−2に進む。 ステップS2−2 受信することができたGPS衛星4
1の数が三つであるか否かを判断する。受信することが
できたGPS衛星41の数が三つである場合はステップ
S2−3に進み、三つより少ない場合はステップS2−
5に進む。 ステップS2−3 自車位置の高さzを固定する。 ステップS2−4 自車位置特定演算処理を行う。 ステップS2−5 車両状態情報に基づく位置特定処理
を行う。 ステップS2−6 自車データ発信処理を行う。 ステップS2−7 他車データ受信処理を行い、処理を
終了する。
Next, the flowchart will be described.
Step S2-1 GPS satellite 4 that could be received
It is determined whether the number of 1 is 4 or more. When the number of GPS satellites 41 that can be received is four or more, the process proceeds to step S2-4, and when the number is less than four, the process proceeds to step S2-2. Step S2-2 GPS satellite 4 that could be received
It is determined whether or not the number of 1 is three. When the number of GPS satellites 41 that can be received is three, the process proceeds to step S2-3, and when the number is less than three, step S2-.
Go to 5. Step S2-3: Fix the height z of the vehicle position. In step S2-4, the own vehicle position specifying calculation process is performed. Step S2-5: The position specifying process based on the vehicle state information is performed. Step S2-6 Car data transmission processing is performed. Step S2-7 Other vehicle data reception processing is performed, and the processing ends.

【0056】次に、車両状態情報に基づく位置特定処理
について説明する。
Next, the position specifying process based on the vehicle state information will be described.

【0057】図7は本発明の実施の形態におけるヨーレ
イトに基づいて自車位置を更新する方法を示す図、図8
は本発明の実施の形態における車両状態情報に基づく位
置特定処理の動作を示すフローチャートである。
FIG. 7 is a diagram showing a method of updating the vehicle position based on the yaw rate according to the embodiment of the present invention, and FIG.
6 is a flowchart showing an operation of position specifying processing based on vehicle state information in the embodiment of the present invention.

【0058】まず、位置検出装置20は、位置特定処理
の対象が自車11であるか否か、すなわち、自車11の
位置を特定するのか他車31の位置を特定するのかを判
断する。そして、自車11の位置を特定する場合、前記
位置検出装置20は、センサ情報受信装置28が検出し
た車速、ヨーレイト等の車両状態情報、ナビ制御装置2
1の記録する自車11の走行軌跡等の情報を取得する。
一方、他車31の位置を特定する場合、前記位置検出装
置20は、信号受信装置25が他車31から受信した情
報の中から、他車31のセンサが検出した他車31の車
速、ヨーレイト等の車両状態情報、他車31の走行軌跡
等の情報を取得する。
First, the position detecting device 20 determines whether or not the target of the position specifying process is the own vehicle 11, that is, whether the position of the own vehicle 11 or the position of the other vehicle 31 is specified. When the position of the vehicle 11 is specified, the position detecting device 20 uses the vehicle speed information detected by the sensor information receiving device 28, vehicle state information such as yaw rate, and the navigation control device 2.
The information such as the traveling locus of the own vehicle 11 recorded by No. 1 is acquired.
On the other hand, when the position of the other vehicle 31 is specified, the position detecting device 20 uses the vehicle speed and yaw rate of the other vehicle 31 detected by the sensor of the other vehicle 31 from the information received by the signal receiving device 25 from the other vehicle 31. And the like, and information such as the traveling locus of the other vehicle 31 is acquired.

【0059】次に、前記位置検出装置20は、現在位置
特定処理を実行する。なお、該現在位置特定処理は、自
車11の位置を特定する場合も他車31の位置を特定す
る場合も同様なので、ここでは、自車11の位置を特定
する場合の現在位置特定処理について、図7を参照して
説明する。なお、図7(a)は、前回の周期における現
在位置特定処理で算出された現在位置、すなわち、更新
前の現在位置の状態を示し、図7(b)は、今回の周期
における現在位置特定処理で算出された現時点における
現在位置、すなわち、更新後の現在位置の状態を示して
いる。
Next, the position detecting device 20 executes a current position specifying process. Since the current position specifying process is the same whether the position of the own vehicle 11 is specified or the position of the other vehicle 31 is specified, here, the current position specifying process when specifying the position of the own vehicle 11 will be described. , FIG. 7 will be described. Note that FIG. 7A shows the current position calculated by the current position specifying process in the previous cycle, that is, the state of the current position before updating, and FIG. 7B shows the current position specifying in the current cycle. The current position calculated at the present time, that is, the state of the updated current position is shown.

【0060】この場合、前記位置検出装置20は、ま
ず、前回の周期における現在位置特定処理で算出された
現在位置、すなわち、更新前の現在位置33aから現時
点における現在位置、すなわち、更新後の現在位置33
bまでの距離としての移動距離dを、車速に基づいて算
出する。この場合、移動距離dは、次の式(5)によっ
て算出される。 d=v×T・・・(5) ここで、vは車速であり、Tは前回の周期において現在
位置特定処理を実行した時点から、現行の現在位置特定
処理を実行する時点までの時間であり、位置検出装置2
0が現在位置特定処理を繰り返し実行する周期(例え
ば、16〔msec〕)である。なお、前記Tは、計測
してもよいし、受信したGPS情報に含まれる時刻tに
基づいて求めてもよい。
In this case, the position detecting device 20 firstly determines the current position calculated by the current position specifying process in the previous cycle, that is, the current position 33a before updating to the current position at the present time, that is, the current after updating. Position 33
The moving distance d as the distance to b is calculated based on the vehicle speed. In this case, the moving distance d is calculated by the following equation (5). d = v × T (5) where v is the vehicle speed, and T is the time from the time when the current position specifying process is executed in the previous cycle to the time when the current current position specifying process is executed. Yes, position detection device 2
0 is a cycle (for example, 16 [msec]) at which the current position specifying process is repeatedly executed. The T may be measured or may be calculated based on the time t included in the received GPS information.

【0061】続いて、前記位置検出装置20は、更新前
の現在位置33aにおける自車11の進行方向35a
を、取得した自車11の走行軌跡34に基づいて設定す
る。なお、図7(a)において前記進行方向35aを示
す矢印の長さは移動距離dを示している。続いて、自車
11の向いている方位の変化を示すヨーレイト36に基
づいて、前記進行方向35aを修正して、現在の進行方
向35bを決定する。この場合、現在の進行方向35b
を示す矢印の長さは、前記進行方向35aを示す矢印の
長さに等しく移動距離dを示している。したがって、図
7(a)において、現在の進行方向35bを示す矢印の
先端の位置35cは、現時点における現在位置、すなわ
ち、図7(b)における更新後の現在位置33bに相当
する。
Subsequently, the position detecting device 20 causes the traveling direction 35a of the own vehicle 11 at the current position 33a before updating.
Is set based on the acquired travel path 34 of the own vehicle 11. In FIG. 7A, the length of the arrow indicating the traveling direction 35a indicates the moving distance d. Subsequently, the traveling direction 35a is corrected based on the yaw rate 36 indicating the change in the azimuth of the vehicle 11, and the current traveling direction 35b is determined. In this case, the current traveling direction 35b
The length of the arrow indicating is equal to the length of the arrow indicating the traveling direction 35a and indicates the movement distance d. Therefore, in FIG. 7A, the position 35c at the tip of the arrow indicating the current traveling direction 35b corresponds to the current position at the present time, that is, the updated current position 33b in FIG. 7B.

【0062】なお、前記進行方向35aを示す矢印の長
さが移動距離dを示していなくてもよい。この場合、前
記進行方向35aを修正して、現在の進行方向35bを
決定した後に、該現在の進行方向35bを示す矢印の長
さが移動距離dの長さとなるように調整する。
The length of the arrow indicating the traveling direction 35a may not indicate the moving distance d. In this case, after the traveling direction 35a is corrected and the current traveling direction 35b is determined, the length of the arrow indicating the current traveling direction 35b is adjusted to be the length of the moving distance d.

【0063】最後に、前記位置検出装置20は、現在位
置を更新前の現在位置33aから更新後の現在位置33
bに更新して、車両状態情報に基づく現在位置特定処理
を終了する。これにより、三つ以上のGPS衛星41か
らGPS情報を受信することができない場合であって
も、自車11の自車位置を特定することができる。
Finally, the position detecting device 20 changes the current position from the current position 33a before updating to the current position 33 after updating.
After updating to b, the current position specifying process based on the vehicle state information is ended. As a result, even if GPS information cannot be received from three or more GPS satellites 41, the vehicle position of the vehicle 11 can be specified.

【0064】なお、他車31の位置を特定する場合、前
記位置検出装置20は、信号受信装置25が受信した前
記他車31の車速、ヨーレイト等の車両状態情報、他車
31の走行軌跡等の情報に基づいて、前記現在位置特定
処理を実行する。これにより、他車31が三つ以上のG
PS衛星41からGPS情報を受信することができない
場合であっても、前記他車31の自車位置を特定するこ
とができる。
When the position of the other vehicle 31 is specified, the position detecting device 20 uses the vehicle speed information of the other vehicle 31 received by the signal receiving device 25, vehicle state information such as yaw rate, the traveling locus of the other vehicle 31, etc. The current position specifying process is executed based on the information of. As a result, the other vehicle 31 has three or more G
Even when GPS information cannot be received from the PS satellite 41, the own vehicle position of the other vehicle 31 can be specified.

【0065】次に、フローチャートについて説明する。 ステップS2−5−1 自車11であるか否かを判断す
る。自車11である場合はステップS2−5−2に進
み、他車31である場合はステップS2−5−3に進
む。 ステップS2−5−2 自車情報を取得する。 ステップS2−5−3 他車情報を取得する。 ステップS2−5−4 現在位置特定処理を行い、処理
を終了する。
Next, the flowchart will be described. Step S2-5-1: It is judged whether or not the vehicle is the own vehicle 11. If it is the own vehicle 11, the process proceeds to step S2-5-2, and if it is the other vehicle 31, the process proceeds to step S2-5-3. Step S2-5-2: Obtain the own vehicle information. Step S2-5-3 Acquires other vehicle information. Step S2-5-4 The current position specifying process is performed, and the process is ended.

【0066】次に、相対位置演算処理について説明す
る。
Next, the relative position calculation process will be described.

【0067】図9は本発明の実施の形態における車両状
態情報に基づく他車位置特定演算処理の概略を示す図、
図10は本発明の実施の形態における相対位置演算処理
の動作を示すフローチャート、図11は本発明の実施の
形態における第1の他車相対位置演算処理の動作を示す
フローチャート、図12は本発明の実施の形態における
第2の他車相対位置演算処理の動作を示すフローチャー
トである。
FIG. 9 is a diagram showing an outline of another vehicle position specifying calculation processing based on vehicle state information in the embodiment of the present invention,
10 is a flow chart showing the operation of the relative position calculation processing in the embodiment of the present invention, FIG. 11 is a flow chart showing the operation of the first other vehicle relative position calculation processing in the embodiment of the present invention, and FIG. 12 is the present invention. 5 is a flowchart showing the operation of a second other vehicle relative position calculation process in the embodiment of FIG.

【0068】この場合、位置検出装置20は、他車31
が受信したGPS情報、他車31の車速、ヨーレイト等
の車両状態情報、他車31の走行軌跡等の情報を取得し
て、自車11に対する他車31の相対的な位置(Δx、
Δy、Δz)を演算するようになっている。
In this case, the position detecting device 20 uses the other vehicle 31
Relative position of the other vehicle 31 with respect to the own vehicle 11 (Δx,
Δy, Δz) are calculated.

【0069】まず、位置検出装置20は、GPS受信装
置24が受信したGPS情報、及び、信号受信装置25
が受信した他車31から送信されたGPS情報に基づい
て、共通衛星の数をカウントする。ここで、共通衛星と
は、自車11がGPS情報を受信することができるとと
もに、他車31もGPS情報を受信することができるG
PS衛星41である。そして、前記位置検出装置20
は、共通衛星の数が三つ以上である場合、第1の他車相
対位置演算処理を実行し、共通衛星の数が三つ以上でな
い場合、すなわち、二つ以下である場合、第2の他車相
対位置演算処理を実行する。
First, the position detecting device 20 receives the GPS information received by the GPS receiving device 24 and the signal receiving device 25.
The number of common satellites is counted based on the GPS information transmitted from the other vehicle 31 received by. Here, the common satellite means that the own vehicle 11 can receive GPS information, and the other vehicle 31 can also receive GPS information.
The PS satellite 41. Then, the position detection device 20
Executes the first other vehicle relative position calculation processing when the number of common satellites is three or more, and when the number of common satellites is not three or more, that is, two or less, the second The other vehicle relative position calculation processing is executed.

【0070】ここで、共通衛星の数が三つ以上である場
合、前記位置検出装置20は、共通衛星の数が四つ以上
であるか否かを判断する。そして、共通衛星の数が四つ
以上である場合、前記位置検出装置20は、四つの共通
衛星であるGPS衛星41−1〜41−4から受信した
GPS情報に基づいて、自車位置を基準とした他車31
の相対的な位置を演算する。この場合、四つの共通衛星
であるGPS衛星41−1〜41−4から受信したGP
S情報に含まれる各種数値を次の式(6)〜(9)で示
される四元連立方程式に代入し、解くことによって、四
つの未知数である他車31の相対的な位置の座標及び他
車31のGPS時計の時刻を算出する。
When the number of common satellites is three or more, the position detecting device 20 determines whether the number of common satellites is four or more. When the number of common satellites is four or more, the position detection device 20 uses the own vehicle position as a reference based on the GPS information received from the GPS satellites 41-1 to 41-4, which are four common satellites. And other car 31
Calculate the relative position of. In this case, the GP received from the four common satellites, GPS satellites 41-1 to 41-4
By substituting various numerical values included in the S information into the quaternary simultaneous equations represented by the following equations (6) to (9) and solving them, the coordinates of the relative position of the other vehicle 31, which is four unknowns, and others. The time of the GPS clock of the car 31 is calculated.

【0071】[0071]

【数2】 [Equation 2]

【0072】ここで、x、y、zは自車位置の座標、Δ
x、Δy、Δzは自車位置に対する他車31の相対位置
を示す座標、すなわち、自車位置の座標x、y、zに対
する他車位置の座標の偏差である。したがって、他車位
置の座標はx+Δx、y+Δy、z+Δzとなる。ま
た、tβは他車31のGPS時計の示す時刻である。な
お、自車位置の座標x、y、zは、前述された自車位置
特定演算処理(ステップS2−4)によって、算出され
る。さらに、xn 、yn 、zn はn番目のGPS衛星4
1−nの座標(n=1、2、3、4)、tn はn番目の
GPS衛星41−nのGPS時計の示す時刻であり、G
PS衛星41−1〜41−4から受信したGPS情報に
含まれている。なお、cは光速を示している。これによ
り、時刻tβにおける自車位置に対する他車31の相対
位置を示す座標(Δx、Δy、Δz)が算出される。
Here, x, y, z are coordinates of the vehicle position, Δ
x, Δy, and Δz are coordinates indicating the relative position of the other vehicle 31 with respect to the own vehicle position, that is, deviations of the coordinates of the other vehicle position with respect to the coordinates x, y, and z of the own vehicle position. Therefore, the coordinates of the other vehicle position are x + Δx, y + Δy, and z + Δz. Further, tβ is the time indicated by the GPS clock of the other vehicle 31. The coordinates x, y, z of the vehicle position are calculated by the vehicle position specifying calculation process (step S2-4) described above. Further, xn, yn, and zn are the nth GPS satellite 4
1-n coordinates (n = 1, 2, 3, 4), tn are times indicated by the GPS clock of the n-th GPS satellite 41-n, and G
It is included in the GPS information received from the PS satellites 41-1 to 41-4. Note that c indicates the speed of light. As a result, the coordinates (Δx, Δy, Δz) indicating the relative position of the other vehicle 31 with respect to the own vehicle position at time tβ are calculated.

【0073】また、共通衛星の数が四つ以上でない場
合、すなわち、共通衛星の数が三つである場合、前記位
置検出装置20は、三つの共通衛星であるGPS衛星4
1−1〜41−3から受信したGPS情報に基づいて、
自車位置を基準とした他車31の相対的な位置を演算す
る。
When the number of common satellites is not four or more, that is, when the number of common satellites is three, the position detecting device 20 determines that the three common satellites are GPS satellites 4
Based on the GPS information received from 1-1 to 41-3,
The relative position of the other vehicle 31 is calculated based on the own vehicle position.

【0074】この場合、算出すべき未知数が、時刻tβ
及び自車位置に対する他車31の相対位置を示す座標
(Δx、Δy、Δz)の四つであるのに対し、GPS情
報を受信することができたGPS衛星41の数が三つし
かないので、GPS情報に含まれる数値を使用した四元
連立方程式を解くことができなくなってしまう。そのた
め、一般的に、変化量が極めて少ないと考えられる自車
位置における高さ方向の座標成分であるzの数値に、前
回の周期における自車位置特定演算処理で算出されたz
の数値を代入し、Δzの数値に、前回の周期における第
1の他車相対位置演算処理で算出されたΔzの数値を代
入して、既知数として取り扱うこととする。これによ
り、GPS情報に含まれる各種数値を前記式(6)〜
(8)から成る三元連立方程式に代入し、解くことによ
って、三つの未知数である自車位置の座標(但し、z及
びΔzは既知数)及びGPS時計の時刻tβを算出する
ことができる。
In this case, the unknown to be calculated is the time tβ.
And four coordinates (Δx, Δy, Δz) indicating the relative position of the other vehicle 31 with respect to the own vehicle position, but there are only three GPS satellites 41 capable of receiving GPS information. , It becomes impossible to solve the quaternary simultaneous equations using the numerical values included in the GPS information. Therefore, in general, the numerical value of z, which is the coordinate component in the height direction at the vehicle position where the amount of change is considered to be extremely small, is added to the z calculated by the vehicle position specifying calculation process in the previous cycle.
The numerical value of Δz is substituted, and the numerical value of Δz is substituted with the numerical value of Δz calculated in the first other vehicle relative position calculation processing in the previous cycle, and is treated as a known number. As a result, various numerical values included in the GPS information can be calculated using the formula (6) to
By substituting it into the three-dimensional simultaneous equation (8) and solving it, it is possible to calculate the coordinates of the own vehicle position (where z and Δz are known numbers) and the time tβ of the GPS clock, which are three unknowns.

【0075】また、共通衛星の数が三つ以上でない場
合、すなわち、共通衛星の数が二つ以下である場合、前
記位置検出装置20は、第2の他車相対位置演算処理を
実行する。この場合、前記位置検出装置20は、信号受
信装置25が受信した他車31から送信されたGPS情
報に基づいて、他車31が三つ以上のGPS衛星41か
らGPS情報を受信することができたか否かを判断す
る。そして、他車31がGPS情報を受信することがで
きたGPS衛星41の数が三つ以上である場合、前記位
置検出装置20は、他車位置特定演算処理を実行して他
車位置を特定する。
When the number of common satellites is not three or more, that is, when the number of common satellites is two or less, the position detecting device 20 executes the second other vehicle relative position calculation processing. In this case, the position detecting device 20 can receive GPS information from the three or more GPS satellites 41 by the other vehicle 31 based on the GPS information transmitted from the other vehicle 31 received by the signal receiving device 25. Determine whether or not. Then, when the number of GPS satellites 41 from which the other vehicle 31 can receive GPS information is three or more, the position detection device 20 executes another vehicle position identification calculation processing to identify the other vehicle position. To do.

【0076】ここで、該他車位置特定演算処理は、前述
された自車位置特定演算処理(ステップS2−4)と同
様の処理を他車31について実行するものである。すな
わち、他車31がGPS情報を受信することができたG
PS衛星41の数が四つ以上である場合、位置検出装置
20は、他車31が四つのGPS衛星41−1〜41−
4から受信したGPS情報に基づいて、該GPS情報に
含まれる各種数値を前記式(1)〜(4)で示される四
元連立方程式に代入し、解くことによって、四つの未知
数である他車位置の座標及び他車31のGPS時計の時
刻を算出する。この場合、x、y、zは他車位置の座
標、tは他車31のGPS時計の示す時刻である。これ
により、時刻tにおける他車位置の座標(x、y、z)
が特定される。
Here, the other vehicle position specifying calculation processing is the same as the own vehicle position specifying calculation processing (step S2-4) described above, which is executed for the other vehicle 31. That is, the G that the other vehicle 31 was able to receive the GPS information
When the number of PS satellites 41 is four or more, the position detection device 20 includes the GPS satellites 41-1 to 41-in which the other vehicle 31 has four.
Based on the GPS information received from No. 4, the various numerical values included in the GPS information are substituted into the quaternary simultaneous equations represented by the equations (1) to (4) and solved to solve another unknown vehicle, which is four unknowns. The coordinates of the position and the time of the GPS clock of the other vehicle 31 are calculated. In this case, x, y, and z are the coordinates of the other vehicle position, and t is the time indicated by the GPS clock of the other vehicle 31. As a result, the coordinates (x, y, z) of the position of the other vehicle at time t
Is specified.

【0077】また、他車31がGPS情報を受信するこ
とができたGPS衛星41の数が三つである場合、一般
的に、変化量が極めて少ないと考えられる他車位置にお
ける高さ方向の座標成分であるzの数値に、前回の周期
における他車位置特定演算処理で算出されたzの数値を
代入して、既知数として取り扱うこととする。すなわ
ち、他車位置の高さであるzを固定する。これにより、
GPS情報に含まれる各種数値を前記式(1)〜(3)
から成る三元連立方程式に代入し、解くことによって、
三つの未知数である他車位置の座標(但し、zは既知
数)及び他車31のGPS時計の時刻を算出することが
できる。
When the number of GPS satellites 41 that can receive GPS information from the other vehicle 31 is three, the variation in the height direction at the other vehicle position, which is generally considered to be extremely small, is considered. The numerical value of z, which is the coordinate component, is substituted with the numerical value of z calculated in the other vehicle position specifying calculation process in the previous cycle, and is treated as a known number. That is, z, which is the height of the position of the other vehicle, is fixed. This allows
The various numerical values included in the GPS information are expressed by the above formulas (1) to (3).
By substituting it into a three-dimensional system of equations
It is possible to calculate the coordinates of the position of the other vehicle (where z is a known number) and the time of the GPS clock of the other vehicle 31, which are three unknowns.

【0078】さらに、他車31がGPS情報を受信する
ことができたGPS衛星41の数が三つ以上でない場
合、すなわち、他車31がGPS情報を受信することが
できたGPS衛星41の数が二つ以下である場合には、
GPS情報に基づいて、他車位置を正確に特定すること
ができないので、前記位置検出装置20は、他車31の
車速、ヨーレイト等の車両状態情報に基づく他車位置特
定処理を実行して、時刻tにおける他車位置の座標
(x、y、z)を特定する。ここで、前記他車位置特定
処理は、前述された車両状態情報に基づく位置特定処理
(ステップS2−5)において、他車31の位置を特定
する場合の現在位置特定処理(ステップS2−5−4)
と同一であるので、他車31の位置を特定する場合の現
在位置特定処理の説明及び図7の記載を援用する。これ
により、図9に示されるように、他車31がGPS衛星
41からGPS情報を受信することができない場合であ
っても、自車11の位置検出装置20は、前記他車31
の位置を特定することができる。
Furthermore, when the number of GPS satellites 41 that the other vehicle 31 was able to receive GPS information is not three or more, that is, the number of GPS satellites 41 that the other vehicle 31 was able to receive GPS information. Is less than or equal to two,
Since the position of the other vehicle cannot be accurately specified based on the GPS information, the position detecting device 20 executes the other vehicle position specifying process based on the vehicle state information such as the vehicle speed and yaw rate of the other vehicle 31, The coordinates (x, y, z) of the other vehicle position at time t are specified. Here, the other vehicle position specifying process is the current position specifying process (step S2-5) for specifying the position of the other vehicle 31 in the position specifying process (step S2-5) based on the vehicle state information described above. 4)
Since it is the same as the above, the description of the current position specifying process when specifying the position of the other vehicle 31 and the description of FIG. 7 are cited. As a result, as shown in FIG. 9, even if the other vehicle 31 cannot receive GPS information from the GPS satellites 41, the position detection device 20 of the own vehicle 11 is not able to receive the other vehicle 31.
The position of can be specified.

【0079】次に、フローチャートについて説明する。
まず、相対位置演算処理の動作を示すフローチャートに
ついて説明する。 ステップS3−1 共通衛星の数をカウントする。 ステップS3−2 共通衛星が三つ以上であるか否かを
判断する。共通衛星が三つ以上である場合はステップS
3−3に進み、共通衛星が三つより少ない場合はステッ
プS3−4に進む。 ステップS3−3 第1の他車相対位置演算処理を行
い、処理を終了する。 ステップS3−4 第2の他車相対位置演算処理を行
い、処理を終了する。。
Next, the flowchart will be described.
First, a flowchart showing the operation of the relative position calculation process will be described. Step S3-1: Count the number of common satellites. Step S3-2: It is judged whether the number of common satellites is three or more. If there are three or more common satellites, step S
If the number of common satellites is less than three, the process proceeds to step S3-4. Step S3-3 The first other vehicle relative position calculation process is performed, and the process is ended. Step S3-4 A second other vehicle relative position calculation process is performed, and the process is ended. .

【0080】次に、第1の他車相対位置演算処理の動作
を示すフローチャートについて説明する。 ステップS3−3−1 共通衛星が四つ以上であるか否
かを判断する。共通衛星が四つ以上である場合はステッ
プS3−3−2に進み、共通衛星が三つである場合はス
テップS3−3−3に進む。 ステップS3−3−2 四つの共通衛星から受信したG
PS情報に基づいて他車31の相対位置(Δx,Δy,
Δz)を演算し、処理を終了する。 ステップS3−3−3 三つの共通衛星から受信したG
PS情報に基づいて他車31の相対位置(Δx,Δy,
Δz)を演算し、処理を終了する。
Next, a flow chart showing the operation of the first other vehicle relative position calculation processing will be described. Step S3-3-1: It is determined whether or not there are four or more common satellites. If there are four or more common satellites, the process proceeds to step S3-3-2, and if there are three common satellites, the process proceeds to step S3-3-3. Step S3-3-2 G received from four common satellites
Based on the PS information, the relative position of the other vehicle 31 (Δx, Δy,
Δz) is calculated, and the process ends. Step S3-3-3 G received from three common satellites
Based on the PS information, the relative position of the other vehicle 31 (Δx, Δy,
Δz) is calculated, and the process ends.

【0081】次に、第2の他車相対位置演算処理の動作
を示すフローチャートについて説明する。 ステップS3−4−1 他車31が三つ以上のGPS衛
星41から情報を受信しているか否かを判断する。三つ
以上のGPS衛星41から情報を受信している場合はス
テップS3−4−2に進み、三つ以上のGPS衛星41
から情報を受信していない場合はステップS3−4−3
に進む。 ステップS3−4−2 他車位置特定演算処理を行い、
処理を終了する。 ステップS3−4−3 車両状態情報に基づく他車位置
特定処理を行い、処理を終了する。
Next, a flow chart showing the operation of the second other vehicle relative position calculation processing will be described. Step S3-4-1: It is determined whether or not the other vehicle 31 receives information from three or more GPS satellites 41. When information is received from three or more GPS satellites 41, the process proceeds to step S3-4-2, and three or more GPS satellites 41 are received.
If the information is not received from step S3-4-3
Proceed to. Step S3-4-2 Performs another vehicle position identification calculation processing,
The process ends. Step S3-4-3 Other vehicle position specifying processing is performed based on the vehicle state information, and the processing ends.

【0082】次に、マップマッチング処理について説明
する。
Next, the map matching process will be described.

【0083】図13は本発明の実施の形態におけるマッ
プマッチング処理の動作の概略を示す図、図14は本発
明の実施の形態における第1の自他車位置補正処理の動
作を示す図、図15は本発明の実施の形態における第2
の自他車位置補正処理の動作を示す図、図16は本発明
の実施の形態における第4の自他車位置補正処理の動作
を示す図、図17は本発明の実施の形態におけるマップ
マッチング処理の動作を示すフローチャート、図18は
本発明の実施の形態における第1の自他車位置補正処理
の動作を示すフローチャート、図19は本発明の実施の
形態における自他車道路照合処理の動作を示すフローチ
ャート、図20は本発明の実施の形態における第2の自
他車位置補正処理の動作を示すフローチャート、図21
は本発明の実施の形態における第3の自他車位置補正処
理の動作を示すフローチャート、図22は本発明の実施
の形態における第4の自他車位置補正処理の動作を示す
フローチャート、図23は本発明の実施の形態における
第5の自他車位置補正処理の動作を示すフローチャー
ト、図24は本発明の実施の形態における第6の自他車
位置補正処理の動作を示すフローチャートである。
FIG. 13 is a diagram showing the outline of the operation of the map matching process in the embodiment of the present invention, and FIG. 14 is a diagram showing the operation of the first own-other vehicle position correction process in the embodiment of the present invention. 15 is the second in the embodiment of the present invention
Showing the operation of the own vehicle / other vehicle position correction processing, FIG. 16 shows the operation of the fourth own vehicle / other vehicle position correction processing in the embodiment of the present invention, and FIG. 17 is the map matching in the embodiment of the present invention. 18 is a flowchart showing the operation of the processing, FIG. 18 is a flowchart showing the operation of the first own-other vehicle position correction processing in the embodiment of the present invention, and FIG. 19 is the operation of the own-other vehicle road matching processing in the embodiment of the present invention. 21 is a flow chart showing the operation of the second own-other vehicle position correction processing in the embodiment of the present invention, and FIG.
23 is a flowchart showing the operation of the third own-other vehicle position correction processing in the embodiment of the present invention, FIG. 22 is a flowchart showing the operation of the fourth own-other vehicle position correction processing in the embodiment of the present invention, FIG. 24 is a flowchart showing an operation of a fifth own-other vehicle position correction process in the embodiment of the present invention, and FIG. 24 is a flowchart showing an operation of a sixth own-other vehicle position correction process in the embodiment of the present invention.

【0084】一般に、車両用のナビゲーション装置にお
いては、GPS情報に基づいて特定された車両の現在位
置が地図における道路上に位置するように、マップマッ
チング処理が実行される。これは、図13(a)に示さ
れるように、GPS情報に基づいて特定された車両の現
在位置は、誤差が含まれているので、地図における道路
からわずかに外れてしまう場合が多い。そこで、「車両
は通常道路上を走っている」との前提に基づいて、GP
S情報に基づいて特定された車両の現在位置を地図にお
ける道路上にまで移動させるためのマップマッチング処
理が実行される。これにより、図13(b)に示される
ように、車両の現在位置が地図における道路上に位置す
ることとなる。
Generally, in the vehicle navigation device, the map matching process is executed so that the current position of the vehicle specified based on the GPS information is located on the road on the map. This is because, as shown in FIG. 13A, the current position of the vehicle specified based on the GPS information includes an error, and thus often deviates slightly from the road on the map. Therefore, based on the premise that "the vehicle normally runs on the road," the GP
A map matching process for moving the current position of the vehicle specified based on the S information onto the road on the map is executed. As a result, as shown in FIG. 13B, the current position of the vehicle is located on the road on the map.

【0085】ここで、本実施の形態において、位置検出
装置20は、共通衛星から受信したGPS情報に基づい
て、自車11及び他車31の現在位置を特定するように
なっている。この場合、自車11と他車31との相対位
置及び相対距離は正確であると考えられる。そこで、本
実施の形態におけるマップマッチング処理においては、
図13(c)に示されるように、自車11及び他車31
の現在位置が、共通衛星から受信したGPS情報に基づ
いて特定された場合、自車11と他車31との相対位置
及び相対距離、すなわち、相対位置関係を崩さないよう
にして、自車11及び他車31の現在位置を地図におけ
る道路上にまで移動させるためのマップマッチング処理
が実行される。これにより、図13(d)に示されるよ
うに、自車11及び他車31の現在位置が地図における
道路上に位置することとなる。
Here, in the present embodiment, the position detection device 20 is adapted to identify the current positions of the own vehicle 11 and the other vehicle 31 based on the GPS information received from the common satellite. In this case, the relative position and relative distance between the own vehicle 11 and the other vehicle 31 are considered to be accurate. Therefore, in the map matching process in this embodiment,
As shown in FIG. 13C, the own vehicle 11 and the other vehicle 31
If the current position of the vehicle is specified based on the GPS information received from the common satellite, the relative position and the relative distance between the own vehicle 11 and the other vehicle 31, that is, the relative positional relationship is maintained, and the own vehicle 11 And the map matching process for moving the current position of the other vehicle 31 to the road on the map is executed. As a result, as shown in FIG. 13D, the current positions of the own vehicle 11 and the other vehicle 31 are located on the road on the map.

【0086】まず、位置検出装置20は、他車31の相
対位置を特定する時に、共通衛星から受信したGPS情
報に基づいて演算を行ったか否かを判断する。すなわ
ち、第1の他車相対位置演算処理(ステップS3−3)
を実行したか、または、第2の他車相対位置演算処理
(ステップS3−4)を実行したかを判断する。
First, when the relative position of the other vehicle 31 is specified, the position detecting device 20 determines whether or not the calculation is performed based on the GPS information received from the common satellite. That is, the first other vehicle relative position calculation process (step S3-3).
Or the second other vehicle relative position calculation process (step S3-4) is executed.

【0087】そして、共通衛星から受信したGPS情報
に基づいて演算を行った場合、前記位置検出装置20
は、自車位置と他車位置とが地図における道路上にある
か否かを走行軌跡に基づいて判断する。まず、前記位置
検出装置20は、自車位置が地図における道路上にある
か否かを自車11の走行軌跡、車速及びヨーレイトに基
づいて判断する。そして、自車位置が地図における道路
上にあると判断した場合、前記位置検出装置20は、他
車位置が地図における道路上にあるか否かを他車31の
走行軌跡に基づいて判断する。これにより、他車位置が
地図における道路上にあると判断した場合、前記位置検
出装置20は自車位置及び他車位置がともに実際の道路
上にあると判断して、第1の自他車位置補正処理を実行
する。
When the calculation is performed based on the GPS information received from the common satellite, the position detecting device 20
Determines whether or not the own vehicle position and the other vehicle position are on the road on the map based on the traveling locus. First, the position detection device 20 determines whether or not the vehicle position is on the road on the map based on the traveling locus of the vehicle 11, the vehicle speed, and the yaw rate. When it is determined that the own vehicle position is on the road on the map, the position detection device 20 determines whether or not the other vehicle position is on the road on the map based on the traveling locus of the other vehicle 31. Accordingly, when it is determined that the other vehicle position is on the road in the map, the position detection device 20 determines that both the own vehicle position and the other vehicle position are on the actual road, and the first own and other vehicle is detected. Position correction processing is executed.

【0088】この場合、前記位置検出装置20は、ま
ず、ナビ制御装置21の記憶手段に記録されているノー
ドデータを取得する。そして、図14(a)に示される
ように、座標(x1 、y1 、z1 )で表される位置にあ
る自車11の現在位置である自車位置42を、自車11
の走行軌跡、車速及びヨーレイトに基づいて判断された
位置、すなわち、走行軌跡、車速及びヨーレイトに基づ
く現在位置42’に移動させる。ここで、前記車速及び
ヨーレイトに基づく現在位置42’は地図における道路
44上のノード上にある。この時、座標(x2 、y2
2 )で表される位置にある他車31の現在位置である
他車位置43も、相対位置関係46を崩さないようにし
て、すなわち、Δx及びΔyを維持したままで移動させ
る。なお、図14は平面図であり、高さ方向の座標の変
化は省略されている。また、47は自車11の進行方
向、48は他車31の進行方向である。
In this case, the position detecting device 20 first obtains the node data recorded in the storage means of the navigation control device 21. Then, as shown in FIG. 14A, the own vehicle position 42, which is the current position of the own vehicle 11 at the position represented by the coordinates (x 1 , y 1 , z 1 ), is changed to the own vehicle 11
The vehicle is moved to a position determined based on the traveling locus, the vehicle speed and the yaw rate, that is, the current position 42 ′ based on the traveling locus, the vehicle speed and the yaw rate. Here, the current position 42 'based on the vehicle speed and the yaw rate is on a node on the road 44 in the map. At this time, the coordinates (x 2 , y 2 ,
The other vehicle position 43, which is the current position of the other vehicle 31 at the position represented by z 2 ), is also moved so that the relative positional relationship 46 is not broken, that is, Δx and Δy are maintained. Note that FIG. 14 is a plan view, and a change in coordinates in the height direction is omitted. Further, 47 is the traveling direction of the own vehicle 11, and 48 is the traveling direction of the other vehicle 31.

【0089】続いて、前記位置検出装置20は、他車位
置43が、他車31の走行軌跡に基づいて判断された位
置、すなわち、走行軌跡に基づく他車位置43’と一致
しているか否か判断する。ここで、走行軌跡に基づく他
車位置43’は地図における道路45上のノード上にあ
る。そして、他車位置43が道路45上にある走行軌跡
に基づく他車位置43’と一致している場合には、自車
位置42及び他車位置43が共に地図における道路44
及び道路45上に合致しているので、マップマッチング
処理を終了する。
Subsequently, the position detecting device 20 determines whether or not the other vehicle position 43 matches the position determined based on the traveling locus of the other vehicle 31, that is, the other vehicle position 43 'based on the traveling locus. To determine. Here, the other vehicle position 43 ′ based on the traveling locus is on a node on the road 45 in the map. Then, when the other vehicle position 43 matches the other vehicle position 43 ′ based on the traveling locus on the road 45, both the own vehicle position 42 and the other vehicle position 43 are on the road 44 on the map.
And the road 45, the map matching process ends.

【0090】また、他車位置43が走行軌跡に基づく他
車位置43’と一致しない場合、前記位置検出装置20
は自他車道路照合処理を実行する。この場合、自車位置
42及び他車位置43は、図14(b)に示されるよう
になっている。ここで、自車位置42は、道路44上の
ノード上にまで移動し、他車位置43は、前記自車位置
42との相対位置関係46を崩さない位置にまで移動し
た状態となっている。すなわち、Δx及びΔyは維持さ
れている。なお、図14(b)において42aは移動前
の自車位置、すなわち、図14(a)における自車位置
42を示し、43aは移動前の他車位置、すなわち、図
14(a)における他車位置43を示している。
If the other vehicle position 43 does not match the other vehicle position 43 'based on the traveling locus, the position detecting device 20
Executes the own vehicle / other vehicle road matching process. In this case, the own vehicle position 42 and the other vehicle position 43 are as shown in FIG. 14 (b). Here, the own vehicle position 42 has moved to a node on the road 44, and the other vehicle position 43 has moved to a position where the relative positional relationship 46 with the own vehicle position 42 is not broken. . That is, Δx and Δy are maintained. In addition, in FIG. 14B, 42a indicates the own vehicle position before the movement, that is, the own vehicle position 42 in FIG. 14A, and 43a indicates the other vehicle position before the movement, that is, the other vehicle position in FIG. 14A. The vehicle position 43 is shown.

【0091】続いて、前記位置検出装置20は、他車位
置43が現時点で位置するであろうと考えられる道路4
5及び他車位置43’を、他車31の走行軌跡、車速及
びヨーレイトに基づいて決定する。そして、他車位置4
3が、現時点で位置するであろうと考えられる道路45
上に位置するように、他車位置43及び自車位置42を
移動させる。この時、道路44上にある自車11の現在
位置である自車位置42が道路44上から外れないよう
に、かつ、相対位置関係46を崩さないようにして、他
車位置43及び自車位置42が移動させられる。
Subsequently, the position detecting device 20 determines that the other vehicle position 43 is currently located on the road 4
5 and the other vehicle position 43 ′ are determined based on the traveling locus of the other vehicle 31, the vehicle speed, and the yaw rate. And other vehicle position 4
3 is road 45 which is considered to be located at the present time
The other vehicle position 43 and the own vehicle position 42 are moved so as to be located above. At this time, the own vehicle position 42, which is the current position of the own vehicle 11 on the road 44, does not deviate from the road 44, and the relative positional relationship 46 is not broken, and the other vehicle position 43 and the own vehicle position Position 42 is moved.

【0092】そして、前記位置検出装置20は、他車位
置43が現時点で位置するであろうと考えられる道路4
5上にあるか否かを判断する。ここで、他車位置43が
道路45上にあると判断した場合、自車位置42及び他
車位置43は、図14(c)に示されるようになってい
る。なお、図14(c)において42bは移動前の自車
位置、すなわち、図14(b)における自車位置42を
示し、43bは移動前の他車位置、すなわち、図14
(b)における他車位置43を示している。この場合、
図14(c)における他車位置43及び自車位置42
は、道路44の方向に沿って移動させられたことが分か
る。そして、他車位置43が道路45上にある場合に
は、自車位置42及び他車位置43が共に地図における
道路44及び45上に合致しているので、マップマッチ
ング処理を終了する。
Then, the position detecting device 20 uses the road 4 which is considered to be the other vehicle position 43 at the present time.
It is determined whether or not it is above 5. Here, when it is determined that the other vehicle position 43 is on the road 45, the own vehicle position 42 and the other vehicle position 43 are as shown in FIG. 14 (c). In addition, in FIG. 14C, 42b shows the own vehicle position before the movement, that is, the own vehicle position 42 in FIG. 14B, and 43b shows the other vehicle position before the movement, that is, FIG.
The other vehicle position 43 in (b) is shown. in this case,
Other vehicle position 43 and own vehicle position 42 in FIG.
Can be seen to have been moved along the direction of road 44. When the other vehicle position 43 is on the road 45, both the own vehicle position 42 and the other vehicle position 43 are on the roads 44 and 45 in the map, so the map matching process is ended.

【0093】また、他車位置43が道路45上にない場
合には、他車31は、例えば、駐車場に入る等して道路
上から外れた可能性がある。そこで、前記位置検出装置
20は、再度、自車位置42を、自車11の走行軌跡、
車速及びヨーレイトに基づいて現時点で位置するであろ
うと考えられる道路44上のノード上に移動させる。こ
の時、他車位置43も、相対位置関係46を崩さないよ
うにして、すなわち、Δx及びΔyを維持したままで移
動させられる。そして、マップマッチング処理を終了す
る。
If the other vehicle position 43 is not on the road 45, the other vehicle 31 may have come off the road, for example, by entering a parking lot. Therefore, the position detection device 20 again sets the vehicle position 42 to the traveling locus of the vehicle 11,
Move to a node on road 44 that is likely to be currently located based on vehicle speed and yaw rate. At this time, the other vehicle position 43 is also moved without breaking the relative positional relationship 46, that is, while maintaining Δx and Δy. Then, the map matching process ends.

【0094】そして、前記位置検出装置20は、前述し
たように、他車位置43が地図における道路45上にあ
るか否かを他車31の走行軌跡に基づいて判断した時
に、他車位置43が地図における道路45上にない場
合、自車位置が実際の道路上にあると判断して、第2の
自他車位置補正処理を実行する。
Then, as described above, the position detecting device 20 determines the other vehicle position 43 when the other vehicle position 43 is on the road 45 in the map based on the traveling locus of the other vehicle 31. Is not on the road 45 in the map, it is determined that the own vehicle position is on the actual road, and the second own-other-vehicle position correction process is executed.

【0095】この場合、前記位置検出装置20は、ま
ず、ナビ制御装置21の記憶手段に記録されているノー
ドデータを取得する。そして、図15(a)に示される
ように、座標(x1 、y1 、z1 )で表される位置にあ
る自車11の現在位置である自車位置42を、走行軌
跡、車速及びヨーレイトに基づく現在位置42’に移動
させる。ここで、前記車速及びヨーレイトに基づく現在
位置42’は地図における道路44上のノード上にあ
る。この時、座標(x2 、y2 、z2 )で表される位置
にある他車31の現在位置である他車位置43も、相対
位置関係46を崩さないようにして、すなわち、Δx及
びΔyを維持したままで移動させられる。なお、図15
は平面図であり、高さ方向の座標の変化は省略されてい
る。また、図15における符号は、図14と同様である
ので、その説明を省略する。
In this case, the position detecting device 20 first obtains the node data recorded in the storage means of the navigation control device 21. Then, as shown in FIG. 15A, the own vehicle position 42, which is the current position of the own vehicle 11 at the position represented by the coordinates (x 1 , y 1 , z 1 ), is changed to the running locus, the vehicle speed, and the It is moved to the current position 42 'based on the yaw rate. Here, the current position 42 'based on the vehicle speed and the yaw rate is on a node on the road 44 in the map. In this case, so as not to disturb the coordinates (x 2, y 2, z 2) vehicle position 43 is the current position of the other vehicle 31 in the represented position also, the relative positional relationship 46, i.e., [Delta] x and It can be moved while maintaining Δy. Note that FIG.
Is a plan view, and changes in the coordinates in the height direction are omitted. Further, the reference numerals in FIG. 15 are the same as those in FIG. 14, and therefore their explanations are omitted.

【0096】これにより、図15(b)に示されるよう
に、自車位置42は道路44上のノード上に位置する。
なお、第2の自他車位置補正処理は、他車位置43が道
路上にないと判断した場合に実行されるので、前記第2
の自他車位置補正処理において、前記位置検出装置20
は、前記第1の自他車位置補正処理において行ったよう
な他車位置43を道路45上に移動させるための処理を
行わない。そして、マップマッチング処理を終了する。
As a result, the vehicle position 42 is located on the node on the road 44, as shown in FIG.
It should be noted that the second own-other vehicle position correction process is executed when it is determined that the other vehicle position 43 is not on the road.
In the own vehicle / other vehicle position correction process, the position detection device 20
Does not perform the process for moving the other vehicle position 43 on the road 45 as performed in the first own / other vehicle position correction process. Then, the map matching process ends.

【0097】また、前記位置検出装置20は、前述した
ように、自車位置42が地図における道路44上にある
か否かを自車11の走行軌跡に基づいて判断した時に、
自車位置42が地図における道路44上にない場合、さ
らに、他車位置43が地図における道路45上にあるか
否かを判断する。そして、他車位置43が地図における
道路45上にある場合、前記位置検出装置20は他車位
置が実際の道路上にあると判断して、第3の自他車位置
補正処理を実行する。
As described above, the position detecting device 20 determines whether the vehicle position 42 is on the road 44 in the map based on the traveling locus of the vehicle 11.
When the own vehicle position 42 is not on the road 44 on the map, it is further determined whether or not the other vehicle position 43 is on the road 45 on the map. Then, when the other vehicle position 43 is on the road 45 in the map, the position detection device 20 determines that the other vehicle position is on the actual road and executes the third own / other vehicle position correction process.

【0098】この場合、前記位置検出装置20は、ま
ず、ナビ制御装置21の記憶手段に記録されているノー
ドデータを取得する。そして、図15(a)に示される
ように、座標(x2 、y2 、z2 )で表される位置にあ
る他車31の現在位置である他車位置43を、走行軌跡
に基づく他車位置43’と一致しているか否か判断す
る。ここで、走行軌跡に基づく他車位置43’は地図に
おける道路45上のノード上にあるとする。この時、座
標(x1 、y1 、z1 )で表される位置にある自車11
の現在位置である自車位置42も、相対位置関係46を
崩さないようにして、すなわち、Δx及びΔyを維持し
たままで移動させられる。
In this case, the position detecting device 20 first obtains the node data recorded in the storage means of the navigation control device 21. Then, as shown in FIG. 15A, the other vehicle position 43, which is the current position of the other vehicle 31 at the position represented by the coordinates (x 2 , y 2 , z 2 ), is changed based on the traveling locus. It is determined whether or not it matches the vehicle position 43 '. Here, it is assumed that the other vehicle position 43 ′ based on the traveling locus is on a node on the road 45 in the map. At this time, the own vehicle 11 at the position represented by the coordinates (x 1 , y 1 , z 1 )
The vehicle position 42, which is the current position of, is also moved without breaking the relative positional relationship 46, that is, while maintaining Δx and Δy.

【0099】これにより、他車位置43は道路45上の
ノード上に位置する。なお、第3の自他車位置補正処理
は、自車位置42が道路44上にないと判断した場合に
実行されるので、前記第3の自他車位置補正処理におい
て、前記位置検出装置20は、前記第1及び2の自他車
位置補正処理において行ったような自車位置42を道路
44上に移動させるための処理を行わない。そして、マ
ップマッチング処理を終了する。
As a result, the other vehicle position 43 is located on the node on the road 45. The third own-other vehicle position correction process is executed when it is determined that the own-vehicle position 42 is not on the road 44. Therefore, in the third own-other vehicle position correction process, the position detection device 20 is used. Does not perform the processing for moving the own vehicle position 42 on the road 44 as performed in the first and second own and other vehicle position correction processing. Then, the map matching process ends.

【0100】また、他車位置43が地図における道路4
5上にない場合、前記位置検出装置20は、自車11の
車速が所定値(例えば、30〔km〕)以上であるか否
か判断する。ここで、車速が所定値未満である場合に
は、自車11は道路44以外の場所、例えば、駐車場等
を走行している可能性が高いのに対して、車速が所定値
以上である場合、自車11は道路44上を走行してい
る、すなわち、自車位置42が道路44上にある可能性
が高いと考えられる。
The other vehicle position 43 is the road 4 on the map.
If the vehicle speed is not 5, the position detection device 20 determines whether the vehicle speed of the vehicle 11 is a predetermined value (for example, 30 [km]) or more. Here, when the vehicle speed is less than the predetermined value, it is highly possible that the vehicle 11 is traveling in a place other than the road 44, for example, a parking lot, while the vehicle speed is the predetermined value or more. In this case, it is considered highly likely that the vehicle 11 is traveling on the road 44, that is, the vehicle position 42 is on the road 44.

【0101】そこで、自車11の車速が所定値以上であ
る場合には、自車位置及び他車位置がともに実際の道路
上になく、かつ、車速が所定値以上であると判断して、
第4の自他車位置補正処理を実行する。この場合、ま
ず、自車位置42に基づいて、複数のマッチング候補点
を選択する。すなわち、前記自車位置42を中心とする
所定半径内に存在する道路に対して、前記自車位置42
から垂線を引き、該垂線の足をマッチング候補点として
選択する。
Therefore, when the vehicle speed of the host vehicle 11 is equal to or higher than the predetermined value, it is determined that neither the host vehicle position nor the other vehicle position is on the actual road, and the vehicle speed is equal to or higher than the predetermined value.
The fourth own vehicle / other vehicle position correction process is executed. In this case, first, a plurality of matching candidate points are selected based on the vehicle position 42. That is, with respect to the road existing within a predetermined radius centered on the vehicle position 42, the vehicle position 42
A perpendicular line is drawn from, and the foot of the perpendicular line is selected as a matching candidate point.

【0102】続いて、自車11の進行方向とマッチング
候補点における進行方向との関係、自車位置42からマ
ッチング候補点までの距離等に基づいて、各マッチング
候補点におけるペナルティを算出する。なお、マッチン
グ候補点における進行方向は、計算で求めてもよいし、
あらかじめ道路データとして持っているようにしてもよ
い。
Then, the penalty at each matching candidate point is calculated based on the relationship between the traveling direction of the own vehicle 11 and the traveling direction at the matching candidate point, the distance from the own vehicle position 42 to the matching candidate point, and the like. The traveling direction at the matching candidate point may be calculated,
It may be stored as road data in advance.

【0103】続いて、ペナルティの最も小さいマッチン
グ候補点を現在位置として決定し、該現在位置に自車位
置42を移動させる。この時、他車位置43も、相対位
置関係46を崩さないようにして、すなわち、Δx及び
Δyを維持したままで移動させられる。
Subsequently, the matching candidate point having the smallest penalty is determined as the current position, and the vehicle position 42 is moved to the current position. At this time, the other vehicle position 43 is also moved without breaking the relative positional relationship 46, that is, while maintaining Δx and Δy.

【0104】なお、自車位置42だけでなく、他車位置
43に基づく複数のマッチング候補点も選択し、自車位
置42及び他車位置43に関してペナルティの最も小さ
いマッチング候補点の組合せを自車11及び他車31の
現在位置として決定し、該現在位置に自車位置42及び
他車位置43を移動させるようにしてもよい。また、す
べてのッチング候補点の中からペナルティの最も小さい
マッチング候補点を自車11又は他車31の現在位置と
して決定し、該現在位置に自車位置42又は他車位置4
3を移動させるようにしてもよい。
Not only the own vehicle position 42 but also a plurality of matching candidate points based on the other vehicle position 43 are selected, and a combination of matching candidate points having the smallest penalty with respect to the own vehicle position 42 and the other vehicle position 43 is selected. It may be determined as the current positions of the vehicle 11 and the other vehicle 31, and the own vehicle position 42 and the other vehicle position 43 may be moved to the current positions. Further, the matching candidate point having the smallest penalty is determined as the current position of the own vehicle 11 or the other vehicle 31 from all the hatching candidate points, and the own vehicle position 42 or the other vehicle position 4 is set at the present position.
3 may be moved.

【0105】一方、自車11の車速が所定値未満であ場
合には、自車位置及び他車位置がともに実際の道路上に
なく、かつ、車速が所定値以上であると判断して、第5
の自他車位置補正処理を実行する。この場合、前記位置
検出装置20は、まず、ナビ制御装置21の記憶手段に
記録されているノードデータを取得する。そして、図1
6(a)に示されるように、座標(x1 、y1 、z1
で表される位置にある自車11の現在位置である自車位
置42を、走行軌跡、車速及びヨーレイトに基づく現在
位置42’に移動させる。この時、座標(x2 、y2
2 )で表される位置にある他車31の現在位置である
他車位置43も、相対位置関係46を崩さないようにし
て、すなわち、Δx及びΔyを維持したままで移動させ
られる。なお、図16は平面図であり、高さ方向の座標
の変化は省略されている。また、図16における符号
は、図14と同様であるので、その説明を省略する。
On the other hand, when the vehicle speed of the host vehicle 11 is less than the predetermined value, it is determined that both the host vehicle position and the other vehicle position are not on the actual road, and the vehicle speed is equal to or higher than the predetermined value. Fifth
The own vehicle / other vehicle position correction process is executed. In this case, the position detecting device 20 first acquires the node data recorded in the storage means of the navigation control device 21. And FIG.
As shown in 6 (a), the coordinates (x 1 , y 1 , z 1 )
The own vehicle position 42, which is the current position of the own vehicle 11 at the position represented by, is moved to the current position 42 ′ based on the traveling locus, the vehicle speed, and the yaw rate. At this time, the coordinates (x 2 , y 2 ,
The other vehicle position 43 which is the current position of the other vehicle 31 at the position represented by z 2 ) is also moved without breaking the relative positional relationship 46, that is, while maintaining Δx and Δy. Note that FIG. 16 is a plan view, and changes in the coordinates in the height direction are omitted. Further, the reference numerals in FIG. 16 are the same as those in FIG. 14, and therefore their explanations are omitted.

【0106】これにより、図16(b)に示されるよう
に、自車位置42は走行軌跡、車速及びヨーレイトに基
づく現在位置42’と一致する。なお、第5の自他車位
置補正処理は、他車位置43が道路上にないと判断した
場合に実行されるので、前記第5の自他車位置補正処理
において、前記位置検出装置20は、前記第1の自他車
位置補正処理において行ったような他車位置43を道路
45上に移動させるための処理を行わない。そして、マ
ップマッチング処理を終了する。
Thus, as shown in FIG. 16 (b), the vehicle position 42 coincides with the current position 42 'based on the traveling locus, the vehicle speed and the yaw rate. Since the fifth own-other vehicle position correction process is executed when it is determined that the other-vehicle position 43 is not on the road, the position detection device 20 performs the fifth own-other vehicle position correction process. The processing for moving the other vehicle position 43 on the road 45 as performed in the first own-other-vehicle position correction processing is not performed. Then, the map matching process ends.

【0107】なお、他車31の相対位置を特定する時
に、共通衛星から受信したGPS情報に基づいて演算を
行わなかった場合、前記位置検出装置20は第6の自他
車位置補正処理を実行する。この場合、自車位置42と
他車位置43とが独立した演算によって特定されている
ので、自車位置42と他車位置43との相対位置関係を
維持する必要がない。そのため、前記位置検出装置20
は、自車位置42と他車位置43とに関して、それぞ
れ、別個にマップマッチング処理を実行する。
When the relative position of the other vehicle 31 is specified, if the calculation is not performed based on the GPS information received from the common satellite, the position detecting device 20 executes the sixth own / other vehicle position correcting process. To do. In this case, since the own vehicle position 42 and the other vehicle position 43 are specified by independent calculations, it is not necessary to maintain the relative positional relationship between the own vehicle position 42 and the other vehicle position 43. Therefore, the position detection device 20
Executes the map matching process separately for the own vehicle position 42 and the other vehicle position 43.

【0108】まず、前記位置検出装置20は、自車位置
42に関し、位置を特定する時に、GPS衛星41から
のGPS情報を使用したか否かを判断する。そして、G
PS情報を使用した場合、前記位置検出装置20は、自
車11の現在位置である自車位置42を、自車11の走
行軌跡、車速及びヨーレイトに基づいて現時点で位置す
るであろうと考えられる地点に移動させる。なお、自車
位置42を特定する時にGPS情報を使用しない場合に
は、既に自車11の走行軌跡、車速及びヨーレイトに基
づいて、位置を特定しているので、自車11の走行軌
跡、車速及びヨーレイトに基づいて現時点で位置するで
あろうと考えられる地点に移動させる処理を実行しな
い。そして、マップマッチング処理を終了する。
First, the position detecting device 20 determines whether or not the GPS information from the GPS satellite 41 is used when the position of the own vehicle position 42 is specified. And G
When the PS information is used, it is considered that the position detection device 20 will position the own vehicle position 42, which is the current position of the own vehicle 11, at the present time based on the traveling locus of the own vehicle 11, the vehicle speed, and the yaw rate. Move to a point. If the GPS information is not used when specifying the own vehicle position 42, the position is already specified based on the traveling locus of the own vehicle 11, the vehicle speed, and the yaw rate. And the process of moving to a point which is considered to be located at the present time based on the yaw rate is not executed. Then, the map matching process ends.

【0109】また、前記位置検出装置20は、他車位置
43に関しても、前述された自車位置42に関する場合
と同様の処理を実行する。
Further, the position detecting device 20 executes the same process for the other vehicle position 43 as for the own vehicle position 42 described above.

【0110】次に、フローチャートについて説明する。
まず、マップマッチング処理の動作を示すフローチャー
トについて説明する。 ステップS4−1 共通衛星から受信したGPS情報に
基づいて演算を行ったか否かを判断する。共通衛星から
受信したGPS情報に基づいて演算を行った場合はステ
ップS4−2に進み、共通衛星から受信したGPS情報
に基づいて演算を行わなかった場合はステップS4−1
1に進む。 ステップS4−2 自車位置42が道路44上に存在し
ているか否かを判断する。自車位置42が道路44上に
存在している場合はステップS4−3に進み、自車位置
42が道路44上に存在していない場合はステップS4
−6に進む。 ステップS4−3 他車位置43が道路45上に存在し
ているか否かを判断する。他車位置45が道路45上に
存在している場合はステップS4−4に進み、他車位置
43が道路45上に存在していない場合はステップS4
−5に進む。 ステップS4−4 第1の自他車位置補正処理を行い、
処理を終了する。 ステップS4−5 第2の自他車位置補正処理を行い、
処理を終了する。 ステップS4−6 他車位置43が道路45上に存在し
ているか否かを判断する。他車位置43が道路45上に
存在している場合はステップS4−7に進み、他車位置
43が道路45上に存在していない場合はステップS4
−8に進む。 ステップS4−7 第3の自他車位置補正処理を行い、
処理を終了する。 ステップS4−8 車速が所定値以上であるか否か判断
する。車速が所定値以上である場合にはステップS4−
9に進み、車速が所定値以上でない場合にはステップS
4−10に進む。 ステップS4−9 第4の自他車位置補正処理を行い、
処理を終了する。 ステップS4−10 第5の自他車位置補正処理を行
い、処理を終了する。 ステップS4−11 第6の自他車位置補正処理を行
い、処理を終了する。
Next, the flowchart will be described.
First, a flowchart showing the operation of the map matching process will be described. Step S4-1: It is determined whether or not the calculation is performed based on the GPS information received from the common satellite. When the calculation is performed based on the GPS information received from the common satellite, the process proceeds to step S4-2, and when the calculation is not performed based on the GPS information received from the common satellite, step S4-1.
Go to 1. In step S4-2, it is determined whether or not the vehicle position 42 exists on the road 44. If the vehicle position 42 is on the road 44, the process proceeds to step S4-3. If the vehicle position 42 is not on the road 44, step S4.
Go to -6. In step S4-3, it is determined whether or not the other vehicle position 43 exists on the road 45. If the other vehicle position 45 exists on the road 45, the process proceeds to step S4-4. If the other vehicle position 43 does not exist on the road 45, step S4.
Go to -5. Step S4-4 Performs the first own / other vehicle position correction process,
The process ends. Step S4-5 Perform the second own / other vehicle position correction processing,
The process ends. Step S4-6: It is judged whether or not the other vehicle position 43 exists on the road 45. If the other vehicle position 43 exists on the road 45, the process proceeds to step S4-7. If the other vehicle position 43 does not exist on the road 45, step S4.
Go to -8. Step S4-7 Perform the third own / other vehicle position correction processing,
The process ends. Step S4-8: It is judged whether the vehicle speed is equal to or higher than a predetermined value. If the vehicle speed is equal to or higher than the predetermined value, step S4-
9. If the vehicle speed is not higher than the predetermined value, go to step S9.
Go to 4-10. Step S4-9 Performs a fourth own vehicle / other vehicle position correction process,
The process ends. Step S4-10 Performs the fifth own vehicle / other vehicle position correction processing, and ends the processing. Step S4-11 A sixth own-other vehicle position correction process is performed, and the process ends.

【0111】次に、第1の自他車位置補正処理を示すフ
ローチャートについて説明する。 ステップS4−4−1 自車位置42を現在位置してい
ると考えられる道路44上のノード44−1上に移動さ
せる。 ステップS4−4−2 他車位置43が道路45上のノ
ード45−1上に位置しているか否かを判断する。他車
位置43が道路45上のノード45−1上に位置してい
る場合は処理を終了し、他車位置43が道路45上のノ
ード45−1上に位置していない場合はステップS4−
4−3に進む。 ステップS4−4−3 自他車道路照合処理を行い、処
理を終了する。
Next, a flow chart showing the first own and other vehicle position correction processing will be described. Step S4-4-1 The vehicle position 42 is moved to the node 44-1 on the road 44 which is considered to be currently located. Step S4-4-2: It is determined whether or not the other vehicle position 43 is located on the node 45-1 on the road 45. If the other vehicle position 43 is located on the node 45-1 on the road 45, the process ends, and if the other vehicle position 43 is not located on the node 45-1 on the road 45, step S4-.
Go to 4-3. Step S4-4-3 The own / other vehicle road matching process is performed, and the process ends.

【0112】次に、自他車道路照合処理を示すフローチ
ャートについて説明する。 ステップS4−4−3−1 他車位置43がどの道路上
に存在しているかを決定する。 ステップS4−4−3−2 自車位置42及び他車位置
43を道路上に位置するように移動させる。 ステップS4−4−3−3 他車位置43が道路45上
にあるか否かを判断する。他車位置43が道路45上に
ある場合は処理を終了し、他車位置43が道路45上に
ない場合はステップS4−4−3−4に進む。 ステップS4−4−3−4 自車位置42を現在位置し
ていると考えられる道路44上のノード44−1上に移
動させ、処理を終了する。
Next, a flow chart showing the own / other vehicle road matching process will be described. Step S4-4-3-1 It is determined on which road the other vehicle position 43 exists. Step S4-4-3-2 The own vehicle position 42 and the other vehicle position 43 are moved so as to be located on the road. In step S4-4-3-3, it is determined whether or not the other vehicle position 43 is on the road 45. If the other vehicle position 43 is on the road 45, the process ends, and if the other vehicle position 43 is not on the road 45, the process proceeds to step S4-4-3-4. Step S4-4-3-4 The vehicle position 42 is moved to the node 44-1 on the road 44 which is considered to be currently located, and the process is ended.

【0113】次に、第2の自他車位置補正処理を示すフ
ローチャートについて説明する。 ステップS4−5−1 自車位置42を現在位置してい
ると考えられる道路44上のノード44−1上に移動さ
せ、処理を終了する。
Next, a flow chart showing the second own vehicle / other vehicle position correction processing will be described. Step S4-5-1: The vehicle position 42 is moved to the node 44-1 on the road 44 which is considered to be currently located, and the process is ended.

【0114】次に、第3の自他車位置補正処理を示すフ
ローチャートについて説明する。 ステップS4−7−1 他車位置43を現在位置してい
ると考えられる道路45上のノード45−1上に移動さ
せ、処理を終了する。
Next, a flow chart showing the third own vehicle / other vehicle position correction processing will be described. Step S4-7-1: The other vehicle position 43 is moved to the node 45-1 on the road 45 which is considered to be currently located, and the process is ended.

【0115】次に、第4の自他車位置補正処理を示すフ
ローチャートについて説明する。 ステップS4−9−1 自車位置42に基づいてマッチ
ング候補点を選択する。 ステップS4−9−2 マッチング候補点のペナルティ
を算出する。 ステップS4−9−3 ペナルティの最も小さいマッチ
ング候補点を現在位置として決定する。 ステップS4−9−4 自車位置42をマッチング候補
点に移動させる。
Next, a flow chart showing the fourth own vehicle / other vehicle position correction processing will be explained. Step S4-9-1 A matching candidate point is selected based on the vehicle position 42. Step S4-9-2 The penalty of the matching candidate points is calculated. Step S4-9-3 The matching candidate point with the smallest penalty is determined as the current position. Step S4-9-4 The vehicle position 42 is moved to the matching candidate point.

【0116】次に、第5の自他車位置補正処理を示すフ
ローチャートについて説明する。 ステップS4−10−1 自車位置42を現在位置して
いると考えられる地点42’に移動させ、処理を終了す
る。
Next, a flow chart showing the fifth own-other vehicle position correction processing will be explained. Step S4-10-1 The vehicle position 42 is moved to the point 42 'which is considered to be currently located, and the process is ended.

【0117】次に、第6の自他車位置補正処理を示すフ
ローチャートについて説明する。ステップS4−11−
1 自車位置検出にGPS衛星41からのGPS情報を
使用したか否かを判断する。自車位置検出にGPS衛星
41からのGPS情報を使用した場合はステップS4−
9−2に進み、自車位置検出にGPS衛星41からのG
PS情報を使用しない場合は処理を終了する。ステップ
S4−11−2 自車位置42を現在位置していると考
えられる地点に移動させ、処理を終了する。
Next, a flowchart showing the sixth own-other vehicle position correction processing will be described. Step S4-11-
1 It is determined whether or not the GPS information from the GPS satellite 41 is used for detecting the vehicle position. If the GPS information from the GPS satellite 41 is used for detecting the own vehicle position, step S4-
Proceed to 9-2 to detect the position of the vehicle using G from the GPS satellite 41
If the PS information is not used, the process ends. In step S4-11-2, the vehicle position 42 is moved to a position that is considered to be the current position, and the process ends.

【0118】前記マップマッチング処理における第1の
自他車位置補正処理を実行することにより、自車11と
他車31との相対位置関係を維持しながら位置の補正を
行うことができるので、自車11又は他車31だけで行
う位置補正よりも、処理精度が向上する。
By executing the first own / other vehicle position correcting process in the map matching process, the position can be corrected while maintaining the relative positional relationship between the own vehicle 11 and the other vehicle 31. The processing accuracy is improved as compared with the position correction performed only by the vehicle 11 or the other vehicle 31.

【0119】そして、第2又は第3の自他車位置補正処
理を実行することにより、自車11又は他車31のいず
れかが道路上にある場合、一方の車両の位置を制限しつ
つ、自車11と他車31との相対位置関係を維持しなが
ら位置の補正を行うことができるので、車両の周辺に存
在する道路上になるように位置補正を行う従来の補正に
比較して、処理精度が向上する。
When either the own vehicle 11 or the other vehicle 31 is on the road by executing the second or third vehicle / other vehicle position correction processing, while limiting the position of one vehicle, Since the position can be corrected while maintaining the relative positional relationship between the own vehicle 11 and the other vehicle 31, as compared with the conventional correction in which the position is corrected so as to be on the road existing around the vehicle, The processing accuracy is improved.

【0120】また、第4の自他車位置補正処理を実行す
ることにより、車速が所定値以上であって、自車11は
道路44上を走行している、すなわち、自車位置42が
道路上にある可能性が高いと考えられる場合に、現在位
置を道路上移動させるので、自車位置42及び他車位置
43を適切な位置に移動させることができる。
By executing the fourth own / other vehicle position correcting process, the vehicle speed is equal to or higher than the predetermined value and the own vehicle 11 is traveling on the road 44, that is, the own vehicle position 42 is on the road. When it is considered that there is a high possibility of being above, the current position is moved on the road, so that the own vehicle position 42 and the other vehicle position 43 can be moved to appropriate positions.

【0121】また、第5の自他車位置補正処理を実行す
ることにより、車速が所定値未満であって、自車位置4
2が道路上にない可能性が高いと考えられる場合に、自
車位置42を適切と判断するので、自車位置42及び他
車位置43を適切な位置とすることができる。
By executing the fifth own / other vehicle position correction processing, the vehicle speed is less than the predetermined value and the own vehicle position 4
When it is considered that there is a high possibility that 2 is not on the road, the own vehicle position 42 is determined to be appropriate, so the own vehicle position 42 and the other vehicle position 43 can be set to appropriate positions.

【0122】次に、報知処理について説明する。Next, the notification process will be described.

【0123】図25は本発明の実施の形態における報知
処理の動作を示すフローチャートである。
FIG. 25 is a flow chart showing the operation of the notification processing in the embodiment of the present invention.

【0124】まず、位置検出装置20は、マップマッチ
ング処理によって特定されたの自車11の現在位置、及
び、他車31の現在位置を表示装置27の画面に表示さ
れている地図に重ね合わせて表示する。これにより、自
車11の運転者は、自車11及び他車31の位置を的確
に把握することができる。
First, the position detecting device 20 superimposes the current position of the own vehicle 11 and the current position of the other vehicle 31 specified by the map matching process on the map displayed on the screen of the display device 27. indicate. This allows the driver of the own vehicle 11 to accurately grasp the positions of the own vehicle 11 and the other vehicle 31.

【0125】また、前記位置検出装置20は、自車11
及び他車31の位置、進行方向、速度等の要素に基づい
て、自車11及び他車31が接近し過ぎて、車両同士が
接触したりする可能性があると判断した場合、警報装置
26に指令を送信する。すると、該警報装置26は、自
車11の運転者に対して警報を発する。これにより、前
記運転者は、他車31と接近し過ぎないように適切な措
置を取ることができる。なお、前記位置検出装置20が
車両の制御装置、例えば、エンジンの制御を実行するE
CU等に直接指令を送信して、エンジン回転数を低下さ
せる等の制御を行わせるようにしてもよい。
Further, the position detecting device 20 is used for the own vehicle 11
When it is determined that the own vehicle 11 and the other vehicle 31 are too close to each other and the vehicles may come into contact with each other based on factors such as the position, the traveling direction, and the speed of the other vehicle 31, the alarm device 26 Send a command to. Then, the alarm device 26 issues a warning to the driver of the own vehicle 11. As a result, the driver can take appropriate measures so as not to approach the other vehicle 31 too much. It should be noted that the position detection device 20 executes a control device for a vehicle, for example, an engine control unit E
A command may be directly transmitted to the CU or the like to perform control such as reducing the engine speed.

【0126】次に、フローチャートについて説明する。 ステップS5−1 自車11及び他車31の現在位置を
表示装置27の画面に表示する。 ステップS5−2 自車11と他車31との接触を判断
して報知し、処理を終了する。
Next, the flowchart will be described. Step S5-1 The current positions of the own vehicle 11 and the other vehicle 31 are displayed on the screen of the display device 27. Step S5-2: The contact between the own vehicle 11 and the other vehicle 31 is judged and notified, and the processing is ended.

【0127】このように、本実施の形態において、位置
検出装置20は、他車31の受信したGPS情報、他車
31の各種車両状態情報及び走行軌跡等の情報、すなわ
ち、他車31の測位情報を他車31から受信するように
なっている。そして、前記位置検出装置20は、自車1
1の受信したGPS情報、自車11の各種車両状態情報
及び走行軌跡等の情報、すなわち、自車11の測位情報
と前記他車31の測位情報に基づいて、自車11の現在
位置、及び、他車31の現在位置を特定する。そのた
め、自車11と他車31との相対位置及び相対距離、す
なわち、相対位置関係46を正確に把握することができ
る。
As described above, in the present embodiment, the position detecting device 20 uses the GPS information received by the other vehicle 31, various vehicle state information of the other vehicle 31, information such as the traveling locus, that is, the positioning of the other vehicle 31. Information is received from the other vehicle 31. Then, the position detection device 20 is provided in the own vehicle 1
1 based on the received GPS information, information about various vehicle states of the own vehicle 11 and information about the traveling locus, that is, the positioning information of the own vehicle 11 and the positioning information of the other vehicle 31, and the current position of the own vehicle 11, and , The current position of the other vehicle 31 is specified. Therefore, the relative position and the relative distance between the own vehicle 11 and the other vehicle 31, that is, the relative positional relationship 46 can be accurately grasped.

【0128】例えば、他車31の位置検出装置が位置検
出装置20と相違する機種である場合、データ処理、演
算処理等の処理方法が相違することが多い。このような
場合に、他車31の位置検出装置が処理を実行して特定
した他車31の現在位置を受信し、該他車31の現在位
置に基づいて自車11と他車31との相対位置関係46
を算出した場合、算出された該相対位置関係46に誤差
が含まれてしまう。
For example, when the position detecting device of the other vehicle 31 is a model different from the position detecting device 20, the processing methods such as data processing and arithmetic processing often differ. In such a case, the position detection device of the other vehicle 31 executes the process to receive the current position of the other vehicle 31 specified, and based on the current position of the other vehicle 31, the own vehicle 11 and the other vehicle 31 Relative positional relationship 46
When calculating, the calculated relative positional relationship 46 includes an error.

【0129】しかし、本実施の形態においては、他車3
1の位置検出装置が処理を実行する前の情報、すなわ
ち、生データとしての他車31の測位情報を他車31か
ら受信し、該生データとしての他車31の測位情報に基
づいて、位置検出装置20が演算を実行し他車31の現
在位置を特定する。そのため、同一の処理方法によっ
て、自車11及び他車31の現在位置が特定されるの
で、自車11と他車31との相対位置関係46を正確に
把握することができる。
However, in this embodiment, the other vehicle 3
The position detection device of No. 1 receives information before executing the process, that is, the positioning information of the other vehicle 31 as raw data from the other vehicle 31, and determines the position based on the positioning information of the other vehicle 31 as the raw data. The detection device 20 executes calculation to identify the current position of the other vehicle 31. Therefore, since the current positions of the own vehicle 11 and the other vehicle 31 are specified by the same processing method, the relative positional relationship 46 between the own vehicle 11 and the other vehicle 31 can be accurately grasped.

【0130】また、本実施の形態におけるマップマッチ
ング処理においては、自車11及び他車31の現在位置
が、共通衛星から受信したGPS情報に基づいて特定さ
れた場合、自車11と他車31との相対位置及び相対距
離、すなわち、相対位置関係46を崩さないようにし
て、自車11及び他車31の現在位置を地図における道
路上にまで移動させるためのマップマッチング処理が実
行される。そのため、マップマッチング処理の精度が高
く、自車11及び他車31の現在位置が地図における道
路上に正確に位置する。
Further, in the map matching process of this embodiment, when the current positions of the own vehicle 11 and the other vehicle 31 are specified based on the GPS information received from the common satellite, the own vehicle 11 and the other vehicle 31. A map matching process for moving the current positions of the own vehicle 11 and the other vehicle 31 to the road on the map without disturbing the relative position and relative distance between the vehicle and the relative position 46 is executed. Therefore, the accuracy of the map matching process is high, and the current positions of the own vehicle 11 and the other vehicle 31 are accurately located on the road on the map.

【0131】さらに、本実施の形態においては、他車3
1のGPS情報が受信することができない場合には、他
車31の各種車両状態情報、他車31の走行軌跡等の情
報等の情報に基づいて、他車位置43を特定することが
できる。そのため、他車31が大きな建物の陰等のよう
に、GPS衛星41からのGPS情報を受信することが
できない状態にある時でも、自車11と他車31との相
対位置関係46を把握することができる。
Further, in this embodiment, the other vehicle 3
If the GPS information of No. 1 cannot be received, the other vehicle position 43 can be specified based on various vehicle state information of the other vehicle 31, information such as the traveling locus of the other vehicle 31, and the like. Therefore, even when the other vehicle 31 cannot receive the GPS information from the GPS satellite 41, such as in the shade of a large building, the relative positional relationship 46 between the own vehicle 11 and the other vehicle 31 is grasped. be able to.

【0132】さらに、自車11がGPS情報が受信する
ことができない場合、自車11の測位情報を送信するよ
うになっている。そのため、他車31において自車11
と他車31との相対位置関係46を把握することができ
る。
Further, when the own vehicle 11 cannot receive the GPS information, the positioning information of the own vehicle 11 is transmitted. Therefore, in the other vehicle 31, the own vehicle 11
It is possible to grasp the relative positional relationship 46 between the vehicle and the other vehicle 31.

【0133】なお、本発明は前記実施の形態に限定され
るものではなく、本発明の趣旨に基づいて種々変形させ
ることが可能であり、それらを本発明の範囲から排除す
るものではない。
The present invention is not limited to the above-mentioned embodiments, but can be variously modified within the scope of the present invention, and they are not excluded from the scope of the present invention.

【0134】[0134]

【発明の効果】以上詳細に説明したように、本発明によ
れば、位置検出装置においては、自車位置情報を作成す
る自車情報作成部と、他車が作成した他車位置情報を受
信する他車情報受信部と、地図を読み込む地図読込部
と、前記自車位置情報に含まれるGPS情報と他車位置
情報に含まれるGPS情報とに基づいて、自車と他車と
の相対位置関係を算出し、該相対位置関係を維持しなが
ら、自車位置及び他車位置を読み込んだ地図上に合致さ
せて特定する位置特定部とを有する。
As described above in detail, according to the present invention, in the position detecting device, the own vehicle information creating unit for creating the own vehicle position information and the other vehicle position information created by another vehicle are received. The other vehicle information receiving unit, the map reading unit that reads the map, and the relative position between the own vehicle and the other vehicle based on the GPS information included in the own vehicle position information and the GPS information included in the other vehicle position information. A position specifying unit that calculates the relationship and maintains the relative position relationship to match and specify the own vehicle position and the other vehicle position on the read map.

【0135】この場合、位置検出装置は、相対位置関係
と地図とに基づいて自車位置及び他車位置を特定するの
で、誤差が減少し、高い精度で自車位置及び他車位置を
特定することができる。また、他車から生のGPS情報
を受信し、同一の処理方法によって算出した自車と他車
の相対位置関係に基づいて自車位置及び他車位置を特定
するので、自車と他車との相対位置関係を高い精度で検
出することができる。
In this case, since the position detecting device specifies the own vehicle position and the other vehicle position based on the relative positional relationship and the map, the error is reduced and the own vehicle position and the other vehicle position are specified with high accuracy. be able to. Further, since the raw GPS information is received from the other vehicle and the own vehicle position and the other vehicle position are specified based on the relative positional relationship between the own vehicle and the other vehicle calculated by the same processing method, the own vehicle and the other vehicle are identified. It is possible to detect the relative positional relationship of the.

【0136】他の位置検出装置においては、さらに、前
記自車位置情報に含まれるGPS情報と他車位置情報に
含まれるGPS情報とは、共通の衛星からのGPS情報
である。
In another position detecting device, the GPS information included in the own vehicle position information and the GPS information included in the other vehicle position information are GPS information from a common satellite.

【0137】この場合、共通のGPS情報に基づいて自
車と他車の相対位置関係を特定するので、異なった衛星
からのGPS情報に基づいて自車と他車の相対位置関係
を特定する場合と比較して誤差が減少し、自車と他車と
の相対位置関係を極めて正確に把握することができる。
また、自車位置及び他車位置も高い精度で特定すること
ができる。
In this case, since the relative positional relationship between the own vehicle and the other vehicle is specified based on the common GPS information, when the relative positional relationship between the own vehicle and the other vehicle is specified based on the GPS information from different satellites. The error is reduced as compared with, and the relative positional relationship between the own vehicle and another vehicle can be grasped extremely accurately.
Further, the own vehicle position and the other vehicle position can also be specified with high accuracy.

【0138】更に他の位置検出装置においては、さら
に、前記自車位置情報は、ヨーレート情報、車速情報又
は走行軌跡情報に基づいて自車位置情報を作成する。
In still another position detecting device, the own vehicle position information is created based on the yaw rate information, the vehicle speed information or the traveling locus information.

【0139】この場合、ヨーレート情報、車速情報又は
走行軌跡情報に基づいて自車位置情報を作成するので、
自車位置の精度が向上する。
In this case, since the own vehicle position information is created based on the yaw rate information, the vehicle speed information or the traveling locus information,
The accuracy of the vehicle position is improved.

【0140】更に他の位置検出装置においては、さら
に、前記自車位置情報を他車に送信する自車情報送信部
を有する。
Still another position detecting device further includes a vehicle information transmitting section for transmitting the vehicle position information to another vehicle.

【0141】この場合、他車においても、自車と他車と
の相対位置関係を把握することができる。
In this case, also in the other vehicle, the relative positional relationship between the own vehicle and the other vehicle can be grasped.

【0142】更に他の位置検出装置においては、さら
に、前記位置特定部は、共通の衛星からのGPS情報に
基づいて、自車と他車との相対位置関係を算出し、ヨー
レート情報、車速情報又は走行軌跡情報に基づいて自車
位置及び他車位置を補正する。
In yet another position detecting device, the position specifying unit calculates the relative positional relationship between the own vehicle and another vehicle based on GPS information from a common satellite, and then yaw rate information and vehicle speed information. Alternatively, the own vehicle position and the other vehicle position are corrected based on the traveling locus information.

【0143】この場合、ヨーレート情報、車速情報又は
走行軌跡情報に基づいて自車位置及び他車位置を補正す
るので、自車位置及び他車位置を高い精度で特定するこ
とができる。
In this case, since the own vehicle position and the other vehicle position are corrected based on the yaw rate information, the vehicle speed information or the traveling locus information, the own vehicle position and the other vehicle position can be specified with high accuracy.

【0144】更に他の位置検出装置においては、さら
に、前記位置特定部は、前記自車位置及び他車位置がと
もに実際の道路上にあると判断した場合、前記自車と他
車との相対位置関係を維持しながら、前記自車位置が地
図上の道路上に合致するように前記自車位置及び他車位
置を補正し、該他車位置が地図上の道路上に合致するよ
うに前記自車位置及び他車位置を補正する。
In still another position detecting device, further, when the position specifying unit determines that both the own vehicle position and the other vehicle position are on an actual road, the relative position between the own vehicle and the other vehicle. While maintaining the positional relationship, the own vehicle position and the other vehicle position are corrected so that the own vehicle position matches the road on the map, and the other vehicle position is matched on the road on the map. Correct the own vehicle position and the other vehicle position.

【0145】この場合、自車位置及び他車位置を道路上
に特定することができ、自車位置及び他車位置の精度が
向上する。
In this case, the own vehicle position and the other vehicle position can be specified on the road, and the accuracy of the own vehicle position and the other vehicle position is improved.

【0146】更に他の位置検出装置においては、さら
に、前記位置特定部は、前記自車位置又は他車位置のい
ずれかが実際の道路上にあると判断した場合、前記自車
と他車との相対位置関係を維持しながら、前記自車位置
又は他車位置のいずれかを地図上の道路上に合致するよ
うに前記自車位置及び他車位置を補正する。
In still another position detecting device, when the position specifying unit determines that either the own vehicle position or the other vehicle position is on an actual road, the position identifying unit determines that the own vehicle and the other vehicle are The vehicle position and the other vehicle position are corrected so that either the own vehicle position or the other vehicle position matches the road on the map while maintaining the relative positional relationship.

【0147】この場合、自車位置又は他車位置を道路上
に特定することができ、自車位置及び他車位置の精度が
向上する。
In this case, the own vehicle position or the other vehicle position can be specified on the road, and the accuracy of the own vehicle position and the other vehicle position is improved.

【0148】更に他の位置検出装置においては、さら
に、前記位置特定部は、前記自車位置及び他車位置がと
もに実際の道路上になく、かつ、車速が所定値以上であ
ると判断した場合、地図上の前記自車位置があると判断
された地点のマッチング候補点を選択し、前記自車と他
車との相対位置関係を維持しながら、地図上のペナルテ
ィの最も小さいマッチング候補点に前記自車位置が合致
するように前記自車位置及び他車位置を補正する。
In still another position detecting device, further, when the position specifying unit determines that both the own vehicle position and the other vehicle position are not on the actual road and the vehicle speed is equal to or higher than a predetermined value. , Selecting a matching candidate point at a point determined to have the own vehicle position on the map, while maintaining the relative positional relationship between the own vehicle and another vehicle, to the matching candidate point with the smallest penalty on the map The own vehicle position and the other vehicle position are corrected so that the own vehicle position matches.

【0149】この場合、自車位置又は他車位置を道路上
に特定することができ、自車位置及び他車位置の精度が
向上する。
In this case, the own vehicle position or the other vehicle position can be specified on the road, and the accuracy of the own vehicle position and the other vehicle position is improved.

【0150】更に他の位置検出装置においては、さら
に、前記位置特定部は、前記自車位置及び他車位置がと
もに実際の道路上になく、かつ、車速が所定値以上でな
いと判断した場合、前記自車と他車との相対位置関係を
維持しながら、地図上の前記自車位置があると判断され
た地点に合致するように前記自車位置及び他車位置を補
正する。
In still another position detecting device, further, when the position specifying unit determines that both the own vehicle position and the other vehicle position are not on the actual road and the vehicle speed is not higher than a predetermined value, While maintaining the relative positional relationship between the own vehicle and the other vehicle, the own vehicle position and the other vehicle position are corrected so as to match the point on the map where the own vehicle position is determined to be.

【0151】この場合、自車位置及び他車位置が道路上
になくても、自車位置及び他車位置を特定することがで
きる。
In this case, the own vehicle position and the other vehicle position can be specified even if the own vehicle position and the other vehicle position are not on the road.

【0152】更に他の位置検出装置においては、さら
に、前記位置特定部が特定した自車位置及び他車位置を
画像又は音によって報知する報知部を有する。
The still another position detecting device further includes a notifying unit for notifying the position of the own vehicle and the position of the other vehicle specified by the position specifying unit by an image or a sound.

【0153】この場合、運転者は、他車と接近し過ぎな
いように適切な措置を取ることができる。
In this case, the driver can take appropriate measures so as not to get too close to the other vehicle.

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

【図1】本発明の実施の形態における位置検出装置の構
成を機能の観点から示すブロック図である。
FIG. 1 is a block diagram showing a configuration of a position detection device according to an embodiment of the present invention in terms of functions.

【図2】本発明の実施の形態における位置検出装置の詳
細な構成を示す図である。
FIG. 2 is a diagram showing a detailed configuration of a position detection device according to an embodiment of the present invention.

【図3】本発明の実施の形態における位置検出装置の動
作の概略を示す第1の図である。
FIG. 3 is a first diagram showing an outline of an operation of the position detection device in the embodiment of the present invention.

【図4】本発明の実施の形態における位置検出装置の動
作の概略を示す第2の図である。
FIG. 4 is a second diagram showing an outline of the operation of the position detection device in the embodiment of the present invention.

【図5】本発明の実施の形態における位置検出装置の動
作を示すフローチャートである。
FIG. 5 is a flowchart showing an operation of the position detection device in the embodiment of the present invention.

【図6】本発明の実施の形態における自車位置特定処理
及び車両情報送受信処理の動作を示すフローチャートで
ある。
FIG. 6 is a flowchart showing operations of own vehicle position identification processing and vehicle information transmission / reception processing in the embodiment of the present invention.

【図7】本発明の実施の形態におけるヨーレイトに基づ
いて自車位置を更新する方法を示す図である。
FIG. 7 is a diagram showing a method for updating the vehicle position based on the yaw rate according to the embodiment of the present invention.

【図8】本発明の実施の形態における車両状態情報に基
づく位置特定処理の動作を示すフローチャートである。
FIG. 8 is a flowchart showing an operation of position specifying processing based on vehicle state information in the embodiment of the present invention.

【図9】本発明の実施の形態における車両状態情報に基
づく他車位置特定演算処理の概略を示す図である。
FIG. 9 is a diagram showing an outline of another vehicle position identification calculation processing based on vehicle state information in the embodiment of the present invention.

【図10】本発明の実施の形態における相対位置演算処
理の動作を示すフローチャートである。
FIG. 10 is a flowchart showing an operation of relative position calculation processing in the embodiment of the present invention.

【図11】本発明の実施の形態における第1の他車相対
位置演算処理の動作を示すフローチャートである。
FIG. 11 is a flowchart showing an operation of a first other vehicle relative position calculation processing in the embodiment of the present invention.

【図12】本発明の実施の形態における第2の他車相対
位置演算処理の動作を示すフローチャートである。
FIG. 12 is a flowchart showing an operation of a second other vehicle relative position calculation processing in the embodiment of the present invention.

【図13】本発明の実施の形態におけるマップマッチン
グ処理の動作の概略を示す図である。
FIG. 13 is a diagram showing an outline of an operation of map matching processing in the embodiment of the present invention.

【図14】本発明の実施の形態における第1の自他車位
置補正処理の動作を示す図である。
FIG. 14 is a diagram showing an operation of a first own / other vehicle position correction process in the embodiment of the present invention.

【図15】本発明の実施の形態における第2の自他車位
置補正処理の動作を示す図である。
FIG. 15 is a diagram showing an operation of a second own-other vehicle position correction process in the embodiment of the present invention.

【図16】本発明の実施の形態における第4の自他車位
置補正処理の動作を示す図である。
FIG. 16 is a diagram showing an operation of a fourth own vehicle / other vehicle position correction process in the embodiment of the present invention.

【図17】本発明の実施の形態におけるマップマッチン
グ処理の動作を示すフローチャートである。
FIG. 17 is a flowchart showing an operation of map matching processing in the embodiment of the present invention.

【図18】本発明の実施の形態における第1の自他車位
置補正処理の動作を示すフローチャートである。
FIG. 18 is a flowchart showing an operation of a first own / other vehicle position correction process in the embodiment of the present invention.

【図19】本発明の実施の形態における自他車道路照合
処理の動作を示すフローチャートである。
FIG. 19 is a flowchart showing an operation of own vehicle / other vehicle road matching processing in the embodiment of the present invention.

【図20】本発明の実施の形態における第2の自他車位
置補正処理の動作を示すフローチャートである。
FIG. 20 is a flowchart showing an operation of a second own-other-vehicle position correction process according to the embodiment of the present invention.

【図21】本発明の実施の形態における第3の自他車位
置補正処理の動作を示すフローチャートである。
FIG. 21 is a flowchart showing an operation of a third own vehicle / other vehicle position correction process in the embodiment of the present invention.

【図22】本発明の実施の形態における第4の自他車位
置補正処理の動作を示すフローチャートである。
FIG. 22 is a flowchart showing an operation of a fourth own vehicle / other vehicle position correction process in the embodiment of the present invention.

【図23】本発明の実施の形態における第5の自他車位
置補正処理の動作を示すフローチャートである。
FIG. 23 is a flowchart showing an operation of a fifth own vehicle / other vehicle position correction process in the embodiment of the present invention.

【図24】本発明の実施の形態における第6の自他車位
置補正処理の動作を示すフローチャートである。
FIG. 24 is a flowchart showing an operation of a sixth own-other vehicle position correction process according to the embodiment of the present invention.

【図25】本発明の実施の形態における報知処理の動作
を示すフローチャートである。
FIG. 25 is a flowchart showing an operation of a notification process in the embodiment of the present invention.

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

11 自車 12 自車情報作成部 13 他車情報受信部 14 位置特定部 15 報知部 16 自車情報送信部 20 位置検出部 21 ナビ制御装置 22 位置検出制御装置 23 信号発信装置 24 GPS受信装置 25 信号受信装置 26 警報装置 27 表示装置 28 センサ情報受信装置 31 他車 34 走行軌跡 42、42b 自車位置 43、43b 他車位置 46 相対位置関係 11 own vehicle 12 Vehicle information creation section 13 Other vehicle information receiver 14 Position identification unit 15 Notification section 16 Own vehicle information transmitter 20 Position detector 21 Navigation controller 22 Position detection control device 23 Signal transmitter 24 GPS receiver 25 signal receiver 26 Alarm device 27 Display 28 Sensor information receiving device 31 Other vehicle 34 Running track 42, 42b Own vehicle position 43, 43b Other vehicle position 46 Relative positional relationship

フロントページの続き Fターム(参考) 2F029 AA02 AB01 AB07 AC02 AC14 AD01 5H180 AA01 BB04 BB05 FF04 FF05 FF22 FF25 FF27 FF32 FF37 5J062 AA05 AA07 BB01 CC07 HH05Continued front page    F-term (reference) 2F029 AA02 AB01 AB07 AC02 AC14                       AD01                 5H180 AA01 BB04 BB05 FF04 FF05                       FF22 FF25 FF27 FF32 FF37                 5J062 AA05 AA07 BB01 CC07 HH05

Claims (12)

【特許請求の範囲】[Claims] 【請求項1】 (a)自車位置情報を作成する自車情報
作成部と、(b)他車が作成した他車位置情報を受信す
る他車情報受信部と、(c)地図を読み込む地図読込部
と、(d)前記自車位置情報に含まれるGPS情報と他
車位置情報に含まれるGPS情報とに基づいて、自車と
他車との相対位置関係を算出し、該相対位置関係を維持
しながら、自車位置及び他車位置を読み込んだ地図上に
合致させて特定する位置特定部とを有することを特徴と
する位置検出装置。
1. A vehicle information creation unit for creating (a) own vehicle position information, (b) another vehicle information receiving unit for receiving other vehicle position information created by another vehicle, and (c) reading a map. A relative position relationship between the own vehicle and another vehicle is calculated based on the map reading unit and (d) GPS information included in the own vehicle position information and GPS information included in the other vehicle position information, and the relative position is calculated. A position detecting device comprising: a position specifying unit that matches and specifies the own vehicle position and the other vehicle position on a map that has been read while maintaining the relationship.
【請求項2】 前記自車位置情報に含まれるGPS情報
と他車位置情報に含まれるGPS情報とは、共通の衛星
からのGPS情報である請求項1に記載の位置検出装
置。
2. The position detecting device according to claim 1, wherein the GPS information included in the own vehicle position information and the GPS information included in the other vehicle position information are GPS information from a common satellite.
【請求項3】 前記自車位置情報は、ヨーレート情報、
車速情報又は走行軌跡情報に基づいて自車位置情報を作
成する請求項1又は2に記載の位置検出装置。
3. The vehicle position information is yaw rate information,
The position detection device according to claim 1 or 2, wherein the vehicle position information is created based on the vehicle speed information or the traveling locus information.
【請求項4】 前記自車位置情報を他車に送信する自車
情報送信部を有する請求項1〜3のいずれか1項に記載
の位置検出装置。
4. The position detection device according to claim 1, further comprising a vehicle information transmission unit that transmits the vehicle position information to another vehicle.
【請求項5】 前記位置特定部は、共通の衛星からのG
PS情報に基づいて、自車と他車との相対位置関係を算
出し、ヨーレート情報、車速情報又は走行軌跡情報に基
づいて自車位置及び他車位置を補正する請求項1〜4の
いずれか1項に記載の位置検出装置。
5. The position specifying unit uses a G from a common satellite.
5. The relative positional relationship between the own vehicle and the other vehicle is calculated based on the PS information, and the own vehicle position and the other vehicle position are corrected based on the yaw rate information, the vehicle speed information or the traveling locus information. The position detection device according to item 1.
【請求項6】 前記位置特定部は、前記自車位置及び他
車位置がともに実際の道路上にあると判断した場合、前
記自車と他車との相対位置関係を維持しながら、前記自
車位置が地図上の道路上に合致するように前記自車位置
及び他車位置を補正し、該他車位置が地図上の道路上に
合致するように前記自車位置及び他車位置を補正する請
求項1〜5のいずれか1項に記載の位置検出装置。
6. The position specifying unit, when determining that both the own vehicle position and the other vehicle position are on an actual road, maintains the relative positional relationship between the own vehicle and the other vehicle while maintaining the relative position relationship between the own vehicle and the other vehicle. Correcting the own vehicle position and the other vehicle position so that the vehicle position matches the road on the map, and correcting the own vehicle position and the other vehicle position so that the other vehicle position matches the road on the map The position detecting device according to any one of claims 1 to 5.
【請求項7】 前記位置特定部は、前記自車位置又は他
車位置のいずれかが実際の道路上にあると判断した場
合、前記自車と他車との相対位置関係を維持しながら、
前記自車位置又は他車位置のいずれかを地図上の道路上
に合致するように前記自車位置及び他車位置を補正する
請求項1〜5のいずれか1項に記載の位置検出装置。
7. The position specifying unit maintains the relative positional relationship between the own vehicle and the other vehicle when determining that either the own vehicle position or the other vehicle position is on an actual road,
The position detection device according to any one of claims 1 to 5, wherein the own vehicle position and the other vehicle position are corrected so that either the own vehicle position or the other vehicle position matches the road on the map.
【請求項8】 前記位置特定部は、前記自車位置及び他
車位置がともに実際の道路上になく、かつ、車速が所定
値以上であると判断した場合、地図上の前記自車位置が
あると判断された地点のマッチング候補点を選択し、前
記自車と他車との相対位置関係を維持しながら、地図上
のペナルティの最も小さいマッチング候補点に前記自車
位置が合致するように前記自車位置及び他車位置を補正
する請求項1〜5のいずれか1項に記載の位置検出装
置。
8. The position specifying unit determines that the own vehicle position on the map is determined when the own vehicle position and the other vehicle position are not on the actual road and the vehicle speed is equal to or higher than a predetermined value. Select a matching candidate point of a point determined to be, so that the own vehicle position matches the matching candidate point with the smallest penalty on the map while maintaining the relative positional relationship between the own vehicle and another vehicle. The position detecting device according to claim 1, wherein the position of the own vehicle and the position of the other vehicle are corrected.
【請求項9】 前記位置特定部は、前記自車位置及び他
車位置がともに実際の道路上になく、かつ、車速が所定
値以上でないと判断した場合、前記自車と他車との相対
位置関係を維持しながら、地図上の前記自車位置がある
と判断された地点に合致するように前記自車位置及び他
車位置を補正する請求項1〜5のいずれか1項に記載の
位置検出装置。
9. The relative position between the own vehicle and another vehicle when the position specifying unit determines that both the own vehicle position and the other vehicle position are not on an actual road and the vehicle speed is not higher than a predetermined value. The said vehicle position and other vehicle position are correct | amended so that it may match with the point judged that the said vehicle position exists on a map, maintaining a positional relationship. Position detection device.
【請求項10】 前記位置特定部が特定した自車位置及
び他車位置を画像又は音によって報知する報知部を有す
る請求項1〜9のいずれか1項に記載の位置検出装置。
10. The position detecting device according to claim 1, further comprising a notification unit that notifies the position of the own vehicle and the position of the other vehicle specified by the position specifying unit by an image or a sound.
【請求項11】 (a)自車位置情報を作成し、(b)
他車が作成した他車位置情報を受信し、(c)地図を読
み込み、(d)前記自車位置情報に含まれるGPS情報
と前記他車位置情報に含まれるGPS情報とに基づい
て、自車と他車との相対位置関係を算出し、該相対位置
関係を維持しながら、読み込んだ地図上に自車位置及び
他車位置を合致させて、該自車位置及び他車位置を特定
することを特徴とする位置検出方法。
11. (a) Creating vehicle position information, (b)
The other vehicle position information created by the other vehicle is received, (c) the map is read, and (d) the own vehicle position information is acquired based on the GPS information included in the own vehicle position information and the GPS information included in the other vehicle position information. The relative positional relationship between the vehicle and the other vehicle is calculated, and while maintaining the relative positional relationship, the own vehicle position and the other vehicle position are matched on the read map, and the own vehicle position and the other vehicle position are specified. A position detection method characterized by the above.
【請求項12】 (a)コンピュータを、(b)自車位
置情報を作成する自車情報作成部、(c)他車が作成し
た他車位置情報を受信する他車情報受信部、(d)地図
を読み込む地図読込部、並びに、(e)前記自車位置情
報に含まれるGPS情報と他車位置情報に含まれるGP
S情報とに基づいて、自車と他車との相対位置関係を算
出し、該相対位置関係を維持しながら、自車位置及び他
車位置を読み込んだ地図上に合致させて特定する位置特
定部として機能させることを特徴とする位置検出プログ
ラム。
12. An (a) computer, (b) own vehicle information creating section for creating own vehicle position information, (c) other vehicle information receiving section for receiving other vehicle position information created by another vehicle, and (d) ) A map reading unit for reading a map, and (e) a GPS included in the own vehicle position information and a GP included in the other vehicle position information
A position specification in which the relative positional relationship between the own vehicle and another vehicle is calculated based on the S information, and while maintaining the relative positional relationship, the own vehicle position and the other vehicle position are matched and specified on the read map. A position detection program characterized by causing it to function as a unit.
JP2002142595A 2002-05-17 2002-05-17 Position detection device Expired - Fee Related JP3932975B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2002142595A JP3932975B2 (en) 2002-05-17 2002-05-17 Position detection device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2002142595A JP3932975B2 (en) 2002-05-17 2002-05-17 Position detection device

Publications (2)

Publication Number Publication Date
JP2003337029A true JP2003337029A (en) 2003-11-28
JP3932975B2 JP3932975B2 (en) 2007-06-20

Family

ID=29702840

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2002142595A Expired - Fee Related JP3932975B2 (en) 2002-05-17 2002-05-17 Position detection device

Country Status (1)

Country Link
JP (1) JP3932975B2 (en)

Cited By (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005352608A (en) * 2004-06-08 2005-12-22 Mazda Motor Corp Warning system and moving body terminal
JP2005352610A (en) * 2004-06-08 2005-12-22 Mazda Motor Corp Warning system and moving body terminal
JP2005352609A (en) * 2004-06-08 2005-12-22 Mazda Motor Corp Warning system and moving body terminal
JP2007085909A (en) * 2005-09-22 2007-04-05 Nissan Motor Co Ltd Device for detecting position of other vehicle
JP2007094698A (en) * 2005-09-28 2007-04-12 Nissan Motor Co Ltd Other vehicle location detection device
JP2008185454A (en) * 2007-01-30 2008-08-14 Xanavi Informatics Corp On-board electronic device and vehicle control system
JP2009145167A (en) * 2007-12-13 2009-07-02 Toyota Central R&D Labs Inc Position estimating apparatus and position estimating system
JP2009264844A (en) * 2008-04-23 2009-11-12 Toyota Motor Corp Relative position detection apparatus and relative position detection system
JP2010102455A (en) * 2008-10-22 2010-05-06 Tokai Rika Co Ltd Vehicle position calculation system
US20110046882A1 (en) * 2008-02-04 2011-02-24 Thomas Heger Device and method for determining the position of another road user
EP2363731A1 (en) 2010-02-25 2011-09-07 Hitachi Ltd. Location estimation system
JP2012103898A (en) * 2010-11-10 2012-05-31 Sanyo Electric Co Ltd Mobile communication device
US8204642B2 (en) 2007-11-13 2012-06-19 Denso Corporation Driving assistance apparatus
DE112009004902T5 (en) 2009-06-11 2012-06-21 Toyota Jidosha Kabushiki Kaisha A method for determining a vehicle traveling position and vehicle traveling position determining device
JP2012181727A (en) * 2011-03-02 2012-09-20 Nec Corp Position measurement system, error correction device, control method, and program
KR101231534B1 (en) 2011-10-17 2013-02-07 현대자동차주식회사 A method and system to improve accuracy in differential global positioning system using vehicle to vehicle
US8676486B2 (en) 2009-07-27 2014-03-18 Toyota Jidosha Kabushiki Kaisha Vehicular information processing device
US9020746B2 (en) 2009-02-25 2015-04-28 Toyota Jidosha Kabushiki Kaisha Vehicle-mounted information processing apparatus and information processing method
JP2018077860A (en) * 2017-11-28 2018-05-17 パイオニア株式会社 Navigation device, navigation method, and navigation program
KR20180099215A (en) * 2017-02-28 2018-09-05 현대자동차주식회사 Apparatus and method for estimating location of vehicle and vehicle using the same
CN112346103A (en) * 2020-10-29 2021-02-09 清华大学 V2X-based intelligent networking automobile dynamic co-location method and device

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0843517A (en) * 1994-07-26 1996-02-16 Oki Electric Ind Co Ltd Vehicle-mounted navigation system
JPH0943336A (en) * 1995-07-27 1997-02-14 Mitsubishi Motors Corp Relative position measuring method
JPH10122895A (en) * 1996-08-29 1998-05-15 Makoto Toyama Searching device
JPH10148665A (en) * 1996-11-19 1998-06-02 Matsushita Electric Ind Co Ltd System for calculating relative position through inter-vehicle communications
JP2000035337A (en) * 1998-07-17 2000-02-02 Sanyo Electric Co Ltd Navigation apparatus

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0843517A (en) * 1994-07-26 1996-02-16 Oki Electric Ind Co Ltd Vehicle-mounted navigation system
JPH0943336A (en) * 1995-07-27 1997-02-14 Mitsubishi Motors Corp Relative position measuring method
JPH10122895A (en) * 1996-08-29 1998-05-15 Makoto Toyama Searching device
JPH10148665A (en) * 1996-11-19 1998-06-02 Matsushita Electric Ind Co Ltd System for calculating relative position through inter-vehicle communications
JP2000035337A (en) * 1998-07-17 2000-02-02 Sanyo Electric Co Ltd Navigation apparatus

Cited By (31)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005352608A (en) * 2004-06-08 2005-12-22 Mazda Motor Corp Warning system and moving body terminal
JP2005352610A (en) * 2004-06-08 2005-12-22 Mazda Motor Corp Warning system and moving body terminal
JP2005352609A (en) * 2004-06-08 2005-12-22 Mazda Motor Corp Warning system and moving body terminal
JP4596309B2 (en) * 2004-06-08 2010-12-08 マツダ株式会社 Alarm system and mobile terminal
JP4596359B2 (en) * 2004-06-08 2010-12-08 マツダ株式会社 Alarm system and mobile terminal
JP4517344B2 (en) * 2004-06-08 2010-08-04 マツダ株式会社 Alarm system and mobile terminal
JP2007085909A (en) * 2005-09-22 2007-04-05 Nissan Motor Co Ltd Device for detecting position of other vehicle
JP2007094698A (en) * 2005-09-28 2007-04-12 Nissan Motor Co Ltd Other vehicle location detection device
JP2008185454A (en) * 2007-01-30 2008-08-14 Xanavi Informatics Corp On-board electronic device and vehicle control system
US8204642B2 (en) 2007-11-13 2012-06-19 Denso Corporation Driving assistance apparatus
JP2009145167A (en) * 2007-12-13 2009-07-02 Toyota Central R&D Labs Inc Position estimating apparatus and position estimating system
US8612150B2 (en) * 2008-02-04 2013-12-17 Robert Bosch Gmbh Device and method for determining the position of another road user
US20110046882A1 (en) * 2008-02-04 2011-02-24 Thomas Heger Device and method for determining the position of another road user
JP2009264844A (en) * 2008-04-23 2009-11-12 Toyota Motor Corp Relative position detection apparatus and relative position detection system
JP2010102455A (en) * 2008-10-22 2010-05-06 Tokai Rika Co Ltd Vehicle position calculation system
US9020746B2 (en) 2009-02-25 2015-04-28 Toyota Jidosha Kabushiki Kaisha Vehicle-mounted information processing apparatus and information processing method
DE112009004902T5 (en) 2009-06-11 2012-06-21 Toyota Jidosha Kabushiki Kaisha A method for determining a vehicle traveling position and vehicle traveling position determining device
DE112009004902B4 (en) * 2009-06-11 2016-10-20 Toyota Jidosha Kabushiki Kaisha A method for determining a vehicle traveling position and vehicle traveling position determining device
US8510027B2 (en) 2009-06-11 2013-08-13 Toyota Jidosha Kabushiki Kaisha Method for judging vehicle traveling position and vehicle traveling position judgment device
US8676486B2 (en) 2009-07-27 2014-03-18 Toyota Jidosha Kabushiki Kaisha Vehicular information processing device
EP2363731A1 (en) 2010-02-25 2011-09-07 Hitachi Ltd. Location estimation system
US8260325B2 (en) 2010-02-25 2012-09-04 Hitachi, Ltd. Location estimation system
JP2012103898A (en) * 2010-11-10 2012-05-31 Sanyo Electric Co Ltd Mobile communication device
JP2012181727A (en) * 2011-03-02 2012-09-20 Nec Corp Position measurement system, error correction device, control method, and program
KR101231534B1 (en) 2011-10-17 2013-02-07 현대자동차주식회사 A method and system to improve accuracy in differential global positioning system using vehicle to vehicle
KR20180099215A (en) * 2017-02-28 2018-09-05 현대자동차주식회사 Apparatus and method for estimating location of vehicle and vehicle using the same
CN108508883A (en) * 2017-02-28 2018-09-07 现代自动车株式会社 Vehicle location estimates device and method and uses its vehicle
KR102215325B1 (en) 2017-02-28 2021-02-15 현대자동차주식회사 Apparatus and method for estimating location of vehicle and vehicle using the same
CN108508883B (en) * 2017-02-28 2022-03-29 现代自动车株式会社 Vehicle position estimation apparatus and method, and vehicle using the same
JP2018077860A (en) * 2017-11-28 2018-05-17 パイオニア株式会社 Navigation device, navigation method, and navigation program
CN112346103A (en) * 2020-10-29 2021-02-09 清华大学 V2X-based intelligent networking automobile dynamic co-location method and device

Also Published As

Publication number Publication date
JP3932975B2 (en) 2007-06-20

Similar Documents

Publication Publication Date Title
JP2003337029A (en) Position detecting device
CN1288424C (en) Vehicle navigation system for priority of auto-running road
US7899589B2 (en) Control information storage apparatus and program for same
EP0836074B1 (en) Route guidance system and method for use in vehicle navigation
EP1995557B1 (en) Position registration device, route search device, position registration method, position registration program, and recording medium
CN107826104A (en) The method for the information being intended to for the predicted travel provided on means of transport
JP2005172578A (en) Navigation system
JP2008123443A (en) Driving support apparatus
JP2010210435A (en) Method of detecting reverse running in navigation apparatus
EP1804024B1 (en) Route search device and navigation device
JP2007034646A (en) Safe traveling supporting system
US10989558B2 (en) Route guidance method and route guidance device
JP2003227867A (en) Position detector
JP2544855B2 (en) Vehicle guidance device
JP2001195693A (en) Vehicle information transmitting device and traffic control system
JP5276922B2 (en) Current position calculation device
JP2007322312A (en) Navigation system
JP2013167452A (en) Navigation system
JPH09297035A (en) Intersection guiding device
JP6244610B2 (en) Navigation system
US20090105936A1 (en) Route guidance apparatus, route guidance method, route guidance program and computer-readable recording medium
JP2001133277A (en) Navigation device
CN115943289A (en) Driving support device and computer program
JP2004045340A (en) Road information estimation device
JP4702221B2 (en) Navigation device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20050422

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20070213

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20070227

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20070312

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100330

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110330

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110330

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120330

Year of fee payment: 5

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20140330

Year of fee payment: 7

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20150330

Year of fee payment: 8

LAPS Cancellation because of no payment of annual fees