JP5430512B2 - MOBILE POSITION DETECTING DEVICE, IN-VEHICLE SAFETY CONTROL DEVICE, AND MOBILE POSITION DETECTING METHOD - Google Patents

MOBILE POSITION DETECTING DEVICE, IN-VEHICLE SAFETY CONTROL DEVICE, AND MOBILE POSITION DETECTING METHOD Download PDF

Info

Publication number
JP5430512B2
JP5430512B2 JP2010164766A JP2010164766A JP5430512B2 JP 5430512 B2 JP5430512 B2 JP 5430512B2 JP 2010164766 A JP2010164766 A JP 2010164766A JP 2010164766 A JP2010164766 A JP 2010164766A JP 5430512 B2 JP5430512 B2 JP 5430512B2
Authority
JP
Japan
Prior art keywords
moving body
information
detection target
body position
detection
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
JP2010164766A
Other languages
Japanese (ja)
Other versions
JP2012027642A (en
Inventor
雄治 五十嵐
隆史 玉田
雅彦 伊川
茂樹 森田
崇 前田
永 菅原
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Priority to JP2010164766A priority Critical patent/JP5430512B2/en
Publication of JP2012027642A publication Critical patent/JP2012027642A/en
Application granted granted Critical
Publication of JP5430512B2 publication Critical patent/JP5430512B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Description

本発明は、路側に設置された路側無線装置から配信される情報を用いて、移動体の位置を検出する移動体位置検出装置、車載安全制御装置、及び、移動体位置検出方法に関するものである。   The present invention relates to a mobile body position detection device, an in-vehicle safety control device, and a mobile body position detection method that detect the position of a mobile body using information distributed from a roadside wireless device installed on the roadside. .

近年、車両(移動体)と衝突可能性の高い他の車両が存在する場合にドライバーに警告等を用いて注意喚起することで、交通事故の発生を抑制することを可能にする技術が提案されている。   In recent years, there has been proposed a technology that can suppress the occurrence of traffic accidents by alerting the driver using a warning or the like when there is another vehicle that is highly likely to collide with the vehicle (moving body). ing.

このような技術として、例えば、GPS衛星を用いて、車両(第1車両)、及び、その他の車両(第2車両)のそれぞれについて現在のGPS位置情報を検出し、これらGPS位置情報から第1車両から見た第2車両の相対距離を求め、当該相対距離に基づいて衝突危険性を判定することが提案されている。しかし、この技術では、第2車両が、第1車両と衝突しない経路を走行している場合であっても、相対距離が短いと警告してしまうという問題がある。また、道路網を考慮して、第1車両と第2車両との間の道のり上の相対距離を取得しようとすると、地図情報などを併用し、どの道路の、どの位置にこれらの車両が存在するかを解析しなければならず、処理が複雑化する。   As such a technique, for example, using GPS satellites, current GPS position information is detected for each of the vehicle (first vehicle) and the other vehicles (second vehicle), and the first GPS position information is used to detect the first GPS position information. It has been proposed to determine the relative distance of the second vehicle viewed from the vehicle and determine the collision risk based on the relative distance. However, with this technology, there is a problem that even if the second vehicle is traveling on a route that does not collide with the first vehicle, a warning is given if the relative distance is short. In addition, considering the road network, when trying to obtain the relative distance on the road between the first vehicle and the second vehicle, the map information is used together, and these vehicles exist in which road on which position. It is necessary to analyze whether to do so, and the processing becomes complicated.

そこで、第1車両が、路側に設置された路側無線装置から配信される第2車両の原点からの位置情報(移動体位置情報)を受信して、その移動体位置情報と、第1車両の原点からの位置情報とに基づいて衝突危険性を判定する技術が提案されている。ただし、この技術では、特許文献1に開示されている技術などにより、第1車両の原点からの位置情報を検出することが必要となる。   Therefore, the first vehicle receives position information (moving body position information) from the origin of the second vehicle distributed from the roadside wireless device installed on the roadside, and the moving body position information and the first vehicle A technique for determining a collision risk based on position information from the origin has been proposed. However, in this technique, it is necessary to detect position information from the origin of the first vehicle by the technique disclosed in Patent Document 1.

特許文献1に開示の技術では、光ビーコン路側無線装置などの近赤外線通信装置が車線ごとに設置されており、光ビーコン路側無線装置と通信可能な光ビーコン通信装置が車両に搭載されている。そして、車両側の光ビーコン通信装置が、光ビーコン路側無線装置と通信開始した時点から現時点までの経過時間と、速度ベクトルとを用いて、道程距離を算出し、光ビーコン路側無線装置の設置位置(原点)から、道程距離だけ進んだ位置を当該車両の現在位置として検出している。   In the technique disclosed in Patent Literature 1, a near infrared communication device such as an optical beacon roadside wireless device is installed for each lane, and an optical beacon communication device capable of communicating with the optical beacon roadside wireless device is mounted on the vehicle. Then, the vehicle-side optical beacon communication device calculates the journey distance using the elapsed time from the time when the communication starts with the optical beacon roadside wireless device to the current time, and the speed vector, and the installation position of the optical beacon roadside wireless device A position advanced from the (origin) by a distance is detected as the current position of the vehicle.

特開2008−181207号公報JP 2008-181207 A

上記特許文献1に開示の技術においては、光ビーコン路側無線装置と光ビーコン通信装置との間における通信として、通信範囲が3〜5メートル、つまり、車両1台分の全長程度と比較的狭い通信が用いられている。しかし、特許文献1に記載の技術において、他の通信媒体、例えば、数十〜数百メートルの比較的広い通信範囲を持つDSRC(Dedicated Short Range Communication)や700MHz帯の電波による通信を用いると、車両の位置検出の精度が低くなってしまうという問題があった。   In the technique disclosed in Patent Document 1, communication between the optical beacon roadside wireless device and the optical beacon communication device is a communication with a relatively narrow communication range of 3 to 5 meters, that is, the entire length of one vehicle. Is used. However, in the technique described in Patent Document 1, using other communication media such as DSRC (Dedicated Short Range Communication) having a relatively wide communication range of several tens to several hundreds of meters or communication using a 700 MHz band radio wave, There has been a problem that the accuracy of vehicle position detection becomes low.

そこで、本発明は、上記のような問題点を鑑みてなされたものであり、比較的広範囲の通信範囲を持つ通信を用いて、移動体の現在位置を検出することが可能な技術を提供することを目的とする。   Therefore, the present invention has been made in view of the above-described problems, and provides a technique capable of detecting the current position of a moving body using communication having a relatively wide communication range. For the purpose.

本発明に係る移動体位置検出装置は、移動体に搭載される移動体位置検出装置であって、路側無線装置から配信された、移動体の位置を示すための原点及び座標軸からなる座標系を特定する移動体位置座標情報と、前記移動体検出装置が搭載された検出対象移動体の複数の移動体位置履歴情報とに基づいて、前記検出対象移動体の前記座標系における現在位置を検出する移動体位置検出手段を備える。前記移動体位置履歴情報は、前記検出対象移動体の過去のGPS位置情報と、当該GPS位置情報に対応付けられた累積走行距離とを含み、前記移動体位置検出手段は、前記複数の移動体位置履歴情報のうち、前記移動体位置座標情報により特定される前記原点の位置に最も近い前記GPS位置情報を含む移動体位置履歴情報を検索し、検索された当該移動体位置履歴情報の前記累積走行距離と現在の累積走行距離の差だけ前記原点から前記座標軸の方向に進んだ位置を、前記検出対象移動体の前記座標系における現在位置として検出する。   A mobile body position detection device according to the present invention is a mobile body position detection device mounted on a mobile body, and has a coordinate system composed of an origin and a coordinate axis for indicating the position of the mobile body distributed from a roadside wireless device. Based on the moving body position coordinate information to be identified and a plurality of moving body position history information of the detection target moving body on which the moving body detection device is mounted, the current position in the coordinate system of the detection target moving body is detected. A moving body position detecting means is provided. The moving body position history information includes past GPS position information of the detection target moving body and an accumulated travel distance associated with the GPS position information, and the moving body position detecting means includes the plurality of moving bodies. Among the position history information, the mobile body position history information including the GPS position information closest to the position of the origin specified by the mobile body position coordinate information is searched, and the accumulation of the searched mobile body position history information is performed. A position advanced in the direction of the coordinate axis from the origin by the difference between the travel distance and the current cumulative travel distance is detected as the current position in the coordinate system of the detection target moving body.

本発明によれば、路側無線装置からの移動体位置座標情報と、複数の移動体位置履歴情報とに基づいて、検出対象移動体の座標系における現在位置を検出する。この検出において、路側無線装置の通信範囲の大きさはほとんど影響しないことから、検出対象移動体の現在位置を検出する際に、比較的広い通信範囲を持つ通信を用いることができる。また、現在位置は、移動体位置履歴情報の累積走行距離と現在の累積走行距離との差であることから、その算出が簡素化されるとともに、現在位置を精度よく検出することができる。   According to the present invention, the current position in the coordinate system of the detection target moving body is detected based on the moving body position coordinate information from the roadside apparatus and the plurality of moving body position history information. In this detection, since the size of the communication range of the roadside apparatus is hardly affected, communication having a relatively wide communication range can be used when detecting the current position of the detection target moving body. In addition, since the current position is the difference between the cumulative travel distance of the moving body position history information and the current cumulative travel distance, the calculation is simplified and the current position can be detected with high accuracy.

実施の形態1に係る安全運転支援システムの構成を示す図である。It is a figure which shows the structure of the safe driving assistance system which concerns on Embodiment 1. FIG. 実施の形態1に係る安全運転支援システムの適用例を示す図である。It is a figure which shows the example of application of the safe driving assistance system which concerns on Embodiment 1. FIG. 実施の形態1に係る車載安全制御装置の構成を示すブロック図である。1 is a block diagram illustrating a configuration of an in-vehicle safety control device according to a first embodiment. 実施の形態1に係る車載安全制御装置の動作を示す図である。It is a figure which shows operation | movement of the vehicle-mounted safety control apparatus which concerns on Embodiment 1. FIG. 実施の形態1に係る車載安全制御装置の動作を示すフローチャートである。3 is a flowchart showing the operation of the in-vehicle safety control device according to the first embodiment.

<実施の形態1>
図1は、本実施の形態に係る移動体位置検出装置、車載安全制御装置、及び、移動体位置検出方法を用いた安全運転支援システムの概念を示す図であり、図2は、当該安全運転支援システムの適用例を示す図である。図2の下側に示されるように、本実施の形態では、移動体たる車両に関し、上流側にある原点と、当該原点から道程に沿って下流に向かう方向を正とした一次元の座標軸とからなる座標系が用いられる。
<Embodiment 1>
FIG. 1 is a diagram illustrating a concept of a safe driving support system using a mobile body position detection device, an in-vehicle safety control device, and a mobile body position detection method according to the present embodiment, and FIG. It is a figure which shows the example of application of a support system. As shown in the lower side of FIG. 2, in the present embodiment, with respect to the vehicle that is a moving body, an origin on the upstream side, and a one-dimensional coordinate axis with a positive direction from the origin toward the downstream along the journey, A coordinate system consisting of is used.

図1に示されるように、安全運転支援システムは、車両11に搭載される本実施の形態に係る車載安全制御装置1と、道路(路側)に設置された路側移動体検出装置2と、道路(路側)に設置された路側無線装置3とを備える。   As shown in FIG. 1, the safe driving support system includes an in-vehicle safety control device 1 according to the present embodiment mounted on a vehicle 11, a road-side moving body detection device 2 installed on a road (roadside), a road And a roadside apparatus 3 installed on the roadside.

路側移動体検出装置2は、例えば、画像センサ、超音波センサ、光学センサからなり、検出範囲2aに車両が存在する場合に当該車両の上記座標系における現在位置を検出し、当該現在位置を示す移動体位置情報を生成する。なお、検出範囲2aに存在する車両には、車載安全制御装置1が搭載されていてもよいし、搭載されていなくてもよい。路側移動体検出装置2は、生成した移動体位置情報を路側無線装置3に出力する。   The roadside moving body detection device 2 includes, for example, an image sensor, an ultrasonic sensor, and an optical sensor. When a vehicle is present in the detection range 2a, the roadside moving body detection device 2 detects the current position in the coordinate system of the vehicle and indicates the current position. Mobile object position information is generated. In addition, the vehicle-mounted safety control apparatus 1 may be mounted in the vehicle which exists in the detection range 2a, and it does not need to be mounted. The roadside mobile body detection device 2 outputs the generated mobile body position information to the roadside wireless device 3.

路側無線装置3は、通信エリアに車両11の車載安全制御装置1が存在する場合に、当該車載安全制御装置1と、数十〜数百メートルの通信範囲を持つDSRCや700MHz帯の電波による無線通信を行う。   When the vehicle-mounted safety control device 1 of the vehicle 11 is present in the communication area, the roadside wireless device 3 is wirelessly connected to the vehicle-mounted safety control device 1 using a DSRC having a communication range of several tens to several hundreds of meters or a 700 MHz band radio wave. Communicate.

本実施の形態では、路側無線装置3は中央装置4と接続されており、中央装置4から、上記原点及び上記座標軸からなる座標系を特定する移動体位置座標情報を受け取ることが可能となっている。この移動体位置座標情報においては、例えば、上記原点の位置や道路の所定の位置が、経度・緯度・方位を用いて特定されている。   In the present embodiment, the roadside apparatus 3 is connected to the central apparatus 4 and can receive from the central apparatus 4 mobile body position coordinate information that specifies a coordinate system including the origin and the coordinate axes. Yes. In the moving body position coordinate information, for example, the position of the origin or a predetermined position on the road is specified using longitude, latitude, and direction.

路側無線装置3は、路側移動体検出装置2からの移動体位置情報、及び、中央装置4からの移動体位置座標情報を、当該車載安全制御装置1に配信する。なお、ここでは、路側無線装置3は、移動体位置座標情報を中央装置4から受け取るものとして説明したが、路側無線装置3に予め移動体位置座標情報が保持されていてもよい。   The roadside apparatus 3 distributes the moving body position information from the roadside moving body detection apparatus 2 and the moving body position coordinate information from the central apparatus 4 to the in-vehicle safety control apparatus 1. Here, the roadside wireless device 3 has been described as receiving the mobile body position coordinate information from the central device 4, but the mobile body position coordinate information may be held in advance in the roadside wireless device 3.

図2に示されるように、車載安全制御装置1が搭載された車両11(以下「検出対象車両11」と呼ぶ)が、上記座標系により表される道路6上を走行している。そして、当該道路6上において、検出対象車両11の前方を別の車両12(以下「前方車両12」と呼ぶ)が走行している。後述するように、本実施の形態では、検出対象車両11の上記座標系における現在位置P1を検出するとともに、検出対象車両11が前方車両12と衝突する可能性が高い場合に、ドライバーに対して警告することが可能となっている。   As shown in FIG. 2, a vehicle 11 (hereinafter referred to as “detection target vehicle 11”) on which the in-vehicle safety control device 1 is mounted is traveling on a road 6 represented by the coordinate system. On the road 6, another vehicle 12 (hereinafter referred to as “front vehicle 12”) is traveling ahead of the detection target vehicle 11. As will be described later, in the present embodiment, when the current position P1 in the coordinate system of the detection target vehicle 11 is detected and the detection target vehicle 11 is highly likely to collide with the vehicle 12 ahead, It is possible to warn.

検出対象車両11が走行している道路6上には、路側無線装置3が検出対象車両11と常時通信可能な通信範囲3aが設けられている。そして、その通信範囲3aよりも下流側には、路側移動体検出装置2が上記座標系における車両の現在位置を検出可能な検出範囲2aが設けられている。なお、図2では、路側無線装置3の通信範囲3aと、路側移動体検出装置2の検出範囲2aとは互いに離れている状態が示されているが、これに限ったものではなく、これらの一部が互いに重なっていてもよい。   On the road 6 on which the detection target vehicle 11 is traveling, a communication range 3a in which the roadside apparatus 3 can always communicate with the detection target vehicle 11 is provided. A detection range 2a in which the road-side moving body detection device 2 can detect the current position of the vehicle in the coordinate system is provided downstream of the communication range 3a. In FIG. 2, the communication range 3 a of the roadside wireless device 3 and the detection range 2 a of the roadside mobile body detection device 2 are shown as being separated from each other. Some may overlap each other.

路側移動体位置検出2は、検出範囲2a内に存在する車両の上記座標系における現在位置を常時検出することが可能となっており、当該現在位置を検出した場合に、当該現在位置を示す移動体位置情報を路側無線装置3に出力する。図2に示される状態では、検出範囲2a内に前方車両12が存在することから、路側移動体位置検出2は、前方車両12の上記座標系における現在位置P2を示す移動体位置情報を路側無線装置3に出力することになる。   The roadside moving body position detection 2 can always detect the current position in the coordinate system of the vehicle existing in the detection range 2a, and when the current position is detected, the movement indicating the current position is detected. The body position information is output to the roadside apparatus 3. In the state shown in FIG. 2, since the forward vehicle 12 exists in the detection range 2a, the road-side mobile body position detection 2 uses the road-side wireless position information indicating the current position P2 in the coordinate system of the forward vehicle 12 as roadside wireless. It is output to the device 3.

図3は、本実施の形態に係る移動体検出位置装置105を備える車載安全制御装置1の構成を示すブロック図である。この図に示されるように、車載安全制御装置1は、タイマー装置101と、車載センサ装置102と、通信装置103と、移動体位置履歴情報蓄積装置104と、移動体位置検出装置105と、衝突判定装置106と、警告出力装置107とを備える。なお、移動体位置履歴情報蓄積装置104には、例えば、RAMなどの記憶装置(図示せず)が用いられ、警告出力装置107には、例えば、スピーカや表示装置(いずれも図示せず)が用いられる。   FIG. 3 is a block diagram illustrating a configuration of the in-vehicle safety control device 1 including the moving body detection position device 105 according to the present embodiment. As shown in this figure, the in-vehicle safety control device 1 includes a timer device 101, an in-vehicle sensor device 102, a communication device 103, a mobile object position history information storage device 104, a mobile object position detection device 105, and a collision. A determination device 106 and a warning output device 107 are provided. For example, a storage device (not shown) such as a RAM is used as the moving body position history information storage device 104, and a speaker or a display device (none of them is shown) is used as the warning output device 107, for example. Used.

タイマー装置101は、現在の時刻を示す時刻情報を取得し、移動体位置履歴情報蓄積装置104に出力する。   The timer device 101 acquires time information indicating the current time and outputs the time information to the moving body position history information storage device 104.

車載センサ装置102は、検出対象車両11のGPS衛星からのGPS位置情報と、検出対象車両11の車速等の情報を含む車載センサ情報と、検出対象車両11の累積走行距離とを検出し、これら情報を移動体位置履歴情報蓄積装置104に出力する。また、車載センサ装置102は、検出対象車両11の現在(最新)の累積走行距離を移動体位置検出装置105に出力する。なお、図3には示していないが、本実施の形態に係る車載センサ装置102は、車載センサ情報(車速)を衝突判定装置106にも出力する。   The in-vehicle sensor device 102 detects the GPS position information from the GPS satellite of the detection target vehicle 11, the in-vehicle sensor information including information such as the vehicle speed of the detection target vehicle 11, and the cumulative travel distance of the detection target vehicle 11. The information is output to the moving body location history information storage device 104. Further, the in-vehicle sensor device 102 outputs the current (latest) cumulative travel distance of the detection target vehicle 11 to the moving body position detection device 105. Although not shown in FIG. 3, the in-vehicle sensor device 102 according to the present embodiment also outputs the in-vehicle sensor information (vehicle speed) to the collision determination device 106.

通信装置103は、路側無線装置3と電波または近赤外線を用いて無線通信することにより、路側無線装置3からの移動体位置情報及び移動体位置座標情報を移動体位置検出装置105に出力するとともに、この通信の状態を示す通信情報を移動体位置履歴情報蓄積装置104に出力する。   The communication device 103 wirelessly communicates with the roadside wireless device 3 using radio waves or near infrared rays, thereby outputting the moving body position information and the moving body position coordinate information from the roadside wireless device 3 to the moving body position detecting device 105. Then, the communication information indicating the communication state is output to the mobile unit position history information storage device 104.

本実施の形態では、上記タイマー装置101、車載センサ装置102及び通信装置103は、安全運転支援システムの仕様上許容される時間間隔(例えば、100ミリ秒)で、上記情報を移動体位置履歴情報蓄積装置104等に出力しているものとする。   In the present embodiment, the timer device 101, the in-vehicle sensor device 102, and the communication device 103 transfer the above information to the moving body position history information at a time interval (for example, 100 milliseconds) that is allowed in the specification of the safe driving support system. Assume that the data is output to the storage device 104 or the like.

移動体位置履歴情報蓄積装置104は、タイマー装置101、車載センサ装置102及び通信装置103の出力情報から、複数の移動体位置履歴情報を生成・蓄積する。   The mobile body location history information storage device 104 generates and stores a plurality of mobile body location history information from the output information of the timer device 101, the in-vehicle sensor device 102, and the communication device 103.

図4は、移動体位置履歴情報蓄積装置104により生成・蓄積される複数の移動体位置履歴情報の一例を示す図である。移動体位置履歴情報蓄積装置104は、移動体位置履歴情報を生成する際に、タイマー装置101から出力される時刻情報と、車載センサ装置102から出力されるGPS位置情報、車載センサ情報及び累積走行距離と、通信装置103から出力される通信情報とをほぼ同時に取得し、これら情報から、移動体位置履歴情報を生成する。移動体位置履歴情報蓄積装置104のこのような動作により、複数の移動体位置履歴情報のそれぞれは、図4に示されるように、検出対象車両11のGPS位置情報と、当該GPS位置情報に対応付けられた検出対象車両11の累積走行距離とを含んだものとなっている。   FIG. 4 is a diagram illustrating an example of a plurality of mobile body position history information generated and stored by the mobile body position history information storage device 104. The mobile body location history information storage device 104 generates time information output from the timer device 101, GPS location information output from the in-vehicle sensor device 102, in-vehicle sensor information, and cumulative travel when generating the mobile body location history information. The distance and the communication information output from the communication device 103 are acquired almost simultaneously, and the moving body position history information is generated from these information. By such an operation of the moving body position history information storage device 104, each of the plurality of moving body position history information corresponds to the GPS position information of the detection target vehicle 11 and the GPS position information as shown in FIG. It includes the cumulative travel distance of the attached detection target vehicle 11.

ここで、図4に示される各項目について説明する。時刻情報はGPS位置情報等が取得された時刻を示す。GPS位置情報は、GPS衛星により検出された、緯度・経度における検出対象車両11の位置情報を示す。通信情報は、通信の開始/終了、通信メディアの種別、接続/切断を示す。車載センサ情報は、検出対象車両11の速度、方位、車速パルス、磁気マーカー検出の有無、停止線検出の有無を示す。累積走行距離は、検出対象車両11が走行開始してから走行した距離を示す。この累積走行距離は、例えば、検出対象車両11のタイヤの累積回転数に基づいて算出される。なお、本実施の形態では、累積走行距離が蓄積可能な最大値を超えた場合には、累積走行距離は、積算開始時の値(例えば0メートル)から再度積算されていくものとする。移動体位置履歴情報蓄積装置104は、生成した移動体位置履歴情報を時刻順に並べて蓄積する。   Here, each item shown in FIG. 4 will be described. The time information indicates the time when the GPS position information and the like are acquired. The GPS position information indicates the position information of the detection target vehicle 11 at the latitude / longitude detected by the GPS satellite. The communication information indicates the start / end of communication, the type of communication media, and connection / disconnection. The in-vehicle sensor information indicates the speed, direction, vehicle speed pulse, presence / absence of magnetic marker detection, and presence / absence of stop line detection of the detection target vehicle 11. The cumulative travel distance indicates the distance traveled since the detection target vehicle 11 started travelling. This cumulative travel distance is calculated based on, for example, the cumulative rotational speed of the tire of the detection target vehicle 11. In the present embodiment, when the accumulated travel distance exceeds the maximum value that can be accumulated, the accumulated travel distance is accumulated again from the value at the start of accumulation (for example, 0 meter). The mobile body location history information storage device 104 stores the generated mobile body location history information in order of time.

図3に戻って、本発明のポイントとなる移動体位置検出装置105は、移動体位置検出手段105aを備えている。この移動体位置検出手段105aは、通信装置103からの移動体位置座標情報と、移動体位置履歴情報蓄積装置104で蓄積されている複数の移動体位置履歴情報とに基づいて、検出対象車両11の現在位置P1を検出する。なお、通信装置103からの移動体位置座標情報は、換言すれば、路側無線装置3からの移動体位置座標情報である。移動体位置検出手段105aが現在位置P1を検出する動作については、後でフローチャートを用いて詳細に説明する。   Returning to FIG. 3, the moving body position detecting device 105 as a point of the present invention includes moving body position detecting means 105 a. This moving body position detecting means 105 a is based on the moving body position coordinate information from the communication device 103 and the plurality of moving body position history information stored in the moving body position history information storage device 104. Current position P1 is detected. In addition, the moving body position coordinate information from the communication device 103 is the moving body position coordinate information from the roadside apparatus 3 in other words. The operation in which the moving body position detecting unit 105a detects the current position P1 will be described in detail later using a flowchart.

移動体位置検出装置105は、移動体位置検出手段105aで検出された、検出対象車両11の現在位置P1と、通信装置103からの、前方車両12の現在位置P2を示す移動体位置情報とに基づいて、検出対象車両11から見た前方車両12の道のりの相対距離(車両間距離)を算出し、当該相対距離を衝突判定装置106に出力する。なお、通信装置103からの移動体位置情報は、換言すれば、路側無線装置3からの移動体位置座標情報である。   The moving body position detecting device 105 includes the current position P1 of the detection target vehicle 11 detected by the moving body position detecting means 105a and the moving body position information indicating the current position P2 of the preceding vehicle 12 from the communication device 103. Based on this, the relative distance (distance between vehicles) of the forward vehicle 12 viewed from the detection target vehicle 11 is calculated, and the relative distance is output to the collision determination device 106. In addition, the moving body position information from the communication apparatus 103 is moving body position coordinate information from the roadside apparatus 3 in other words.

衝突判定装置106は、移動体位置検出装置105からの相対距離と、車載センサ装置102からの検出対象車両11の速度(車載センサ情報)とに基づいて、検出対象車両11が前方車両12と衝突する危険性があるかを判定する。この衝突判定装置106の判定動作についても、後でフローチャートを用いて詳細に説明する。   The collision determination device 106 causes the detection target vehicle 11 to collide with the preceding vehicle 12 based on the relative distance from the moving body position detection device 105 and the speed of the detection target vehicle 11 from the in-vehicle sensor device 102 (in-vehicle sensor information). Determine whether there is a risk of The determination operation of the collision determination device 106 will also be described in detail later using a flowchart.

衝突判定装置106は、検出対象車両11が前方車両12と衝突する危険があると判定した場合には、衝突の可能性及び危険性があることを検出対象車両11のドライバーに警告するためのコンテンツ(例えば、音声及び画像データ)を警告出力装置107に出力する。警告出力装置107は、衝突判定装置106から当該コンテンツを受けた場合に、当該コンテンツを再生し、音声や画像等による警告を外部(ドライバー)に出力する。   When the collision determination device 106 determines that the detection target vehicle 11 is in danger of colliding with the vehicle 12 ahead, the content for warning the driver of the detection target vehicle 11 that there is a possibility and danger of the collision (For example, sound and image data) is output to the warning output device 107. When the warning output device 107 receives the content from the collision determination device 106, the warning output device 107 reproduces the content and outputs a warning by sound, image, or the like to the outside (driver).

図5は、移動体位置履歴情報蓄積装置104,移動体位置検出装置105(移動体位置検出手段105a),衝突判定装置106及び警告出力装置107の動作を示すフローチャートである。このフローチャートにおいては、主に、移動体位置検出手段105aが検出対象車両11の現在位置P1を検出すること、衝突判定装置106が検出対象車両11と前方車両12との衝突危険性を判定すること、衝突危険性があると判定された場合に警告出力装置107がドライバーに警告を出力することを示している。以下、このフローチャートを用いて、この一連の動作について詳細に説明する。   FIG. 5 is a flowchart showing the operations of the moving object position history information storage device 104, the moving object position detection device 105 (the moving object position detection means 105a), the collision determination device 106, and the warning output device 107. In this flowchart, mainly, the moving body position detection unit 105a detects the current position P1 of the detection target vehicle 11, and the collision determination device 106 determines the risk of collision between the detection target vehicle 11 and the preceding vehicle 12. This indicates that the warning output device 107 outputs a warning to the driver when it is determined that there is a collision risk. Hereinafter, this series of operations will be described in detail using this flowchart.

なお、ステップS1の前段階として、検出対象車両11が、安全運転支援システムの仕様上、位置検出誤差として許容される距離(例えば、数十センチメートル)を走行する毎に、移動体位置履歴情報蓄積装置104が、GPS位置情報及び累積走行距離を移動体位置履歴情報として生成することにより、複数の移動体位置履歴情報が蓄積されているものとする。ただし、所定の時間経過した場合、路側無線装置3との通信開始時など路側無線装置3との通信の接続/切断が行われた場合、及び、車載センサ装置102が道路に埋め込まれた磁気マーカーまたは停止線位置などを検出した場合のいずれかが成立した際にも、移動体位置履歴情報蓄積装置104は、移動体位置履歴情報を生成・蓄積してもよい。   In addition, as the previous stage of step S1, every time the detection target vehicle 11 travels a distance (for example, several tens of centimeters) allowed as a position detection error in the specification of the safe driving support system, the moving body position history information It is assumed that a plurality of mobile body position history information is stored by the storage device 104 generating the GPS position information and the accumulated travel distance as mobile body position history information. However, when a predetermined time has elapsed, when communication with the roadside apparatus 3 is connected / disconnected, such as when communication with the roadside apparatus 3 is started, and when the in-vehicle sensor device 102 is embedded in the road Alternatively, the moving body position history information storage device 104 may generate and store the moving body position history information when any of the cases where the stop line position is detected is established.

ステップS1にて、移動体位置検出装置105に、通信装置103が受信した移動体位置情報及び移動体位置座標情報と、車載センサ装置102で検出された累積走行距離とが随時入力される。   In step S <b> 1, the mobile body position information and the mobile body position coordinate information received by the communication device 103 and the cumulative travel distance detected by the in-vehicle sensor device 102 are input to the mobile body position detection device 105 as needed.

ステップS2にて、移動体位置検出手段105aは、移動体位置履歴情報蓄積装置104に蓄積されている複数の移動体位置履歴情報のうち、ステップS1にて受けた移動体位置座標情報で特定される原点の位置(図2に示す位置0)に最も近い過去のGPS位置情報を含む移動体位置履歴情報を検索する。以下、このようにして移動体位置検出手段105aで検索された移動体位置履歴情報を「移動体位置履歴情報O」と呼ぶこともある。   In step S2, the moving body position detecting means 105a is specified by the moving body position coordinate information received in step S1 among the plurality of moving body position history information stored in the moving body position history information storage device 104. The mobile body position history information including the past GPS position information closest to the origin position (position 0 shown in FIG. 2) is searched. Hereinafter, the moving body position history information searched by the moving body position detecting means 105a in this way may be referred to as “moving body position history information O”.

そして、移動体位置検出手段105aは、移動体位置履歴情報Oの累積走行距離(LO)と、車載センサ装置102で検出された現在(最新)の累積走行距離(LX)との差(P1)を算出する。本実施の形態では、移動体位置検出手段105aは、LX≧LOである場合には、次式(1)によりP1を求め、LX<LOである場合には、次式(2)によりP1を求める。 Then, the moving body position detecting means 105a determines the difference between the accumulated traveling distance (L O ) of the moving body position history information O and the current (latest) accumulated traveling distance (L X ) detected by the in-vehicle sensor device 102 ( P1) is calculated. In the present embodiment, the moving body position detecting means 105a obtains P1 by the following equation (1) when L X ≧ L O , and when L X <L O , the following equation (2 ) To obtain P1.

Figure 0005430512
Figure 0005430512

Figure 0005430512
Figure 0005430512

そして、移動体位置検出手段105aは、差(P1)だけ原点から進んだ位置を、検出対象車両11の座標系における現在位置として検出する。   Then, the moving body position detecting unit 105a detects the position advanced from the origin by the difference (P1) as the current position in the coordinate system of the detection target vehicle 11.

ステップS3にて、移動体位置検出装置105は、移動体位置検出手段105aで検出された検出対象車両11の現在位置(P1)と、通信装置103からの移動体位置情報が示す、前方車両12の現在位置(P2)とに基づいて、次式(3)により、検出対象車両11から見た前方車両12の道のりの相対距離(Lw)を算出する。   In step S <b> 3, the moving body position detection device 105 detects the forward vehicle 12 indicated by the current position (P <b> 1) of the detection target vehicle 11 detected by the moving body position detection unit 105 a and the moving body position information from the communication device 103. Based on the current position (P2), the road relative distance (Lw) of the forward vehicle 12 viewed from the detection target vehicle 11 is calculated by the following equation (3).

Figure 0005430512
Figure 0005430512

ステップS4にて、移動体位置検出装置105は、相対距離Lwの値を衝突判装置106に出力する。   In step S <b> 4, the moving body position detection device 105 outputs the value of the relative distance Lw to the collision determination device 106.

ステップS5にて、衝突判定手段106は、相対距離Lwに基づいて、検出対象車両11と前方車両12とが衝突するかを判定する。   In step S5, the collision determination unit 106 determines whether the detection target vehicle 11 and the preceding vehicle 12 collide based on the relative distance Lw.

例えば、衝突判定手段106は、予め定められた検出対象車両11の減速度(d)と、車載センサ装置102からの検出対象車両11の速度(v)とに基づいて、次式(4)により、検出対象車両11がブレーキ等を受けてから停止するまでの時間(Ta=(v/d))に進む制動距離(La)を算出する。   For example, the collision determination unit 106 uses the following equation (4) based on the predetermined deceleration (d) of the detection target vehicle 11 and the speed (v) of the detection target vehicle 11 from the in-vehicle sensor device 102. Then, a braking distance (La) is calculated that proceeds to a time (Ta = (v / d)) from when the detection target vehicle 11 receives a brake or the like until it stops.

Figure 0005430512
Figure 0005430512

それから、衝突判定手段106は、検出対象車両11の速度(v)と、前方車両12に関する移動体位置情報を通信手段103で受信してから警告出力装置107が警告を出力するまでの車載装置側の処理時間(Tb)と、警告出力装置107からの警告を受けてからドライバーがブレーキ等の衝突回避行動をするまでの人の反応時間(Tc)とに基づいて、次式(5)により、前方車両12の移動体位置情報が通信手段103で受信されてからブレーキ等の衝突回避行動が行われるまでに進む距離(Lb)を算出する。   Then, the collision determination unit 106 receives the speed (v) of the detection target vehicle 11 and the moving body position information regarding the preceding vehicle 12 from the communication unit 103 until the warning output device 107 outputs a warning. And the response time (Tc) of the person from when the warning is received from the warning output device 107 until the driver performs a collision avoidance action such as a brake, the following equation (5): The distance (Lb) traveled from when the moving body position information of the preceding vehicle 12 is received by the communication means 103 until the collision avoidance action such as braking is performed is calculated.

Figure 0005430512
Figure 0005430512

ステップS6にて、衝突判定手段106は、次式(6)が満された場合に、検出対象車両11と前方車両12とが衝突する危険性があると判断し、ステップS7に進む。一方、衝突判定手段106は、次式(6)が満されなかった場合に、検出対象車両11と前方車両12とが衝突する危険性がないと判断し、ステップS7を行わずに、図5に示される動作が一通り終了する。   In step S6, the collision determination unit 106 determines that there is a risk of collision between the detection target vehicle 11 and the preceding vehicle 12 when the following expression (6) is satisfied, and the process proceeds to step S7. On the other hand, when the following equation (6) is not satisfied, the collision determination unit 106 determines that there is no risk that the detection target vehicle 11 and the preceding vehicle 12 will collide, and without performing step S7, FIG. The operation shown in FIG.

Figure 0005430512
Figure 0005430512

ステップS7にて、衝突判定手段106は、検出対象車両11のドライバーに警告するためのコンテンツを警告出力装置107に出力する。そして、警告出力装置107は、衝突判定手段106からのコンテンツを再生し、警告をドライバー(外部)に出力する。   In step S <b> 7, the collision determination unit 106 outputs content for warning the driver of the detection target vehicle 11 to the warning output device 107. Then, the warning output device 107 reproduces the content from the collision determination unit 106 and outputs a warning to the driver (external).

以上のような本実施の形態に係る移動体位置検出装置105によれば、路側無線装置3からの移動体位置座標情報と、複数の移動体位置履歴情報とに基づいて、検出対象車両11の現在位置P1を検出する。この検出において、路側無線装置3の通信範囲3aの大きさはほとんど影響しないことから、検出対象車両11の現在位置P1を検出する際に、比較的広い通信範囲3aを持つ通信を用いることができる。また、現在位置P1は、移動体位置履歴情報の累積走行距離と現在の累積走行距離との差であることから、その算出が簡素化されるとともに、正確な走行距離を検出することができる。また、その結果として、算出・検出に必要なエネルギーを低減することができたり、それに必要な装置を小型化できたりするという副次的な効果も期待できる。   According to the mobile body position detection apparatus 105 according to the present embodiment as described above, the detection target vehicle 11 is detected based on the mobile body position coordinate information from the roadside apparatus 3 and a plurality of mobile body position history information. The current position P1 is detected. In this detection, since the size of the communication range 3a of the roadside apparatus 3 has little influence, when detecting the current position P1 of the detection target vehicle 11, communication having a relatively wide communication range 3a can be used. . In addition, since the current position P1 is a difference between the cumulative travel distance of the moving body position history information and the current cumulative travel distance, the calculation is simplified and an accurate travel distance can be detected. As a result, it is also possible to expect a secondary effect that energy required for calculation / detection can be reduced and a device required for the calculation / detection can be reduced in size.

なお、上述したように、安全運転支援システムの仕様上、位置検出誤差として許容される距離(例えば、数十センチメートル)を走行する毎に、GPS位置情報及び累積走行距離を移動体位置履歴情報として生成すれば、現在位置P1を高い精度で取得することができる。   Note that, as described above, the GPS position information and the accumulated traveling distance are calculated as the mobile body position history information every time the vehicle travels a distance (for example, several tens of centimeters) allowed as a position detection error in the specification of the safe driving support system. As a result, the current position P1 can be acquired with high accuracy.

また、以上のような本実施の形態に係る車載安全制御装置1によれば、座標上における相対距離に基づいて、検出対象車両11と前方車両12とが衝突するかを判定する。これにより、道路網を考慮した道のり上の相対距離を用いて衝突危険性が判断される。したがって、衝突しない経路を走行している場合に現実の相対距離が短くなっても、警告が出力されてしまうのを防ぐことができる。   Moreover, according to the vehicle-mounted safety control apparatus 1 which concerns on this Embodiment as mentioned above, it is determined whether the detection object vehicle 11 and the front vehicle 12 collide based on the relative distance on a coordinate. Thereby, the risk of collision is determined using the relative distance on the road in consideration of the road network. Therefore, it is possible to prevent a warning from being output even if the actual relative distance is shortened when traveling on a route that does not collide.

なお、上記移動体位置座標情報においては、例えば、上記原点の位置や道路の所定の位置が、経度・緯度・方位を用いて特定されるものとしていたが、磁気マーカーの検出位置を上記原点の位置として用いてもよい。   In the moving body position coordinate information, for example, the position of the origin or a predetermined position on the road is specified by using longitude, latitude, and azimuth. It may be used as a position.

この場合、原点の位置(図2に示す位置O)に磁気マーカーが設置されており、車載センサ装置102がその磁気マーカーを検出する。そして、上述のステップS2と同様にして、移動体位置履歴情報蓄積装置104に蓄積されている複数の移動体位置履歴情報のうち、車載センサ情報として検出される磁気マーカー(例えば図4の履歴NO1)に対応するGPS位置情報が原点として用いられる。   In this case, a magnetic marker is installed at the position of the origin (position O shown in FIG. 2), and the in-vehicle sensor device 102 detects the magnetic marker. Then, in the same manner as in step S2 described above, among the plurality of moving body position history information stored in the moving body position history information storage device 104, a magnetic marker (for example, history NO1 in FIG. 4) detected as in-vehicle sensor information. GPS position information corresponding to) is used as the origin.

<実施の形態2>
上述の実施の形態1では、移動体位置座標情報と移動体位置履歴情報を用いて、検出対象車両11の現在位置を求めた。本実施の形態では、別の情報を用いて、検出対象車両11の現在位置を求める。
<Embodiment 2>
In the first embodiment described above, the current position of the detection target vehicle 11 is obtained using the moving body position coordinate information and the moving body position history information. In the present embodiment, the current position of the detection target vehicle 11 is obtained using other information.

本実施の形態では、路側無線装置3から、停止線位置を示すための原点及び座標軸からなる座標系を特定する停止線位置座標情報と、上記原点から見た停止線の相対距離(つまり、当該座標系上における停止線位置)を示す停止線位置情報とが配信される。本実施の形態では、路側無線装置3から配信された、停止線位置座標情報及び停止線位置情報は、通信装置103で受信された後、移動体位置検出装置105に入力される。   In the present embodiment, from the roadside wireless device 3, stop line position coordinate information for specifying a coordinate system composed of an origin and a coordinate axis for indicating the stop line position, and a relative distance of the stop line viewed from the origin (that is, the concerned Stop line position information indicating the stop line position on the coordinate system) is distributed. In the present embodiment, the stop line position coordinate information and stop line position information distributed from the roadside apparatus 3 are received by the communication apparatus 103 and then input to the moving body position detection apparatus 105.

これと並行して、車載安全制御装置1は、車載センサ装置102に含まれるカメラ102a(撮像センサ)を用いて停止線位置を検出する。そして、車載センサ装置102は、停止線位置を検出した時点の累積走行距離と現時点の累積走行距離との差などを、検出対象車両11から見た停止線位置の相対距離Lcとして取得する。車載センサ装置102が取得した当該相対距離Lcは、移動体位置検出装置105に入力される。   In parallel with this, the vehicle-mounted safety control device 1 detects the stop line position using the camera 102a (imaging sensor) included in the vehicle-mounted sensor device 102. The in-vehicle sensor device 102 acquires the difference between the cumulative travel distance at the time when the stop line position is detected and the current cumulative travel distance as the relative distance Lc of the stop line position as viewed from the detection target vehicle 11. The relative distance Lc acquired by the in-vehicle sensor device 102 is input to the moving body position detection device 105.

そして、移動体位置検出装置105は、停止線位置座標情報、停止線位置情報及び相対距離Lcに基づいて、次式(7)により、検出対象車両11の現在位置Ps1を求める。つまり、移動体位置検出装置105は、停止線位置情報が示す停止線位置と、相対距離Lcとの差を、停止線位置座標情報が特定する座標系における検出対象車両11の現在位置Ps1として検出する。   And the moving body position detection apparatus 105 calculates | requires the present position Ps1 of the detection target vehicle 11 by following Formula (7) based on stop line position coordinate information, stop line position information, and relative distance Lc. That is, the moving body position detection device 105 detects the difference between the stop line position indicated by the stop line position information and the relative distance Lc as the current position Ps1 of the detection target vehicle 11 in the coordinate system specified by the stop line position coordinate information. To do.

Figure 0005430512
Figure 0005430512

以上のような本実施の形態に係る移動体位置検出装置105によれば、路側無線装置3からの停止線位置座標情報及び停止線位置情報と、カメラ102aを用いて検出した検出対象車両11から見た停止線位置の相対距離Lcを用いて、検出対象車両11の現在位置PS1を検出することができる。つまり、本実施の形態に係る移動体位置検出装置105によれば、実施の形態1で用いた情報とは別の情報を用いて、検出対象車両11の現在位置Ps1を検出することができる。   According to the moving body position detection apparatus 105 according to the present embodiment as described above, the stop line position coordinate information and stop line position information from the roadside apparatus 3 and the detection target vehicle 11 detected using the camera 102a. The current position PS1 of the detection target vehicle 11 can be detected using the relative distance Lc of the viewed stop line position. That is, according to the moving body position detection apparatus 105 according to the present embodiment, the current position Ps1 of the detection target vehicle 11 can be detected using information different from the information used in the first embodiment.

なお、停止線位置はカメラ102aを用いて検出されることから、車載センサ装置102で検出される相対距離Lcの検出誤差、つまり、現在位置Ps1の検出誤差は、カメラの撮像範囲(約5〜6メートル程度)以下となることを前提としている。その結果、本実施の形態で求められる現在位置Ps1の検出誤差は、相対距離Lcの検出誤差範囲内となる。   Since the stop line position is detected using the camera 102a, the detection error of the relative distance Lc detected by the in-vehicle sensor device 102, that is, the detection error of the current position Ps1 is an imaging range of the camera (about 5 to 5). 6m) or less. As a result, the detection error of the current position Ps1 obtained in the present embodiment is within the detection error range of the relative distance Lc.

また、本実施の形態では、実施の形態1で検出対象車両11の現在位置P1を求めるのに必要であったGPS位置情報が不要であることから、高層ビルの多いGPSの電波が届かない市街地、または、GPS位置検出誤差が十メートル単位で発生するような場合であっても、検出対象車両11の現在位置Ps1を求めることができる。   In addition, in this embodiment, the GPS position information necessary for obtaining the current position P1 of the detection target vehicle 11 in the first embodiment is unnecessary, so that the urban area where GPS radio waves do not reach with many high-rise buildings. Alternatively, even if the GPS position detection error occurs in units of 10 meters, the current position Ps1 of the detection target vehicle 11 can be obtained.

なお、実施の形態1及び本実施の形態2により検出対象車両11の現在位置P1及び現在位置Ps1をそれぞれ求め、現在位置P1の値が、現在位置Ps1の値より所定値以上(例えば十メートル以上)異なる場合に、当該現在位置P1の値の精度が低下していると判断して、現在位置P1を所定の動作(例えば実施の形態1で述べた衝突危険性の判断)に用いないようにしてもよい。なお、この場合に、現在位置P1の代わりに現在位置Ps1を利用するようにしても良い。このようにすれば、実施の形態1で求められる現在位置P1の精度が良いか悪いかを、当該現在位置P1と、本実施の形態により求められる現在位置Ps1とに基づいて確認することができることから、精度のよい現在位置のみを用いることができる。   Note that the current position P1 and the current position Ps1 of the detection target vehicle 11 are respectively obtained according to the first embodiment and the second embodiment, and the value of the current position P1 is greater than or equal to a predetermined value (for example, ten meters or more) from the value of the current position Ps1. ) If they are different, it is determined that the accuracy of the value of the current position P1 is lowered, and the current position P1 is not used for a predetermined operation (for example, the determination of the collision risk described in the first embodiment). May be. In this case, the current position Ps1 may be used instead of the current position P1. In this way, whether the accuracy of the current position P1 obtained in the first embodiment is good or bad can be confirmed based on the current position P1 and the current position Ps1 obtained in the present embodiment. Therefore, it is possible to use only the current position with high accuracy.

1 車載安全制御装置、2 路側移動体検出装置、3 路側無線装置、11 検出対象車両、12 前方車両、102a カメラ、105 移動体位置検出装置、105a 移動体位置検出手段、106 衝突判定手段、107 警告出力装置。   DESCRIPTION OF SYMBOLS 1 Vehicle-mounted safety control apparatus, 2 roadside mobile body detection apparatus, 3 roadside radio | wireless apparatus, 11 detection object vehicle, 12 vehicle ahead, 102a camera, 105 mobile body position detection apparatus, 105a mobile body position detection means, 106 collision determination means, 107 Warning output device.

Claims (5)

移動体に搭載される移動体位置検出装置であって、
路側無線装置から配信された、移動体の位置を示すための原点及び座標軸からなる座標系を特定する移動体位置座標情報と、前記移動体検出装置が搭載された検出対象移動体の複数の移動体位置履歴情報とに基づいて、前記検出対象移動体の前記座標系における現在位置を検出する移動体位置検出手段
を備え、
前記移動体位置履歴情報は、
前記検出対象移動体の過去のGPS位置情報と、当該GPS位置情報に対応付けられた累積走行距離とを含み、
前記移動体位置検出手段は、
前記複数の移動体位置履歴情報のうち、前記移動体位置座標情報により特定される前記原点の位置に最も近い前記GPS位置情報を含む移動体位置履歴情報を検索し、検索された当該移動体位置履歴情報の前記累積走行距離と現在の累積走行距離の差だけ前記原点から前記座標軸の方向に進んだ位置を、前記検出対象移動体の前記座標系における現在位置として検出する、移動体位置検出装置。
A moving body position detecting device mounted on a moving body,
A plurality of movements of moving object position coordinate information specifying a coordinate system composed of an origin and a coordinate axis for indicating the position of the moving object, and a detection target moving object on which the moving object detection device is mounted, distributed from the roadside wireless device Based on body position history information, comprising a moving body position detecting means for detecting a current position in the coordinate system of the detection target moving body,
The moving body position history information is:
Including past GPS position information of the detection target moving body, and an accumulated travel distance associated with the GPS position information,
The moving body position detecting means includes
Among the plurality of moving body position history information, the moving body position history information including the GPS position information closest to the position of the origin specified by the moving body position coordinate information is searched, and the searched moving body position A moving body position detecting device that detects a position advanced in the direction of the coordinate axis from the origin by the difference between the accumulated traveling distance of history information and the current accumulated traveling distance as a current position in the coordinate system of the detection target moving body. .
移動体に搭載される車載安全制御装置であって、
請求項1に記載の移動体位置検出装置を備え、
前記移動体位置検出装置は、前記移動体位置検出手段で検出された前記検出対象移動体の前記座標系における現在位置と、路側無線装置から配信された、他の移動体の前記座標系における現在位置を示す移動体位置情報とに基づいて、前記検出対象移動体から見た前記他の移動体の相対距離を算出し、
前記相対距離に基づいて、前記検出対象移動体と前記他の移動体とが衝突するかを判定する衝突判定手段と、
前記衝突判定手段で衝突すると判定された場合に、警告を外部に出力する警告出力装置と
をさらに備える車載安全制御装置。
An in-vehicle safety control device mounted on a moving body,
The mobile body position detection device according to claim 1,
The mobile body position detection device includes a current position in the coordinate system of the detection target mobile body detected by the mobile body position detection unit, and a current position in the coordinate system of another mobile body distributed from a roadside wireless device. Based on the moving body position information indicating the position, the relative distance of the other moving body viewed from the detection target moving body,
A collision determination means for determining whether the detection target moving body and the other moving body collide based on the relative distance;
A vehicle-mounted safety control device further comprising a warning output device that outputs a warning to the outside when the collision determination means determines that a collision has occurred.
検出対象移動体の位置を検出する移動体位置検出方法であって、
(a)路側無線装置から配信された、移動体の位置を示すための原点及び座標軸からなる座標系を特定する移動体位置座標情報を取得するとともに、前記検出対象移動体の過去のGPS位置情報と、当該GPS位置情報に対応付けられた累積走行距離とを含む複数の移動体位置履歴情報を取得する工程と、
(b)前記複数の移動体位置座標情報のうち、前記移動体位置座標情報により特定される前記原点の位置に最も近い前記GPS位置情報を含む移動体位置履歴情報を検索し、検索された当該移動体位置履歴情報の前記累積走行距離と現在の累積走行距離の差だけ前記原点から前記座標軸の方向に進んだ距離を、前記検出対象移動体の前記座標系における現在位置として検出する工程と
を備える移動体位置検出方法。
A moving body position detection method for detecting the position of a detection target moving body,
(A) Obtaining moving body position coordinate information specifying a coordinate system composed of an origin and a coordinate axis for indicating the position of the moving body, distributed from the roadside apparatus, and past GPS position information of the detection target moving body And acquiring a plurality of mobile body position history information including the cumulative travel distance associated with the GPS position information;
(B) Among the plurality of moving body position coordinate information, the mobile body position history information including the GPS position information closest to the position of the origin specified by the moving body position coordinate information is searched, and the searched Detecting a distance traveled in the direction of the coordinate axis from the origin by the difference between the cumulative travel distance of the mobile body position history information and the current cumulative travel distance as a current position in the coordinate system of the detection target mobile body. A moving body position detection method provided.
検出対象移動体の位置を検出する移動体位置検出方法であって、
(a)路側無線装置から配信された、停止線位置及び車両の位置を示すための原点及び座標軸からなる座標系を特定する停止線位置座標情報と、当該座標系における前記停止線位置を示す停止線位置情報とを取得するとともに、前記検出対象移動体が備える撮像センサを用いて前記検出対象移動体から見た前記停止線位置の相対距離を取得する工程と、
(b)前記停止線位置情報が示す前記停止線位置と、前記相対距離との差を、前記停止線位置座標情報が特定する前記座標系における前記検出対象移動体の現在位置として検出する工程と
を備える移動体位置検出方法。
A moving body position detection method for detecting the position of a detection target moving body,
(A) Stop line position coordinate information specifying a coordinate system composed of an origin and a coordinate axis for indicating the stop line position and the vehicle position distributed from the roadside apparatus, and a stop indicating the stop line position in the coordinate system Obtaining line position information and obtaining a relative distance of the stop line position viewed from the detection target moving body using an imaging sensor included in the detection target moving body;
(B) detecting a difference between the stop line position indicated by the stop line position information and the relative distance as a current position of the detection target moving body in the coordinate system specified by the stop line position coordinate information; A moving body position detection method comprising:
(A)請求項3に記載の移動体位置検出方法を用いて前記検出対象移動体の現在位置を検出する工程と、
(B)請求項4に記載の移動体位置検出方法を用いて前記検出対象移動体の現在位置を検出する工程と、
(C)工程(A)で検出した前記現在位置の値が、工程(B)で検出した前記現在位置の値より所定値以上異なる場合に、前記工程(A)で検出した前記現在位置の精度が低下していると判断する工程と
を備える移動体位置検出方法。
(A) detecting a current position of the detection target moving body using the moving body position detecting method according to claim 3;
(B) detecting a current position of the detection target moving body using the moving body position detecting method according to claim 4;
(C) The accuracy of the current position detected in the step (A) when the value of the current position detected in the step (A) is different from the value of the current position detected in the step (B) by a predetermined value or more. A moving body position detection method comprising: a step of determining that the pressure has decreased.
JP2010164766A 2010-07-22 2010-07-22 MOBILE POSITION DETECTING DEVICE, IN-VEHICLE SAFETY CONTROL DEVICE, AND MOBILE POSITION DETECTING METHOD Expired - Fee Related JP5430512B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2010164766A JP5430512B2 (en) 2010-07-22 2010-07-22 MOBILE POSITION DETECTING DEVICE, IN-VEHICLE SAFETY CONTROL DEVICE, AND MOBILE POSITION DETECTING METHOD

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2010164766A JP5430512B2 (en) 2010-07-22 2010-07-22 MOBILE POSITION DETECTING DEVICE, IN-VEHICLE SAFETY CONTROL DEVICE, AND MOBILE POSITION DETECTING METHOD

Publications (2)

Publication Number Publication Date
JP2012027642A JP2012027642A (en) 2012-02-09
JP5430512B2 true JP5430512B2 (en) 2014-03-05

Family

ID=45780510

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2010164766A Expired - Fee Related JP5430512B2 (en) 2010-07-22 2010-07-22 MOBILE POSITION DETECTING DEVICE, IN-VEHICLE SAFETY CONTROL DEVICE, AND MOBILE POSITION DETECTING METHOD

Country Status (1)

Country Link
JP (1) JP5430512B2 (en)

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4317293B2 (en) * 1999-08-25 2009-08-19 クラリオン株式会社 Surrounding vehicle recognition communication system
JP2003288684A (en) * 2002-03-28 2003-10-10 Natl Inst For Land & Infrastructure Management Mlit Traveling position detecting method by road-vehicle communication
JP2008287572A (en) * 2007-05-18 2008-11-27 Sumitomo Electric Ind Ltd Vehicle driving support system, driving support device, vehicle, and vehicle driving support method
JP4715826B2 (en) * 2007-09-28 2011-07-06 住友電気工業株式会社 Vehicle driving support system, driving support device, vehicle, and vehicle driving support method
JP5233606B2 (en) * 2008-11-19 2013-07-10 富士通株式会社 Absolute movement path calculating device and method, and program

Also Published As

Publication number Publication date
JP2012027642A (en) 2012-02-09

Similar Documents

Publication Publication Date Title
US10704920B2 (en) Traffic lane guidance system for vehicle and traffic lane guidance method for vehicle
JP6149846B2 (en) Warning device
JP6260912B2 (en) Device, method, and program for providing traffic location information
JP6537631B2 (en) Prediction device, prediction system, prediction method and prediction program
JP6168025B2 (en) Intersection-related warning device for vehicles
JP2008065481A (en) Driving support system for vehicle
CN111009146B (en) Server, information processing method, and non-transitory storage medium storing program
JP4985450B2 (en) Information providing apparatus, information providing system, vehicle, and information providing method
KR102591823B1 (en) Apparatus and method for avoiding vehicle collision
JP2008015920A (en) Vehicle collision prevention support system
JP2008210051A (en) Driving support system for vehicle
JP2013033324A (en) Surrounding vehicle information notifying device
JP6500724B2 (en) Danger information notification system, server and computer program
JP2008065482A (en) Driving support system for vehicle
JP4609467B2 (en) Peripheral vehicle information generation device, peripheral vehicle information generation system, computer program, and peripheral vehicle information generation method
JP5924395B2 (en) Peripheral vehicle information notification device
JP5582078B2 (en) Driving assistance device
JP2008084003A (en) Vehicular drive support system
JP2017123072A (en) Driving support apparatus and computer program
KR102084946B1 (en) Method and apparatus for generating an alarm notification according to the passage height of object located in a moving path the vehicle
JP2013050803A (en) Mobile communication device and method of supporting rear-end collision prevention
JP4596359B2 (en) Alarm system and mobile terminal
JP4766058B2 (en) Information providing apparatus, information providing system, vehicle, and information providing method
JP6210071B2 (en) Collision avoidance system
JP4788701B2 (en) Vehicle information generating apparatus, computer program, and vehicle information generating method

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20121005

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20131030

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: 20131105

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20131203

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

Ref document number: 5430512

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees