JP4591777B2 - Self-recognition system - Google Patents
Self-recognition system Download PDFInfo
- Publication number
- JP4591777B2 JP4591777B2 JP2005377455A JP2005377455A JP4591777B2 JP 4591777 B2 JP4591777 B2 JP 4591777B2 JP 2005377455 A JP2005377455 A JP 2005377455A JP 2005377455 A JP2005377455 A JP 2005377455A JP 4591777 B2 JP4591777 B2 JP 4591777B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- self
- recognized
- confidence level
- traveling
- 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
Links
Images
Description
本発明は、ナビゲーション装置等に採用される自位置認識システムに関する。 The present invention relates to a local position recognition system employed in a navigation device or the like.
自位置の正確な認識は、ナビゲーション装置、走行制御装置等にとって非常に重要な事項である。
自位置の認識システムとしては、所謂、自律航法システムが知られているとともに、GPS情報等の他者からの情報に基づいて自位置を認識する他律航法システムも知られている。さらに、走行路に沿って位置される地物(例えば、交差点にある停止線・走行路に沿って引かれている白線(実線・破線等を含む))等を、撮像情報から認識し、これら地物の位置から自位置を認識するシステムも採用されつつある。
これら3種のシステムは、基本的に自車側で検出可能な情報から自位置を認識・決定するシステムである。
Accurate recognition of the own position is a very important matter for navigation devices, travel control devices, and the like.
As a self-recognition system, a so-called autonomous navigation system is known, and another navigation system for recognizing the self-position based on information from others such as GPS information is also known. In addition, the features located along the road (for example, stop lines at intersections, white lines drawn along the road (including solid lines, broken lines, etc.)) are recognized from the imaging information, and these A system for recognizing its own position from the position of a feature is also being adopted.
These three types of systems are basically systems that recognize and determine the position of the vehicle from information that can be detected by the vehicle.
一方、自車以外の他車の有する情報から自位置を認識・決定しようとするシステムも提案されている。
特許文献1に開示される技術がこの種の技術であり、この文献に開示の技術では、前方車の位置情報に基づいて、後方車は自位置を認識・決定する。この技術では、他車の情報を利用することで、一群の車両の位置関係を良好に認識できる。
On the other hand, a system for recognizing / determining its own position from information possessed by other vehicles other than the own vehicle has also been proposed.
The technology disclosed in
しかしながら、自車が検出できる情報のみを基準として自位置を決定しようとすると、それらシステム固有の認識限界を超えることはできない。
例えば、自律航法センサから得られる情報から、自車の移動軌跡を逐次演算して逐次自位置を認識するシステムでは、走行距離の増加に伴って認識誤差が蓄積され、その確からしさが走行距離の増加に伴って低下することがよく知られている。
GPS情報等を使用する他律航法の場合は、GPS情報から得られる位置情報の精度限界が、確からしさの限界となる。
一方、地物の位置から自位置を認識するシステムにあっては、地物が存在する位置において自位置認識を行うため、その精度は高く、確からしさをかなり高いものとできるが、自位置認識に使用できる地物が常時、走行路に沿って存在するわけではない。
However, if the position of the vehicle is determined based only on information that can be detected by the vehicle, the recognition limit inherent in those systems cannot be exceeded.
For example, in a system that recognizes the position of the vehicle by sequentially calculating the movement trajectory of the vehicle from information obtained from the autonomous navigation sensor, recognition errors accumulate as the travel distance increases, and the probability of the travel distance increases. It is well known that it decreases with an increase.
In the case of other navigation using GPS information or the like, the accuracy limit of the position information obtained from the GPS information is the limit of the probability.
On the other hand, in a system that recognizes its own position from the position of the feature, its position is recognized at the position where the feature exists, so its accuracy is high and the probability is quite high. The features that can be used are not always along the road.
そこで、先にも示したように、他車の位置情報を自位置の認識に使用することが試みられるようになっている。例えば、特許文献1に開示されている技術は、前方車両の持つ位置情報を後方車両が自車の自位置の認識に使用しようとするものであるが、使用しようとする前方車両の自位置の確からしさ、精度に関しては、何ら考慮されていない。
Thus, as previously indicated, attempts have been made to use the position information of other vehicles for recognition of the own position. For example, in the technique disclosed in
従って、前方車両の位置情報、車間距離とで一意的に自車の位置補正を行うと、前方車両の位置情報の精度が必ずしも高いものとは限らず、良好でない前方車両の位置情報から自車の自位置を認識・決定することとなり、自位置認識の精度が悪化してしまう。 Therefore, if the position of the host vehicle is uniquely corrected based on the position information of the preceding vehicle and the inter-vehicle distance, the accuracy of the position information of the preceding vehicle is not always high, and the position of the preceding vehicle is not necessarily good. The self-position is recognized and determined, and the accuracy of self-position recognition deteriorates.
本発明の目的は、他車の有する自位置に関する情報に基づいて、自位置を認識するシステムにおいて、位置精度が高く、認識される自位置の確からしさを高く維持できる自位置認識システムを得ることにある。 An object of the present invention is to provide a self-recognition system capable of maintaining a high position accuracy and a high probability of a recognized self-position in a system for recognizing the self-position based on information on the self-position of another vehicle. It is in.
上記目的を達成するための本発明に係る、
各車両に、自位置の認識を行う自位置認識手段と、前記自位置認識手段により認識される自位置を補正する補正手段とを備え、
車両間で情報通信を行う車車間通信手段を備える自位置認識システムの特徴構成は、
各車両に、自位置の確からしさの指標である自信度を演算する自信度演算手段を備え、
前記車車間通信手段を介して、送信車両から受信車両に、送信車両の自位置及び自信度を送信可能に構成されるとともに、前記受信車両に対する送信車両の相対位置関係を検出する位置関係検出手段を備え、
前記車車間通信手段を介して送られてくる送信車両の自信度と、受信車両が認識している自信度とを比較する自信度比較手段を備え、
前記送信車両の自信度が、受信車両の自信度より高い場合に、前記補正手段が、送信車両の自位置及び前記相対位置関係に基づいて自位置の補正を行い、
前記自位置が走行レーン単位で認識され、前記自信度が自車が走行していると認識している認識走行レーンの確からしさを示す指標であり、前記相対位置関係が、車両間における各車両が走行している走行レーン間の関係であり、
前記送信車両が自車の周囲を走行している周囲車両で、前記受信車両が自車であり、前記周囲車両が認識している認識走行レーンと、前記自車が走行している走行レーンと前記周囲車両が走行している走行レーンとの関係に基づいて、自位置を補正するものである。
According to the present invention for achieving the above object,
Each vehicle includes own position recognition means for recognizing the own position, and correction means for correcting the own position recognized by the own position recognition means,
The characteristic configuration of the self-position recognition system including vehicle-to-vehicle communication means for performing information communication between vehicles is as follows:
Each vehicle is equipped with a confidence level calculation means for calculating the confidence level, which is an index of the likelihood of its own position.
A positional relationship detecting unit configured to transmit the own position and the degree of confidence of the transmitting vehicle from the transmitting vehicle to the receiving vehicle via the inter-vehicle communication unit, and detecting a relative positional relationship of the transmitting vehicle with respect to the receiving vehicle. With
Comprising confidence degree comparison means for comparing the confidence level of the transmitting vehicle sent via the inter-vehicle communication means and the confidence level recognized by the receiving vehicle,
Confidence of the transmission vehicle is higher than the confidence level of the receiving vehicle, wherein the correction means have lines to correct the current position based on the vehicle position and the relative positional relationship of the transmission vehicle,
The own position is recognized in units of driving lanes, and the degree of confidence is an index indicating the probability of a recognized driving lane in which the own vehicle is driving, and the relative positional relationship is determined by each vehicle between vehicles. Is the relationship between the driving lanes
The transmission vehicle is a surrounding vehicle traveling around the vehicle, the receiving vehicle is the vehicle, a recognition traveling lane recognized by the surrounding vehicle, and a traveling lane in which the vehicle is traveling The self-position is corrected based on the relationship with the traveling lane in which the surrounding vehicle is traveling .
この自位置認識システムにおける自位置の認識方法は、以下の手順を経るものとなる。
即ち、各車両で、自位置の認識を行う自位置認識工程と、前記自位置認識工程で認識される自位置を補正する自位置補正工程とを実行し、
車両間で情報通信を行う自位置認識方法の特徴手段は、
各車両で、自位置の確からしさの指標である自信度を演算する自信度演算工程を実行し、
送信車両から受信車両に、送信車両の自位置及び自信度を送信し、前記受信車両に対する送信車両の相対位置関係を検出する位置関係検出工程を実行し、
前記送られてくる送信車両の自信度と、受信車両が認識している自信度とを比較する自信度比較工程を実行し、
前記送信車両の自信度が、受信車両の自信度より高い場合に、前記自位置補正工程において、送信車両の自位置及び前記相対位置関係に基づいて自位置の補正を行い、
前記自位置が走行レーン単位で認識され、前記自信度が自車が走行していると認識している認識走行レーンの確からしさを示す指標であり、前記相対位置関係が、車両間における各車両が走行している走行レーン間の関係であり、
前記送信車両が自車の周囲を走行している周囲車両で、前記受信車両が自車であり、前記周囲車両が認識している認識走行レーンと、前記自車が走行している走行レーンと前記周囲車両が走行している走行レーンとの関係に基づいて、自位置を補正するものである。
The self position recognition method in this self position recognition system goes through the following procedure.
That is, in each vehicle, a self-position recognition process for recognizing the self-position and a self-position correction process for correcting the self-position recognized in the self-position recognition process are performed.
The characteristic means of the own position recognition method for performing information communication between vehicles is as follows:
In each vehicle, execute a confidence level calculation process to calculate the confidence level, which is an index of the accuracy of the position of the vehicle,
Transmitting the own position and confidence of the transmitting vehicle from the transmitting vehicle to the receiving vehicle, and performing a positional relationship detection step of detecting a relative positional relationship of the transmitting vehicle with respect to the receiving vehicle;
Performing a confidence level comparison step of comparing the confidence level of the transmitted vehicle and the confidence level recognized by the receiving vehicle;
Confidence of the transmission vehicle is higher than the confidence level of the receiving vehicle, in the current position correction step, have lines to correct the current position based on the vehicle position and the relative positional relationship of the transmission vehicle,
The own position is recognized in units of driving lanes, and the degree of confidence is an index indicating the probability of a recognized driving lane in which the own vehicle is driving, and the relative positional relationship is determined by each vehicle between vehicles. Is the relationship between the driving lanes
The transmission vehicle is a surrounding vehicle traveling around the vehicle, the receiving vehicle is the vehicle, a recognition traveling lane recognized by the surrounding vehicle, and a traveling lane in which the vehicle is traveling The self-position is corrected based on the relationship with the traveling lane in which the surrounding vehicle is traveling.
また、上記目的を達成するための本発明に係る、 Further, according to the present invention for achieving the above object,
各車両に、自位置の認識を行う自位置認識手段と、前記自位置認識手段により認識される自位置を補正する補正手段とを備え、 Each vehicle includes own position recognition means for recognizing the own position, and correction means for correcting the own position recognized by the own position recognition means,
車両間で情報通信を行う車車間通信手段を備える自位置認識システムの特徴構成は、 The characteristic configuration of the self-position recognition system including vehicle-to-vehicle communication means for performing information communication between vehicles is as follows:
各車両に、自位置の確からしさの指標である自信度を演算する自信度演算手段を備え、 Each vehicle is equipped with a confidence level calculation means for calculating the confidence level, which is an index of the likelihood of its own position.
前記車車間通信手段を介して、送信車両から受信車両に、送信車両の自位置及び自信度を送信可能に構成されるとともに、前記受信車両に対する送信車両の相対位置関係を検出する位置関係検出手段を備え、 A positional relationship detecting unit configured to transmit the own position and the degree of confidence of the transmitting vehicle from the transmitting vehicle to the receiving vehicle via the inter-vehicle communication unit, and detecting a relative positional relationship of the transmitting vehicle with respect to the receiving vehicle. With
前記車車間通信手段を介して送られてくる送信車両の自信度と、受信車両が認識している自信度とを比較する自信度比較手段を備え、 Comprising confidence degree comparison means for comparing the confidence level of the transmitting vehicle sent via the inter-vehicle communication means and the confidence level recognized by the receiving vehicle,
前記送信車両の自信度が、受信車両の自信度より高い場合に、前記補正手段が、送信車両の自位置及び前記相対位置関係に基づいて自位置の補正を行い、 When the confidence level of the transmitting vehicle is higher than the confidence level of the receiving vehicle, the correction means corrects the own position based on the own position of the transmitting vehicle and the relative positional relationship,
前記自位置が走行路単位で認識され、前記自信度が自車が走行していると認識している認識走行路の確からしさを示す指標であり、前記相対位置関係が、車両間における各車両が走行している走行路間の関係であり、 The self-position is recognized on a road-by-road basis, and the degree of confidence is an index indicating the certainty of the recognized road that the car is running, and the relative positional relationship is determined by each vehicle between vehicles. Is the relationship between the traveling roads,
前記送信車両が自車の周囲を走行している周囲車両で、前記受信車両が自車であり、前記周囲車両が認識している認識走行路と、前記自車が走行している走行路と前記周囲車両が走行している走行路との関係に基づいて、自位置を補正するものである。 The transmitting vehicle is a surrounding vehicle traveling around the own vehicle, the receiving vehicle is the own vehicle, the recognized traveling path recognized by the surrounding vehicle, and the traveling path on which the own vehicle is traveling The self position is corrected based on the relationship with the travel path on which the surrounding vehicle is traveling.
この自位置認識システムにおける自位置の認識方法は、以下の手順を経るものとなる。 The self position recognition method in this self position recognition system goes through the following procedure.
即ち、各車両で、自位置の認識を行う自位置認識工程と、前記自位置認識工程で認識される自位置を補正する自位置補正工程とを実行し、 That is, in each vehicle, a self-position recognition process for recognizing the self-position and a self-position correction process for correcting the self-position recognized in the self-position recognition process are performed.
車両間で情報通信を行う自位置認識方法の特徴手段は、 The characteristic means of the self-position recognition method for performing information communication between vehicles is as follows:
各車両で、自位置の確からしさの指標である自信度を演算する自信度演算工程を実行し、 In each vehicle, execute a confidence level calculation process to calculate the confidence level, which is an index of the accuracy of the position of the vehicle,
送信車両から受信車両に、送信車両の自位置及び自信度を送信し、前記受信車両に対する送信車両の相対位置関係を検出する位置関係検出工程を実行し、 Transmitting the own position and confidence of the transmitting vehicle from the transmitting vehicle to the receiving vehicle, and performing a positional relationship detection step of detecting a relative positional relationship of the transmitting vehicle with respect to the receiving vehicle;
前記送られてくる送信車両の自信度と、受信車両が認識している自信度とを比較する自信度比較工程を実行し、 Performing a confidence level comparison step of comparing the confidence level of the transmitted vehicle and the confidence level recognized by the receiving vehicle;
前記送信車両の自信度が、受信車両の自信度より高い場合に、前記自位置補正工程において、送信車両の自位置及び前記相対位置関係に基づいて自位置の補正を行い、When the confidence level of the transmitting vehicle is higher than the confidence level of the receiving vehicle, in the own position correction step, the own position is corrected based on the own position of the transmitting vehicle and the relative positional relationship,
前記自位置が走行路単位で認識され、前記自信度が自車が走行していると認識している認識走行路の確からしさを示す指標であり、前記相対位置関係が、車両間における各車両が走行している走行路間の関係であり、 The self-position is recognized on a road-by-road basis, and the degree of confidence is an index indicating the certainty of the recognized road that the car is running, and the relative positional relationship is determined by each vehicle between vehicles. Is the relationship between the traveling roads,
前記送信車両が自車の周囲を走行している周囲車両で、前記受信車両が自車であり、前記周囲車両が認識している認識走行路と、前記自車が走行している走行路と前記周囲車両が走行している走行路との関係に基づいて、自位置を補正するものである。 The transmitting vehicle is a surrounding vehicle traveling around the own vehicle, the receiving vehicle is the own vehicle, the recognized traveling path recognized by the surrounding vehicle, and the traveling path on which the own vehicle is traveling The self position is corrected based on the relationship with the travel path on which the surrounding vehicle is traveling.
このシステムでは、送信車両と受信車両との両方の車両で、自ら認識する自位置の自信度が求められる。即ち、自ら自位置と認識している認識自体の確からしさの指標である自信度が、各車両で保有される。ここで、自位置としては、後に実施の形態で示すように、走行路に沿った方向での位置、走行路の巾方向の位置、或いは、走行していると認識している走行路自体(走行路識別名等で識別された走行路)であったりする。 In this system, the self-confidence level of the self-position recognized by both the transmitting vehicle and the receiving vehicle is required. That is, each vehicle has a degree of confidence that is an index of the certainty of the recognition that it recognizes as its own position. Here, as the own position, as will be shown later in the embodiment, the position in the direction along the traveling path, the position in the width direction of the traveling path, or the traveling path recognized as traveling ( Or a travel path identified by a travel path identification name or the like.
そして、このシステムでは、送信車両から受信車両に、送信車両が認識している自位置及びその自信度が送信される。そして、先ず、自信度間の比較が実行される。このようにすることで、送信車両側と受信車両側との間で、自信度の高い側の車両が何れの車両かが判明する。そして、本願にあっては、自信度が高い側の車両の自位置を基準に、受信車両の自位置が補正される。この時、送信車両と受信車両との位置関係は、別途求めることとしておき、送信車両が認識している自位置と車両間の位置関係とに基づいて、受信車両の自位置を求める。結果、受信車両の自位置を精度の高いものとできる。 In this system, the own position recognized by the transmitting vehicle and the degree of confidence thereof are transmitted from the transmitting vehicle to the receiving vehicle. First, a comparison between confidence levels is performed. By doing in this way, it becomes clear which vehicle is the vehicle of the high confidence level between the transmitting vehicle side and the receiving vehicle side. And in this application, the own position of a receiving vehicle is correct | amended on the basis of the own position of the vehicle of the side with high confidence. At this time, the positional relationship between the transmitting vehicle and the receiving vehicle is determined separately, and the receiving vehicle's own position is determined based on the own position recognized by the transmitting vehicle and the positional relationship between the vehicles. As a result, the position of the receiving vehicle can be made highly accurate.
従って、このシステムでは、各車両が認識している自位置と、その自位置の確度(信頼性)に基づいて、車両群を成す各車両の自位置を補正・決定するため、位置精度が高いものとなり、自位置に関する情報を使用するナビゲーション、走行制御等を従来より的確なものとできる。 Therefore, this system corrects and determines the own position of each vehicle constituting the vehicle group based on the own position recognized by each vehicle and the accuracy (reliability) of the own position, so that the position accuracy is high. As a result, navigation, travel control, and the like that use information about its own position can be made more accurate than before.
また、このシステムでは、自位置を走行路単位で認識し(本願にあっては、このようにして認識される走行路を認識走行路と呼ぶ)、自信度を、この認識の確からしさに係る指標とし、さらに、相対位置関係として、各車両が走行している走行路間の関係を相対位置関係でとして求めることで、送信車両の認識走行路から受信車両の認識走行路を補正・決定することができ、走行している走行路の特定を良好に行える。
この種の走行路の認定は、例えば、並行に走っている並行路が存在し、並行路間で走行している走行路の特定が困難を伴う場合に有効な認識判定技術を与えることができる。
In this system, the self-position is recognized in units of travel paths (in the present application, the travel paths recognized in this way are called recognition travel paths), and the degree of confidence is related to the probability of the recognition. As an index, and as a relative positional relationship, the relationship between the traveling paths on which each vehicle is traveling is obtained as a relative positional relationship, thereby correcting and determining the recognized traveling path of the receiving vehicle from the recognized traveling path of the transmitting vehicle. Therefore, it is possible to satisfactorily identify the traveling road that is running.
This type of travel path authorization can provide an effective recognition / determination technique when, for example, there are parallel roads running in parallel and it is difficult to identify the travel roads running between the parallel roads. .
この場合、特徴手段としては、前記自位置が走行路単位で認識され、前記自信度が自車が走行していると認識している認識走行路の確からしさを示す指標であり、前記相対位置関係が、車両間における各車両が走行している走行路間の関係であるとして、認識方法は成立する。 In this case, as the characteristic means, the self-position is recognized in units of travel roads, and the degree of confidence is an index indicating the probability of the recognized travel road recognized that the vehicle is traveling, and the relative position The recognition method is established assuming that the relationship is the relationship between the traveling paths on which the vehicles are traveling among the vehicles.
また、このシステムでは、自車周りに存する周囲車両の保有する情報を利用して、自信度が高い、自車が走行している走行路を特定する情報である認識走行路情報を得ることができる。 In addition, in this system, it is possible to obtain recognized travel path information that is information that identifies a travel path on which the host vehicle is traveling with high confidence by using information held by surrounding vehicles existing around the host vehicle. it can.
この場合、特徴手段は、前記送信車両が自車の周囲を走行している周囲車両で、前記受信車両が自車であり、前記周囲車両が認識している認識走行路と、前記自車が走行している走行路と前記周囲車両が走行している走行路との関係に基づいて、自位置を補正することとなる。 In this case, the characteristic means is a surrounding vehicle in which the transmitting vehicle is traveling around the own vehicle, the receiving vehicle is the own vehicle, a recognized traveling path recognized by the surrounding vehicle, and the own vehicle is The own position is corrected based on the relationship between the traveling road on which the vehicle is traveling and the traveling road on which the surrounding vehicle is traveling.
このシステム構成で採用される送信側の車両に搭載されるべきシステム構成は、以下の構成となる。
即ち、送信側のシステムである自位置認識用送信システムは、
自位置の認識を行う自位置認識手段、前記自位置認識手段により認識される自位置を補正する補正手段、及び車両間で情報通信を行う車車間通信手段を備え、
前記自位置の確からしさの指標である自信度を求める自信度演算手段を備え、
前記車車間通信手段を介して、受信車両に、自車の自位置及び自信度を送信可能に構成され、
前記自位置が走行レーン単位で認識され、前記自信度が自車が走行していると認識している認識走行レーンの確からしさを示す指標であるものとなる。
The system configuration to be mounted on the transmission-side vehicle employed in this system configuration is as follows.
That is, the transmission system for self-position recognition that is the system on the transmission side is
A self-position recognition means for recognizing the self-position, a correction means for correcting the self-position recognized by the self-position recognition means, and a vehicle-to-vehicle communication means for performing information communication between vehicles;
Comprising a confidence level calculating means for obtaining a confidence level that is an index of the probability of the self-position,
Via the vehicle-to-vehicle communication means, the receiving vehicle is configured to be able to transmit its own position and confidence level ,
The self-position is recognized in units of travel lanes, and the confidence level is an index indicating the probability of the recognized travel lane recognized that the vehicle is traveling.
また、このシステム構成で採用される送信側の車両に搭載されるべきシステム構成は、以下の構成となる。 Further, the system configuration to be mounted on the transmission-side vehicle employed in this system configuration is as follows.
即ち、送信側のシステムである自位置認識用送信システムは、 That is, the transmission system for self-position recognition that is the system on the transmission side is
自位置の認識を行う自位置認識手段、前記自位置認識手段により認識される自位置を補正する補正手段、及び車両間で情報通信を行う車車間通信手段を備え、 A self-position recognition means for recognizing the self-position, a correction means for correcting the self-position recognized by the self-position recognition means, and a vehicle-to-vehicle communication means for performing information communication between vehicles;
前記自位置の確からしさの指標である自信度を求める自信度演算手段を備え、 Comprising a confidence level calculating means for obtaining a confidence level that is an index of the probability of the self-position,
前記車車間通信手段を介して、受信車両に、自車の自位置及び自信度を送信可能に構成され、 Via the vehicle-to-vehicle communication means, the receiving vehicle is configured to be able to transmit its own position and confidence level,
前記自位置が走行路単位で認識され、前記自信度が自車が走行していると認識している認識走行路の確からしさを示す指標であるものとなる。 The self-position is recognized in units of travel roads, and the confidence level is an index indicating the certainty of the recognized travel roads that the vehicle is recognizing.
一方、受信側であり、自位置の補正を状況に応じて行う自位置認識用受信システムの構成は、これが、自位置の認識を行う自位置認識手段と、前記自位置認識手段により認識される自位置を補正する補正手段及び、車両間で情報通信を行う車車間通信手段を備え、
前記自位置の確からしさの指標である自信度を求める自信度演算手段を備え、
前記車車間通信手段を介して、送信車両から送られてくる送信車両の自位置及び自信度を受信可能に構成されるとともに、自車に対する送信車両の相対位置関係を検出する位置関係検出手段を備え、
前記車車間通信手段を介して送られてくる送信車両の自信度と、自車が認識している自信度とを比較する自信度比較手段を備え、
前記送信車両の自信度が、自車の自信度より高い場合に、前記補正手段が、送信車両の自位置及び前記相対位置関係に基づいて自位置の補正を行い、
前記自位置が走行レーン単位で認識され、前記自信度が自車が走行していると認識している認識走行レーンの確からしさを示す指標であり、前記相対位置関係が、車両間における各車両が走行している走行レーン間の関係であり、
前記送信車両が自車の周囲を走行している周囲車両で、前記周囲車両が認識している認識走行レーンと、前記自車が走行している走行レーンと前記周囲車両が走行している走行レーンとの関係に基づいて、自位置を補正するものとできる。
On the other hand, the configuration of the reception system for self-position recognition that is the reception side and performs self-position correction according to the situation is recognized by the self-position recognition means for recognizing the self-position and the self-position recognition means. Correction means for correcting the own position, and vehicle-to-vehicle communication means for performing information communication between vehicles,
Comprising a confidence level calculating means for obtaining a confidence level that is an index of the probability of the self-position,
A positional relationship detecting unit configured to be able to receive the own position and the degree of confidence of the transmitting vehicle transmitted from the transmitting vehicle via the inter-vehicle communication unit, and to detect a relative positional relationship of the transmitting vehicle with respect to the own vehicle. Prepared,
Comprising a confidence level comparison means for comparing the confidence level of the transmission vehicle sent through the vehicle-to-vehicle communication means and the confidence level recognized by the own vehicle;
Confidence of the transmission vehicle is higher than the confidence of the vehicle, wherein the correction means have lines to correct the current position based on the vehicle position and the relative positional relationship of the transmission vehicle,
The own position is recognized in units of driving lanes, and the degree of confidence is an index indicating the probability of a recognized driving lane in which the own vehicle is driving, and the relative positional relationship is determined by each vehicle between vehicles. Is the relationship between the driving lanes
The surrounding vehicle in which the transmitting vehicle is traveling around the vehicle, the recognized traveling lane recognized by the surrounding vehicle, the traveling lane in which the vehicle is traveling, and the traveling in which the surrounding vehicle is traveling The own position can be corrected based on the relationship with the lane.
また、受信側であり、自位置の補正を状況に応じて行う自位置認識用受信システムの構成は、これが、自位置の認識を行う自位置認識手段と、前記自位置認識手段により認識される自位置を補正する補正手段及び、車両間で情報通信を行う車車間通信手段を備え、 Further, the configuration of the receiving system for self-position recognition which is the receiving side and corrects the self-position according to the situation is recognized by the self-position recognition means for recognizing the self-position and the self-position recognition means. Correction means for correcting the own position, and vehicle-to-vehicle communication means for performing information communication between vehicles,
前記自位置の確からしさの指標である自信度を求める自信度演算手段を備え、 Comprising a confidence level calculating means for obtaining a confidence level that is an index of the probability of the self-position,
前記車車間通信手段を介して、送信車両から送られてくる送信車両の自位置及び自信度を受信可能に構成されるとともに、自車に対する送信車両の相対位置関係を検出する位置関係検出手段を備え、 A positional relationship detecting unit configured to be able to receive the own position and the degree of confidence of the transmitting vehicle transmitted from the transmitting vehicle via the inter-vehicle communication unit, and to detect a relative positional relationship of the transmitting vehicle with respect to the own vehicle. Prepared,
前記車車間通信手段を介して送られてくる送信車両の自信度と、自車が認識している自信度とを比較する自信度比較手段を備え、 Comprising a confidence level comparison means for comparing the confidence level of the transmission vehicle sent through the vehicle-to-vehicle communication means and the confidence level recognized by the own vehicle;
前記送信車両の自信度が、自車の自信度より高い場合に、前記補正手段が、送信車両の自位置及び前記相対位置関係に基づいて自位置の補正を行い、When the confidence level of the transmission vehicle is higher than the confidence level of the own vehicle, the correction means corrects the own position based on the own position of the transmission vehicle and the relative positional relationship,
前記自位置が走行路単位で認識され、前記自信度が自車が走行していると認識している認識走行路の確からしさを示す指標であり、前記相対位置関係が、車両間における各車両が走行している走行路間の関係であり、 The self-position is recognized on a road-by-road basis, and the degree of confidence is an index indicating the certainty of the recognized road that the car is running, and the relative positional relationship is determined by each vehicle between vehicles. Is the relationship between the traveling roads,
前記送信車両が自車の周囲を走行している周囲車両で、前記周囲車両が認識している認識走行路と、前記自車が走行している走行路と前記周囲車両が走行している走行路との関係に基づいて、自位置を補正するものとできる。 The surrounding vehicle in which the transmitting vehicle is traveling around the own vehicle, the recognized traveling path recognized by the surrounding vehicle, the traveling path in which the own vehicle is traveling, and the traveling in which the surrounding vehicle is traveling The own position can be corrected based on the relationship with the road.
さて、以上の構成の自位置認識システムにおいて、 In the self-position recognition system having the above configuration,
前記自信度演算手段が、前記自位置認識手段により自位置の認識が行われた場合に、認識事例に応じて、認識事例毎に予め設定された所定値だけ自信度を増加又は減少することが好ましい。 The self-confidence degree calculating means may increase or decrease the self-confidence degree by a predetermined value set in advance for each recognition case according to the recognition case when the self-position recognition means recognizes the self-position. preferable.
また、以上説明してきた構成において、前記自位置認識手段が、前記走行路に沿って認識可能な地物の位置情報、GPS情報あるいは、自律航法センサから検出される検出情報のいずれか一種以上から、自位置の認識が可能に構成されることが好ましい。
これら一種以上の情報に基づいて、自位置認識手段が自位置を認識することで、自車で得られる情報に従った自位置の認識を実行できる。
Further, in the configuration described above, the self position recognizing means is based on at least one of position information of the feature recognizable along the travel path, GPS information, or detection information detected from the autonomous navigation sensor. It is preferable that recognition of the own position is possible.
Based on the one or more types of information, the self-position recognition unit recognizes the self-position so that the self-position can be recognized according to the information obtained by the own vehicle.
以下、本発明の実施の形態に関して、図面を使用して説明する。
本明細書にあっては、認識対象となる自位置が、車が走行路に沿って走行している状況における走行方向に沿った走行路上の位置である第一実施の形態、走行方向に対してその巾方向での位置であり、具体的には走行レーンrを認識する第二実施の形態、並行路等、複数の走行路を自車が走行していると認識される可能性がある状況において、実際に走行している走行路がどの走行路であるかを認識対象とする第三実施の形態に関して、順に紹介する。
第二実施の形態、第三実施の形態は、それぞれ、第一実施の形態で実行可能な走行路に沿った方向での自位置の認識機能に加えて、走行路巾方向の認識、走行路自体の認識が可能となっているため、第二実施の形態、第三実施の形態の説明では、追加的な機能に関して説明する。
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
In the present specification, the self-position to be recognized is a position on the travel path along the travel direction in a situation where the vehicle travels along the travel path, relative to the travel direction. The position in the width direction, specifically the second embodiment for recognizing the travel lane r, there is a possibility that the vehicle is recognized as traveling on a plurality of travel paths such as parallel roads. In the situation, the third embodiment in which the traveling road that is actually traveling is recognized will be introduced in order.
In the second embodiment and the third embodiment, in addition to the function of recognizing the own position in the direction along the travel path that can be executed in the first embodiment, the recognition of the travel path width direction, the travel path, respectively. Since the device itself can be recognized, additional functions will be described in the description of the second embodiment and the third embodiment.
これらの実施の形態において、自位置補正の実行に際して、自車Ci内で、予め自位置が認識されているとともに、この自位置の自信度が求められており、他車Coから、他車Coが認識している自位置とその自信度とを受信して、先ず、自信度間の比較を行い、他車Coの自信度が自車の自信度より高い場合にのみ、他車Coの自位置に基づいて自車Ciの自位置を補正行う点において、共通する。 In these embodiments, when executing the own position correction, the own position is recognized in advance in the own car Ci, and the degree of confidence of the own position is obtained. First, the self-recognized position and the degree of confidence are received. First, a comparison is made between the confidence levels, and only when the confidence level of the other vehicle Co is higher than the confidence level of the own vehicle Co This is common in that the position of the vehicle Ci is corrected based on the position.
1 第一実施の形態
この実施の形態は、認識対象となる自位置が走行方向に沿った走行路R上の位置である例であり、例えば、図5、図6に示すように、紙面上下方向における走行路R上の位置を認識する例である。これらの図は、走行路Rを下から上に車が走行している状態を示している。
図上、上側に図示される車が、これまで説明してきた他車Coに相当し、下側に図示される車が、自車Ciに相当する。従って、これらの例では、下側に図示される自車Ciにおいて、他車Coからの自位置情報に基づいて、自位置の補正を行うか否かが問題となる。
1 First Embodiment This embodiment is an example in which the subject position to be recognized is a position on the traveling path R along the traveling direction. For example, as shown in FIGS. It is an example which recognizes the position on the driving path R in a direction. These drawings show a state where the vehicle is traveling on the traveling path R from the bottom to the top.
In the drawing, the car shown on the upper side corresponds to the other car Co described so far, and the car shown on the lower side corresponds to the host vehicle Ci. Therefore, in these examples, whether or not to correct the own position based on the own position information from the other vehicle Co in the own vehicle Ci illustrated in the lower side becomes a problem.
この実施形態における、自車側の自位置認識システム1の形態を図1に示した。
自位置認識システム1は、自車Ciの自位置を決定するためのシステムとして構築されており、この自位置認識システム1により求められた自位置の情報が、ナビゲーション情報を生成するためのナビゲーション装置本体2、あるいは走行制御を行うための走行制御装置3に送られ、適確に使用される。
The form of the own
The own
ナビゲーション装置本体2にあっては、例えば、自位置の情報は、現在の正確な自位置に基づいて、新たなルート探索、案内に使用されるとともに、地図上に現在位置を正確に表示するのに使用される。
走行制御装置3では、例えば、前方に停止線があり、自車Ciが停止の必要がある場合に、適確な減速制御を行うために使用される。
In the
In the traveling
自位置認識システム1は、システム本体となる演算制御装置4と、この演算制御装置4に接続された種々の附属機器を備えて構成されている。
The self-
演算制御装置4には、自律航法センサ5からの検出情報が取り込み可能に構成されている。この自律航法センサ5は、具体的には自車の向いている方位を検出するための方位センサ5aと、例えば、ドライブシャフトといった、車輪に連結されている回転体の回転数から車両の走行距離を求める距離センサ5bとを備えて構成されている。
自律航法センサ5からの検出情報は、自車の移動軌跡の演算に使用される。即ち、予め設定されている特定の時間間隔間で、距離センサ5bから判明する走行距離分だけ、方位センサ5aにより検出された方位に移動したものとして、自車の移動軌跡を求めていくことで、逐次的に自位置を求めることができる。
The arithmetic and control unit 4 is configured to be able to capture detection information from the
Detection information from the
演算制御装置4には、GPS受信機6が接続されており、逐次、GPS衛星7から送られてくるGPS情報を受信して、演算制御装置4内で、このGPS情報から、GPS情報に基づいた自位置の認識が可能となっている。GPS情報に基づいて求められる自位置は、経度及び緯度の組み合わせとして得られる情報である。
A GPS receiver 6 is connected to the arithmetic control device 4, and the GPS information sent from the
演算制御装置4には、前方カメラ8a及び後方カメラ8bからの撮像情報である画像情報が入力されるように構成されており、画像認識により、それぞれのカメラ8の撮像範囲内にある例えば地物Mを認識可能に構成されている。図8(b)が、前方カメラ8aにより撮像された画像の例である。
The arithmetic and control unit 4 is configured to receive image information that is imaging information from the
演算制御装置4には、車車間通信モジュール9(車車通信手段の一例)が接続されており、このモジュール9から車車間通信により受信された情報が入ってくるように構成されている。本願にあっては、この車車間通信で通信の対象となる情報は、他車Coである送信車両の自位置の情報およびその自信度である。
A vehicle-to-vehicle communication module 9 (an example of a vehicle-to-vehicle communication means) is connected to the arithmetic and control unit 4 and is configured to receive information received from the
演算制御装置4には、車間距離検出モジュール10(位置関係検出手段の一例)が接続されており、この車間距離検出モジュール10から、自車Ciに対する送信車両Coの相対位置情報が入ってくるように構成されている。図5、図6に示す例においては、車間距離検出モジュール10は、前方車両Coとの間の車間距離を検出する。即ち、走行路Rにおいて、その走行方向前方に存する送信車両Coと自車Ciとの間の車間距離が演算制御装置4に入力される。
The arithmetic control device 4 is connected to an inter-vehicle distance detection module 10 (an example of a positional relationship detection means), and the relative position information of the transmission vehicle Co with respect to the host vehicle Ci is input from the inter-vehicle
演算制御装置4には、データベースDBが備えられており、このデータベースDBとして、地図データベースDBmと自信度演算データベースDBcが備えられている。このデータベースDBは、例えば、ハードディスクドライブ、DVD−ROMを備えたDVDドライブ、CD−ROMを備えたCDドライブ等のように、情報を記憶可能な記録媒体とその駆動手段とを有する装置をハードウエア構成として備えている。
地図データベースDBmは、地図情報を格納したデータベースである。図2は、地図データベースDBmに格納されている地図情報の内容を示す説明図である。この図に示すように、地図データベースDBmには、地図情報として、道路ネットワークレイヤL1、道路形状レイヤL2、地物レイヤL3が格納されている。
道路ネットワークレイヤL1は、走行路Rである道路間の接続情報を示すレイヤである。具体的には、緯度及び経度で表現された地図上の位置情報を有する多数のノードNの情報と、2つのノードNを連結して道路を構成する多数のリンクLの情報とを有して構成されている。また、各リンクLは、そのリンク情報として、道路名、道路の種別(高速道路、有料道路、国道、県道等の種別)やリンク長さ等の情報を有している。
道路形状レイヤL2は、道路ネットワークレイヤL1に関連付けられて格納され、道路の形状を示すレイヤである。具体的には、2つのノードNの間(リンクL上)に配置されて緯度及び経度で表現された地図上の位置情報を有する多数の道路形状補完点Sの情報と、各道路形状補完点Sにおける道路幅Wの情報とを有して構成されている。
The calculation control device 4 is provided with a database DB, and as this database DB, a map database DBm and a confidence level calculation database DBc are provided. The database DB includes a device having a recording medium capable of storing information and its driving means, such as a hard disk drive, a DVD drive equipped with a DVD-ROM, a CD drive equipped with a CD-ROM, and the like. It is provided as a configuration.
The map database DBm is a database that stores map information. FIG. 2 is an explanatory diagram showing the contents of the map information stored in the map database DBm. As shown in this figure, the map database DBm stores a road network layer L1, a road shape layer L2, and a feature layer L3 as map information.
The road network layer L1 is a layer that indicates connection information between roads that are the traveling road R. Specifically, it has information on a large number of nodes N having position information on a map expressed by latitude and longitude, and information on a large number of links L constituting the road by connecting the two nodes N. It is configured. Each link L includes information such as a road name, a road type (a type such as an expressway, a toll road, a national road, a prefectural road), a link length, and the like as link information.
The road shape layer L2 is a layer that is stored in association with the road network layer L1 and indicates the shape of the road. Specifically, information on a number of road shape complementary points S that are located between two nodes N (on the link L) and have position information on the map expressed in latitude and longitude, and each road shape complementary point Information of the road width W in S.
地物レイヤL3は、道路ネットワークレイヤL1及び道路形状レイヤL2に関連付けられて格納され、道路上及び道路の周辺に設けられた各種地物の情報を示すレイヤである。この地物レイヤL3に格納される地物Mの情報としては、少なくともカメラ等で撮像可能な画像認識の対象となる地物Mが、その関連情報とともに格納されている。
具体的には地物Mとして、道路の路面に設けられたペイント表示の地物Mp、道路に沿って設けられた各種の道路標識Mfや信号機Ms等の立体物の地物等の各種の地物についての情報が地物レイヤL3に格納されている。ここで、ペイント表示には、例えば、車線を分ける白線(実線、破線、中央線等の区画線の種類の情報も含む。)、ゼブラゾーン、停止線、横断歩道、各レーンの進行方向を指定する進行方向別通行区分表示、速度表示等が含まれる。また、正確にはペイントによるものではないが、同じく道路の路面に設けられるマンホールもここではペイント表示に含めてもよい。また、立体物としては、各種の道路標識や信号機のほか、ガードレール、建物、電柱、看板等の道路上又は道路の周辺に設けられる様々な立体物が含まれる。
The feature layer L3 is a layer that is stored in association with the road network layer L1 and the road shape layer L2, and indicates information on various features provided on the road and in the vicinity of the road. As the information on the feature M stored in the feature layer L3, at least the feature M to be image-recognized that can be captured by a camera or the like is stored together with the related information.
Specifically, as the feature M, various features such as a feature Mp of a paint display provided on the road surface of the road, a feature of a three-dimensional object such as various road signs Mf and a traffic light Ms provided along the road, etc. Information about the object is stored in the feature layer L3. Here, for example, the white line that separates the lane (including information on the type of lane marking such as solid line, broken line, and center line), zebra zone, stop line, pedestrian crossing, and the traveling direction of each lane are specified in the paint display. The display includes a direction-by-direction traffic classification display, a speed display, and the like. In addition, although not precisely based on paint, a manhole provided on the road surface may also be included in the paint display here. In addition to various road signs and traffic lights, the three-dimensional objects include various three-dimensional objects provided on or around the road, such as guardrails, buildings, utility poles, and signboards.
この地図データベースDBmを使用することで、上記の自律航法センサ5からの走行軌跡あるいはGPS情報から求まる現在の位置(緯度・経度)に基づいて、現在の自車Ciの位置を地図上でマッチングすることができる。
さらに、この地図データベースDBmには、地物レイヤL3に様々な地物Mがその位置とともに登録されているため、先に説明したカメラ8により撮像される画像内に特定の地物Mが撮像された場合に、その地物Mの地図データベースDBmに登録された位置と、画像から判明する地物Mと自車Ciとの位置関係から、自車Ciの位置(絶対座標位置)を認識することができる。
By using this map database DBm, the current position of the vehicle Ci is matched on the map based on the current position (latitude / longitude) obtained from the travel locus from the
Further, since various features M are registered in the map database DBm together with their positions in the feature layer L3, the specific feature M is captured in the image captured by the camera 8 described above. The position (absolute coordinate position) of the vehicle Ci is recognized from the position registered in the map database DBm of the feature M and the positional relationship between the feature M and the vehicle Ci found from the image. Can do.
自信度演算データベースDBcは、得点データベースDBc1及び自信度換算データベースDBc2を備えて構成されている。
得点データベースDBc1は、以下の表1に示すように、自位置の認識のタイミングで、加算又は減算される得点(表1左欄に示す)と、その得点の事例要因(表1右欄に示す)との関係を纏めたデータテーブルである。得点の加算及び減算は、左欄に示されるプラスマイナスで決まる。
The confidence level calculation database DBc includes a score database DBc1 and a confidence level conversion database DBc2.
As shown in Table 1 below, the score database DBc1 is a score that is added or subtracted at the timing of recognition of its own position (shown in the left column of Table 1), and case factors of the score (shown in the right column of Table 1) Is a data table summarizing the relationship with The addition and subtraction of scores is determined by plus or minus shown in the left column.
表1に示す事例要因に関して例示的に説明しておくと、「道路上の地物を認識し位置補正が成された直後」に、得点が50点加算される。これは、地物Mの認識を行って位置補正をすると、その確からしさが最も増す状況となるためである。
一方、「地物認識位置補正後10m毎」に得点は5点ごと減算される。この状況は、地物認識で位置補正をした後、通常の自律航法で自位置を認識しながら走っている状況では、走行距離に応じて自信度が低下することに対応している。
GPSの受信状況に関しては、その受信状況が比較的良好な場合は、比較的高い得点を与えることができる(20点加算)が、悪い場合は、得点に変化がない(0点加算)ことを示している。
交差点右左折直後、カーブでの補正後には、それらの地点情報に基づいて、ある程度の得点を与えることができる(前者で20点加算、後者で10点加算)。一方、トンネル内において、自信度は低下する(10点減算)。さらに、カメラ等の画像認識システム、GPS受信機の故障等により自信度が低下する(前者で40点減算、後者で30点減算)。
For example, the case factors shown in Table 1 will be described. After the feature on the road is recognized and the position is corrected, 50 points are added. This is because when the feature M is recognized and the position is corrected, the probability is most increased.
On the other hand, the score is subtracted every 5 points “every 10 m after the feature recognition position correction”. This situation corresponds to the fact that after performing position correction with feature recognition and running while recognizing its own position with normal autonomous navigation, the degree of confidence decreases according to the distance traveled.
Regarding the GPS reception status, if the reception status is relatively good, a relatively high score can be given (20 points addition), but if the reception status is bad, the score does not change (0 points addition). Show.
Immediately after turning right or left at the intersection, after correction with a curve, a certain amount of points can be given based on the information on the points (the former adds 20 points and the latter adds 10 points). On the other hand, the confidence level decreases in the tunnel (10 points subtraction). Furthermore, the degree of confidence decreases due to a failure of an image recognition system such as a camera or a GPS receiver (the former subtracts 40 points and the latter subtracts 30 points).
自信度換算データベースDBc2の構造を表2に示した。
この表は、得点の積算値として得られる総得点(表2右欄)と自信度(表2左欄)との関係を示したものであり、総得点が高いほど、自信度が高く設定されていることが判る。
The structure of the confidence conversion database DBc2 is shown in Table 2.
This table shows the relationship between the total score (the right column in Table 2) and the confidence level (the left column in Table 2) obtained as the integrated value of the scores. The higher the total score, the higher the confidence level is set. You can see that
以上が、演算制御装置4に接続されている機器およびその機能の説明であるが、以下に演算制御装置4内の構成に関して説明する。
図1からも判明するように、この装置4には、自位置認識部41、自位置決定部42、自信度決定部43及び自信度比較部44が設けられている。
The above is the description of the devices connected to the arithmetic control device 4 and the functions thereof. The configuration within the arithmetic control device 4 will be described below.
As can be seen from FIG. 1, the device 4 includes a self-
自位置認識部41は、演算制御装置4に送られてくる情報から自位置の認識を実行する機能部であり、自位置決定部42は、これまで認識されていた自位置を補正して、現在の自位置として最も確からしさの高い自位置を補正・決定する機能部である。
一方、自信度決定部43は、上記のようにして決定される自位置に関する自信度を演算する機能部であり、自信度比較部44は、車車間通信モジュール9を介して送られてくる、他車Coの自信度と現在の自車Ciの自信度とを比較し、その比較結果に基づいて、自位置決定部42において、他車情報依存の補正を行い、自位置を決定するべきか否かの判定を行う機能部である。
The self-
On the other hand, the confidence
この例にあっては、自位置認識部41には、第一自位置認識手段41a、第二自位置認識手段41b及び第三自位置認識手段41cの3種の認識手段が備えられている。
第一自位置認識手段41aは、自律航法により自位置を求める手段であり、方位センサ5a及び距離センサ5bからの情報に基づいて、自車の移動軌跡を順次、自位置の認識処理タイミング毎に求め、自位置を認識する手段である。
In this example, the own
The first own
第二自位置認識手段41bは、GPS衛星から所定のタイミングで受信されるGPS情報に基づいて、自位置を認識する手段である。
The second self
第三自位置認識手段41cは、カメラ8等の撮像情報と、地図データベースDBm内に記憶されている地物Mの情報とを対比し、同一の地物Mが撮像画像内に認められた場合に、その地物Mの位置情報に基づいて自位置を認識する手段である。この手段による自位置認識は、地物Mの存在を前提とするため、地物Mが存在する地点に自車が到達したタイミングにおいてのみ、認識が行われる。
The third
自位置決定部42には、自車情報依存の自位置補正を行う自車情報依存補正手段42aと、他車情報にも基づいた自位置補正を行う他車情報依存補正手段42bが設けられている。
The own
自車情報依存補正手段42aは、過去に決定された自位置に対して、新たな自位置が自位置認識部41で認識された場合に、新たな認識情報に基づいて、現在の自位置を補正・決定する機能手段である。即ち、自位置認識部41に備えられる、それぞれの自位置認識手段41a,41b,41cは、一定のタイミング(第一自位置認識手段41aは一定の時間間隔毎、第二自位置認識手段41bはGPS情報の取り込みタイミング毎、第三自位置認識手段41cは自位置認識に使用可能な地物が画像認識される毎)で、自位置を認識するが、この決定手段42aにあっては、原則的には、第一自位置認識手段41aにより認識される自位置を補正・決定に使用しながら、第二、第三の自位置認識手段41b,41cにより認識された自位置が存在する場合は、第一自位置認識手段41aにより認識される自位置より後者手段により認識される自位置ほど優先して、自位置を補正・決定する。
The own vehicle information dependence correction means 42a determines the current own position based on the new recognition information when a new own position is recognized by the own
即ち、本例の場合、後者側ほど、自位置認識の確からしさが高いため、後者側の情報を優先して自位置の補正・決定に使用する。ここで、自位置認識の頻度は、前者側ほど高いため、第二、第三自位置認識手段41b,41cで、自位置認識が行えない状況にあっては、自律航法に基づいて認識された自位置が自動的に使用される。
このようにすることで、自車情報依存補正手段42aにおいては、常時、自車で得られる情報から自位置が補正・決定される。
That is, in the case of this example, since the probability of the self-position recognition is higher on the latter side, information on the latter side is preferentially used for correction / determination of the own position. Here, since the frequency of self-position recognition is higher in the former side, the second and third self-position recognition means 41b and 41c were recognized based on autonomous navigation in a situation where self-position recognition was not possible. Your position is automatically used.
By doing in this way, in the own vehicle information dependence correction means 42a, the own position is always corrected and determined from information obtained by the own vehicle.
他車情報依存補正手段42bは、本願独特の補正手法を実行する機能手段である。
この手段は、自車情報に基づいて自車情報依存補正手段42aにより決定された自位置に対して、他車Coの自位置が受信され、他車Coの自位置についての自信度が高いことを条件として、他車Coの自位置を基準として自車Ciの自位置を補正・決定する。
この他車情報依存補正手段42bへは、他車Coの自位置と、自車Ciと他車Coとの車間距離が入力される。そこで、この手段42bでは、他車Coの自位置を基準として、車間距離だけ離れた位置を自位置として求める。
このようにして求められた自位置は、自車情報依存補正手段42aにより決定された自位置に対して優先するものとされ、この手段42bが働く場合は、他車情報依存補正手段42bにより決定された自位置が、現在の自位置として決定される。
このように決定してよい理由は、この他車情報依存補正手段42bに位置決定に必要な情報が送られ、この手段における処理を実行する段階にあっては、自信度比較部44において他車Coの自信度が自車Ciの自信度より高いとの判定結果がでている状態だからである。
The other vehicle information dependent correction means 42b is a functional means for executing a correction method unique to the present application.
This means that the own position of the other vehicle Co is received with respect to the own position determined by the own vehicle information dependence correcting means 42a based on the own vehicle information, and the degree of confidence in the own position of the other vehicle Co is high. As a condition, the own position of the own vehicle Ci is corrected / determined based on the own position of the other vehicle Co.
The other vehicle information dependent correction means 42b receives the own position of the other vehicle Co and the distance between the own vehicle Ci and the other vehicle Co. Therefore, in this means 42b, a position separated by the inter-vehicle distance is obtained as the own position with reference to the own position of the other vehicle Co.
The self-position obtained in this way is given priority over the self-position determined by the own vehicle information dependence correction means 42a, and when this means 42b works, it is decided by the other vehicle information dependence correction means 42b. The determined own position is determined as the current own position.
The reason for this determination is that information necessary for position determination is sent to the other vehicle information dependence correction means 42b, and the confidence
自信度決定部43には、得点積算手段43aと自信度演算手段43bが備えられている。
得点積算手段43aは、自位置決定部42において自位置決定が行われる毎に、その決定状況を判定し、決定状況が得点の加算・減算に相当する状況である場合には、表1に示した得点表に従って、得点の加算・減算を実行し、これを総得点として積算する。同時に、常時実行されている自律航法による自位置の決定が行われると、表1に示すように、地物認識位置補正後、10mの走行毎に、5点の減算を行う。
この総得点には、その上限値(例えば100点)と下限値(例えば−100点)が設けられており、特定事象が連続して起こっても総得点は、一定の範囲内に収まるように構成されている。
The confidence
The score accumulating means 43a determines the determination status every time the own
The total score is provided with an upper limit value (for example, 100 points) and a lower limit value (for example, −100 points), so that the total score is within a certain range even if a specific event occurs continuously. It is configured.
この積算状況を、図3に基づいて説明する。
図3において、上図は車Cの走行状態を示しており、下図は上図に示す走行が行われた場合の総得点(得点積算値)の変化を示したものである。
上図は、車Cが右側から左側へ走行する状況を示したものであり、走行方向に、自位置を認識可能な地物Mである横断歩道Xがあり、その先にトンネルTがある状況を示している。一方、下向きの矢印は、矢印が記載されている位置で、自位置の決定が逐次なされたことを示している。この例では、最初に地物Mである横断歩道Xにより、自位置が認識・決定され、以降、自律航法による自位置認識状態がしばらく継続し、その間、2回、GPS情報が受信されて、GPS情報に基づく自位置認識、補正を行った後、トンネルTに到達している。
This integration state will be described with reference to FIG.
In FIG. 3, the upper diagram shows the traveling state of the car C, and the lower diagram shows the change in the total score (score integrated value) when the traveling shown in the upper diagram is performed.
The above figure shows the situation where the car C travels from the right side to the left side, where there is a pedestrian crossing X that is a feature M that can recognize its position in the direction of travel, and there is a tunnel T beyond that. Is shown. On the other hand, a downward arrow indicates that the position of the subject is sequentially determined at the position where the arrow is described. In this example, the position is first recognized and determined by the pedestrian crossing X, which is the feature M, and then the position recognition state by the autonomous navigation continues for a while, during which time GPS information is received twice, After the self-position recognition and correction based on the GPS information, the tunnel T is reached.
総得点の変化は、最初、総得点が0であるとして、先ず地物Mによる自位置の認識である横断歩道Xを利用した自位置認識が行われた時点で50点の加算がおこなわれる。その後、自律航法状態で、総得点は逐次減少していくが、GPS情報を利用した自位置認識が行われた時点毎に20点の加算が行われ、総得点は、図示する様なのこぎり歯状の変化となる。トンネルTに突入することで、その進入時に10点が減算されることを示している。 As for the change of the total score, first, assuming that the total score is 0, 50 points are added when the self-position recognition using the pedestrian crossing X which is the recognition of the self-position by the feature M is first performed. After that, in the autonomous navigation state, the total score gradually decreases, but 20 points are added every time the position recognition using GPS information is performed, and the total score is a sawtooth as shown in the figure. Changes. By entering the tunnel T, 10 points are subtracted when entering the tunnel T.
自信度演算手段43bは、得点積算手段43aにより積算される総得点に基づいて表2に示す自信度換算テーブルから自信度を演算する。
従って、走行状態にある車において、常時、演算された自信度が保持される。
The confidence level calculation means 43b calculates the confidence level from the confidence level conversion table shown in Table 2 based on the total score accumulated by the score accumulation means 43a.
Therefore, the calculated degree of confidence is always maintained in a vehicle in a running state.
以上が、この実施形態における演算制御装置4の構成の説明であるが、以下、図4、図5、図6に基づいて、走行方向に沿った走行路上での位置の補正に関して説明する。
説明においては、自車Ci及び他車Coの存在を前提とするが、両車Ci,Coは、自位置の認識、補正・決定を可能とする機能部、補正・決定した自位置の自信度を演算する機能部、車車通信モジュール9が備えられている。さらに、自車Ciには他車Coとの車間距離を検出するための車間距離検出モジュール10が備えられている。
図5、図6は、他車Coが先行して横断歩道Xがある位置に到達した状況を示しており、自車Ciは、他車Coに後続する状態で、他車Coに近接しようとしている。従って、他車Coは送信車両となり、自車Ciは受信車両となる。
図5、図6とは、ともに他車Coが地物Mである横断歩道Xに近づいた状況を示しているが、図5に示す状態では、地物認識が良好に行われ、横断歩道Xの位置を基準として他車Coの自位置が良好に決定された状況を示している。従って、他車Coの自信度は2から10に変更されている。
一方、図6に示す状態では、地物認識が良好に行われなかったため、横断歩道Xの位置を基準として他車Coの自位置が良好に決定されなかった状況を示している。従って、他車Coの自信度は2のままである。
The above is the description of the configuration of the arithmetic and control unit 4 in this embodiment. Hereinafter, the correction of the position on the travel path along the travel direction will be described based on FIGS. 4, 5, and 6.
In the description, it is assumed that the own vehicle Ci and the other vehicle Co exist, but both the vehicles Ci and Co have a function unit that enables recognition, correction and determination of the own position, and the degree of confidence of the corrected and determined own position. And a
5 and 6 show a situation in which the other vehicle Co has reached the position where the pedestrian crossing X is located in advance, and the host vehicle Ci tries to approach the other vehicle Co in a state of following the other vehicle Co. Yes. Therefore, the other vehicle Co is a transmitting vehicle, and the host vehicle Ci is a receiving vehicle.
5 and 6 both show a situation in which the other vehicle Co has approached the pedestrian crossing X, which is the feature M, but in the state shown in FIG. This shows a situation in which the position of the other vehicle Co is well determined with reference to the position of. Therefore, the confidence level of the other vehicle Co is changed from 2 to 10.
On the other hand, the state shown in FIG. 6 shows a situation in which the position of the other vehicle Co is not well determined based on the position of the pedestrian crossing X because the feature recognition is not performed well. Therefore, the confidence level of the other vehicle Co remains at 2.
この状態から、自車Ciと他車Coとの間における車車間通信を利用しての自車Ciの自位置の補正・決定が実行される。
図4は、この状態における自車Ciにおける処理フローを示したものである。
以下、このフローに従って、説明を進める。
処理の開始に伴って他車Co(前方車両)の情報を取得する(ステップ1)。このとき取得される情報には、他車Coの識別番号、車種、通信形態等が含まれる。他車Coの情報の取得ができず、他車Coの認識が行えない場合(ステップ2:no)は、情報取得を繰り返す。情報の取得ができ、通信を確立できた場合(ステップ2:yes)は、他車Coの自信度を取得する(ステップ3)。
そして、自信度比較部44で、他車Coと自車Ciとの自信度を比較する(ステップ4)。比較の結果、他車Coの自信度が自車Ciの自信度より高い場合(ステップ4:yes)は、他車Coの自位置の情報に基づいて自車Coの自位置を補正する処理に移る(ステップ5〜8)。
From this state, correction / determination of the own position of the own vehicle Ci using inter-vehicle communication between the own vehicle Ci and the other vehicle Co is executed.
FIG. 4 shows a processing flow in the vehicle Ci in this state.
Hereinafter, the description will proceed according to this flow.
Accompanying the start of the process, information on another vehicle Co (front vehicle) is acquired (step 1). The information acquired at this time includes an identification number of another vehicle Co, a vehicle type, a communication form, and the like. When the information on the other vehicle Co cannot be acquired and the other vehicle Co cannot be recognized (step 2: no), the information acquisition is repeated. If information can be acquired and communication can be established (step 2: yes), the confidence level of the other vehicle Co is acquired (step 3).
Then, the confidence
一方、比較の結果、他車Coの自信度が自車Ciの自信度より低い場合(ステップ4:no)は、ステップ1に戻り、他車Coの自信度が自車Ciの自信度を上回るまで、ステップ1〜4の処理を繰り返す。この状況が、図6に示される状況であり、この図では、後続車である自車Ciの自位置が他車の情報に従って補正されることはない。
On the other hand, as a result of comparison, if the confidence level of the other vehicle Co is lower than the confidence level of the own vehicle Ci (step 4: no), the process returns to step 1 and the confidence level of the other vehicle Co exceeds the confidence level of the own vehicle Ci.
図5に示すように、自車Ciの自信度が他車Coの自信度より低い場合の処理は、以下の処理を順次実行する。即ち、他車Co(前方車両)の自位置の情報を取得する(ステップ5)。そして、車間距離検出モジュール10により、他車Coと自車Ciとの車間距離を検出し、取得する(ステップ6)。引き続いて、他車情報依存補正手段42bは、このようにして得られる他車Coの自位置と車間距離から自車Ciの自位置を求め、得られた自位置を現在の位置として自車Ciの自位置を補正・決定する(ステップ7)。この補正が良好に完了した場合は、自位置の補正・決定処理を完了し(ステップ8:yes)、何らかの理由で完了できなかった場合は、ステップ5に戻って処理を実行する。完了した場合、自車Ciの自位置認識の自信度は、他車の自信度に置換する。
この状況が図5に示した状況であり、自車Ciの自信度が5から10に変更されている。
As shown in FIG. 5, in the case where the confidence level of the host vehicle Ci is lower than the confidence level of the other vehicle Co, the following processing is sequentially executed. That is, information on the own position of the other vehicle Co (front vehicle) is acquired (step 5). The inter-vehicle
This situation is the situation shown in FIG. 5, and the confidence level of the own vehicle Ci is changed from 5 to 10.
2 第二実施の形態
この実施の形態は、認識対象となる自位置が走行方向に対してその横方向での走行路上の巾方向の位置(具体的には走行レーンr)である例であり、図11、図12に示すように、走行レーンrを認識、補正・決定する例である。これらの例でも、図上、上側に図示される車が他車Coに相当し、下側に図示される車が自車Ciに相当する。従って、下側に図示される自車Ciにおいて、他車Coからの自位置に関する情報(走行レーンの情報)に基づいて、自車Ciの走行レーンrの補正を行うか否かが問題となる。
2 Second Embodiment This embodiment is an example in which the position to be recognized is the position in the width direction (specifically, the travel lane r) on the travel path in the lateral direction with respect to the travel direction. 11 and FIG. 12, this is an example of recognizing, correcting, and determining a driving lane r. Also in these examples, the car illustrated on the upper side in the figure corresponds to the other vehicle Co, and the car illustrated on the lower side corresponds to the host vehicle Ci. Therefore, in the host vehicle Ci shown in the lower side, it becomes a problem whether or not to correct the travel lane r of the host vehicle Ci based on information on the own position from the other vehicle Co (travel lane information). .
この実施形態のシステム形態を図7に示した。
本システムから得られる走行レーン情報は、先の例と同様に、ナビゲーション装置本体2あるいは走行制御装置3に送られて、的確なナビゲーション、走行制御に使用される。
The system configuration of this embodiment is shown in FIG.
Travel lane information obtained from this system is sent to the
この例にあっても、自位置認識システム1は、システム本体となる演算制御装置4と、この演算制御装置4に接続された附属機器とを備えて構成される。
Even in this example, the local
演算制御装置4には、先の例と同様に、自律航法センサ5、GPS受信機6、前方カメラ8a及び後方カメラ8bが接続されており、それぞれの機器からの検出情報が入力される。車車間通信モジュール9が接続されていることも先の例と同様である。
As in the previous example, the
先の例では、自車Ciと他車Coとの車間距離を検出するための車間距離検出モジュール9が設けられていたが、それに加えて、制御演算装置4内に、前方カメラ8a等の撮像装置からの情報である撮像情報から、画像認識処理により自車Ciと他車Coとの位置関係である車間状態を確認する位置関係検出手段としての車間状態確認手段11が備えられている。この手段11の構成に関しては、後に詳述する。
In the previous example, the inter-vehicle
演算制御装置4には、データベースDBが備えられており、このデータベースDBには、地図データベースDBmと自信度演算データベースDBcが備えられている。
地図データベースDBmは、先の例で示したと同様に図3に示すように階層化された構成を採用されており、道路ネットワークレイヤL1、道路形状レイヤL2、地物レイヤL3が格納されている。
The arithmetic and control unit 4 includes a database DB, and the database DB includes a map database DBm and a confidence level calculation database DBc.
The map database DBm has a hierarchized configuration as shown in FIG. 3 as shown in the previous example, and stores a road network layer L1, a road shape layer L2, and a feature layer L3.
この地図データベースDBmを使用することで、上記の自律航法センサ5からの走行軌跡あるいはGPS情報から求まる現在の位置(緯度・経度)に基づいて、現在の自車Ciの走行路Rに沿った位置を地図上でマッチングすることができる。
さらに、この地図データベースDBmには、地物レイヤL3に様々な地物Mがその位置とともに登録されているため、カメラ8により撮像される画像情報内に特定の地物Mの画像が含まれている場合に、その地物Mの位置情報から、自車Ciの位置(走行レーンr)を認識することができる。この実施の形態では、自車Ciが走行している走行レーンrを問題とするため、特に、路肩の位置、車線を分ける白線(実線、破線、中央線等)等の登録情報が利用される。
By using this map database DBm, based on the current position (latitude / longitude) obtained from the traveling locus from the
Further, in this map database DBm, since various features M are registered together with their positions in the feature layer L3, the image of the specific feature M is included in the image information captured by the camera 8. When the vehicle is present, the position (travel lane r) of the host vehicle Ci can be recognized from the position information of the feature M. In this embodiment, since the travel lane r in which the vehicle Ci is traveling is a problem, registration information such as the position of the shoulder and the white line (solid line, broken line, center line, etc.) that separates the lane is used. .
即ち、図8(b)に示すように、カメラ8等から得られる撮像情報における路肩G1iの位置、車線を分ける白線(実線G2i、破線G3i、中央線G4i等)の位置と、現在の自車Ciの位置において、地図データベースDBmから得られる地物Mに関する情報である、図8(a)に示すおける路肩G1dの位置、車線を分ける白線(実線G2d、破線G3d、中央線G4d等)の位置との比較により、自車Ciの走行レーンrを認識することができる。この走行レーンrの認識に関しては、第四自位置認識手段41dにおいて説明する。 That is, as shown in FIG. 8B, the position of the road shoulder G1i, the position of the white line (solid line G2i, broken line G3i, center line G4i, etc.) that separates the lane in the imaging information obtained from the camera 8, etc., and the current own vehicle At the position Ci, the position of the road shoulder G1d shown in FIG. 8 (a), the position of the white line (solid line G2d, broken line G3d, center line G4d, etc.) dividing the lane, which is information about the feature M obtained from the map database DBm. By comparing with the above, the traveling lane r of the host vehicle Ci can be recognized. The recognition of the travel lane r will be described in the fourth self position recognition means 41d.
自信度演算データベースDBcは、先の例と同様に、得点データベースDBm及び自信度換算データベースDBcを備えて構成されている。
得点データベースDBmは、走行路巾方向の自位置認識に関しては、以下の表3に示すように、走行レーンの認識タイミングで、加算又は減算される得点(表3左欄に示す)と、その得点の事例要因(表3右欄に示す)の関係を纏めたデータベースである。得点の加算及び減算は、左欄に示されるプラスマイナスに依存することとなる。
Similar to the previous example, the confidence calculation database DBc includes a score database DBm and a confidence conversion database DBc.
As shown in Table 3 below, the score database DBm adds or subtracts the score (shown in the left column of Table 3) and the score for the position recognition in the traveling road width direction as shown in Table 3 below. It is a database that summarizes the relationship of the case factors (shown in the right column of Table 3). The score addition and subtraction will depend on the plus or minus shown in the left column.
表3に示す事例要因に関して例示的に説明しておくと、「路肩、白線等々を良好に認識」できた場合に、得点が50点加算されることを示している。これは、地物の認識が確実に行われているため、正確に走行レーンが判別できる状況にあるためである。
一方、「跨ぎ判定を行い、路肩は認識、白線は未認識」の場合は、得点が30点加算されることを示している。さらに、「跨ぎ判定はできなかったが、白線を良好に認識」した場合は、得点が20点加算されることを示している。ここで、跨ぎ判定とは、後述する第四自位置認識手段41dにおいて白線を跨ぐ走行が行われた否かに基づいて行われる判定である。この判定の可否、及び路肩、白線等の認識の可否に基づいて、走行レーン認識の確からしさは、同表に示すように低くなる。
さらに、「4レーン以上の道路走行時、左右レーン白線が破線で、跨ぎ判定が行われない」状況では、得点が与えれることはない。
跨ぎ、白線、路肩の認識ができない状況では、できなくなった段階から10m走行毎に、得点5点が減算される。
さらに白線のない道路を走行している状況では、得点20点が減算される。
その他、それぞれに状況に応じて、得点の加算及び減算を行うように得点が決定されているのは、先の例と同様である。
Exemplarily explaining the case factors shown in Table 3, it indicates that 50 points are added when “the shoulder, white line, etc. can be recognized well”. This is because the lanes can be accurately identified because the feature has been reliably recognized.
On the other hand, when “crossing determination is performed and the shoulder is recognized and the white line is not recognized”, 30 points are added. Furthermore, when “the stride determination cannot be performed but the white line is recognized well”, 20 points are added. Here, the stride determination is a determination that is made based on whether or not the fourth self-position recognizing means 41d described later has traveled across the white line. Based on whether this determination is possible and whether the road shoulder, white line, etc. can be recognized, the certainty of travel lane recognition is low as shown in the table.
Furthermore, no score is given in the situation “when the road runs on four or more lanes, the white line on the left and right lanes is a broken line and the crossing determination is not performed”.
In situations where straddling, white lines, and shoulders cannot be recognized, 5 points are subtracted every 10 m from the stage where it is no longer possible.
Furthermore, in a situation where the vehicle is traveling on a road without a white line, 20 points are subtracted.
In addition, as in the previous example, the score is determined so that the score is added and subtracted depending on the situation.
自信度換算データベースDBc2の構造は先に示した表2と同様であり、その使用形態も同様である。 The structure of the confidence level conversion database DBc2 is the same as that of Table 2 shown above, and the usage pattern is also the same.
以上が、この例において、演算制御装置4に接続されている機器およびその機能の説明であるが、以下に演算制御装置4内の構成に関して説明する。
図7からも判明するように、この例にあっても、この装置4内に、自位置認識部41、自位置決定部42、自信度決定部43及び自信度比較部44が設けられている。
The above is the description of the equipment connected to the arithmetic control device 4 and the function thereof in this example. The configuration within the arithmetic control device 4 will be described below.
As can be seen from FIG. 7, even in this example, a self-
自位置認識部41は、演算制御装置4に送られてくる情報から自位置(この例の場合は走行レーン)の認識をも実行する機能部であり、自位置決定部42は、これまで認識されていた自位置を補正して、現在の自位置として最も確からしさの高い走行レーンをも決定する機能部である。
一方、自信度決定部43は、上記のようにして決定される走行レーンrに関する自信度をも演算する機能部であり、自信度比較部44は、車車間通信モジュールを介して送られてくる、他車Coの自信度と現在の自車Ciの自信度とを比較し、その比較結果に基づいて、自位置決定手段43において、他車情報依存の補正を行うか否かの判定情報を得る機能部である。
The own
On the other hand, the confidence
自位置認識部41には、先に説明した、第一自位置認識手段41a、第二自位置認識手段41b及び第三自位置認識手段41cの3種の認識手段が備えられているほか、第四自位置認識手段41dが備えられている。
第一、第二、第三自位置認識手段41a,41b,41cの機能は、走行方向に沿った自位置を認識する上で、先の第一実施の形態の場合と同様であり、説明を省略する。
The self-
The functions of the first, second, and third own
第四自位置認識手段41dは、現在、走行している走行レーンrを認識する機能部であり、この機能を果たす走行レーン決定手段411を備えている。この走行レーン決定手段411に対する補助手段として跨ぎ判定手段412が備えられており、この跨ぎ判定手段412による判定結果が、走行レーン決定手段411による走行レーンrの決定に使用できるように構成されている。 The fourth self position recognizing unit 41d is a functional unit that recognizes the currently traveling lane r, and includes a traveling lane determining unit 411 that performs this function. A stride determination unit 412 is provided as an auxiliary unit for the travel lane determination unit 411, and the determination result by the stride determination unit 412 can be used to determine the travel lane r by the travel lane determination unit 411. .
走行レーン決定手段411は、基本的には、カメラ8等からの画像情報と、地図データベースDBm内に記憶されている地物情報とを対比し、同一の地物Mが認識された場合に、その地物Mの位置情報(具体的には画像情報内で認識される白線の位置関係)に基づいて、現在の走行レーンrを認識する手段である。この手段による自位置認識は、地物Mの存在を前提とするため、地物Mが存在する地点にいるタイミングで、認識が行われる。 The traveling lane determining means 411 basically compares the image information from the camera 8 and the like with the feature information stored in the map database DBm, and when the same feature M is recognized, This is means for recognizing the current travel lane r based on the positional information of the feature M (specifically, the positional relationship of white lines recognized in the image information). Since the self position recognition by this means is based on the presence of the feature M, the recognition is performed at the timing at which the feature M exists.
この第四自位置認識手段41dによる処理は、走行方向を横断する方向での処理である。従って、走行方法に沿って決定された自位置を利用して、地図データベースDBmからその地点の道路状況に対応した地物M(路肩G1d、実線G2d、破線G3d、中央線G4dの種別、配置等)の情報を抽出し、図8に示すように、地図情報側から得られる情報(図8(a))と、画像情報から得られ情報(図8(b))とを比較する。そして、自車Ciが特定の走行レーンrにあるとした場合に撮像されるべき撮像情報と、現実に撮像された画像情報を比較対照することで、その一致度が高い場合に、その走行レーンrを自車が走行している走行レーンrを割り出すことができる。この図8では、自車Ciが左レーンを走行している状況を示している。 The process by the fourth own position recognition means 41d is a process in a direction crossing the traveling direction. Therefore, using the self-position determined in accordance with the traveling method, the feature M corresponding to the road condition at that point from the map database DBm (the type of the shoulder G1d, solid line G2d, broken line G3d, center line G4d, etc.) ) Is extracted, and the information obtained from the map information side (FIG. 8A) is compared with the information obtained from the image information (FIG. 8B) as shown in FIG. Then, when the own vehicle Ci is in a specific travel lane r, when the degree of coincidence is high by comparing and contrasting the imaging information to be captured with the image information actually captured, the travel lane The travel lane r in which the vehicle is traveling can be determined from r. FIG. 8 shows a situation where the vehicle Ci is traveling in the left lane.
この第四自位置認識手段41dには、さらに、所謂、跨ぎ判定手段412が備えられている。この判定手段412は、逐次得られる画像情報を逐次監視することで、自車Ciにより区画線の跨ぎが行われた否かを、その跨ぎ方向とともに監視する。そして、所定方向での跨ぎが行われたと判断された場合には、現在認識している走行レーンrから、移動方向にレーン間の跨ぎが行われたとして、跨ぎ後の走行レーンrを現在の走行レーンとして認識する。 The fourth self position recognizing means 41d is further provided with a so-called stride judging means 412. This determination means 412 monitors whether or not the lane marking has been straddled by the own vehicle Ci by sequentially monitoring image information obtained sequentially. If it is determined that straddling in a predetermined direction has been performed, it is assumed that straddling between lanes has been performed in the moving direction from the currently recognized travel lane r, and the travel lane r after straddling is Recognize as a driving lane.
この例にあっても、自位置決定部42には、自車情報依存の自位置補正を行う自車情報依存補正手段42aと、他車情報にも基づいた自位置補正を行う他車情報依存補正手段42bが設けられている。走行路Rに沿った自位置に決定は、第一の実施の形態と同様に行われるため、以下の説明では、走行レーンrの決定に関してのみ説明する。
Even in this example, the own
自車情報依存補正手段42aは、過去に決定された走行レーンrに対して、新たな走行レーンrが自位置認識部41で認識された場合は、新たな走行レーンrに現在の走行レーンrを補正する。この例では、自位置認識部41に備えられる第四自位置認識手段41dによる認識結果が、走行レーンrの決定に、実質上、そのまま使用される。
このようにすることで、常時、逐次的に、自車側で得られる情報から、自車Ciの走行レーンrが順次、決定される。
The own vehicle information dependence correction means 42a, when a new travel lane r is recognized by the own
By doing in this way, the driving lane r of the own vehicle Ci is sequentially determined from the information obtained on the own vehicle side sequentially and constantly.
他車情報依存補正手段42bは、自車情報に基づいて決定された走行レーンrに対して、他車Coの走行レーンr(自位置)が受信され、他車Coの走行レーンrについての自信度が高いことを条件として、他車Coの走行レーンrから自車Ciの走行レーンrを基準として自車Ciの走行レーンrを補正・決定する。
この他車情報依存補正手段42bへは、他車Coの走行レーンr、車間状態確認手段11から自車Ciと他車Coとの間における走行レーンrに関する関係情報が送られてくる。そして、この手段42bでは、他車Coの走行レーンrを基準として、自車Ciの走行レーンrを決定する。例えば、前方カメラ8aで得られた画像より、他車Coが自車Ciと同一の走行レーンrを走行していることが確認された状況で、他車Coが保有している走行レーンrの情報が、自車情報依存補正手段42aにより決定された走行レーンrに対して優先するものとされ、他車情報依存補正手段42bにより決定された走行レーンrが、現在の走行レーンrとして決定される。
The other vehicle information dependence correction means 42b receives the traveling lane r (own position) of the other vehicle Co for the traveling lane r determined based on the own vehicle information, and is confident about the traveling lane r of the other vehicle Co. On the condition that the degree is high, the travel lane r of the own vehicle Ci is corrected and determined from the travel lane r of the other vehicle Co on the basis of the travel lane r of the own vehicle Ci.
The other vehicle information
この例にあっても、自信度決定部43には、得点積算手段43aと自信度演算手段43bが備えられている。
得点積算手段43aは、自位置決定部43において走行レーン決定が行われる毎に、その決定状況を判定し、決定状況が得点に加算・減算に相当する状況である場合には、表3に示した得点表に従って、得点の加算・減算を実行し、これを総得点として積算する。但し、この例では、総得点の上限値及び下限値が設定されており、例えば、撮像情報を利用して良好に走行レーンrを認識する認識状態が連続して、比較的長い時間継続しても、総得点が上限を超えないように総得点が調整されるように構成されている。
Even in this example, the confidence
The score accumulating unit 43a determines the determination status every time the lane determination is performed in the own
この積算状況を、図9に基づいて説明する。
上図は、図3と同様に、車Cが右側から左側へ走行する状況を示したものであり、走行路Rが、路肩、白線等を良好に認識できていた走行路から、認識できなくなった状況を示しており、その後、再度、跨ぎ判定が可能となって、これを行い、その後、路肩は認識可能で白線を認識できていない状況で、さらに全く認識ができなくなり、白線のない走行路に至った状況を示している。
This integration state will be described with reference to FIG.
The upper figure shows the situation where the car C travels from the right side to the left side as in FIG. 3, and the road R can no longer be recognized from the road where the road shoulder, white line, etc. could be recognized well. After that, it is possible to make a crossover determination again, and then perform this. After that, the road shoulder is recognizable and the white line is not recognized. It shows the situation that led to the road.
総得点の変化は、最初、先ず、路肩、白線等が良好に認識されたことで、50点の総得点が確保されていた状況に対応している。その後、跨ぎ、白線、路肩を認識できなくなったことで、順次、減算が行われ、再跨ぎ判定が行われたことで、30点の加算が行われ、さらに減算が行われ、総得点は、図示する様なのこぎり歯状の変化となる。そして、白線のない走行路に至ることで、その進入時に30点が減算されることを示している。 The change in the total score corresponds to the situation where a total score of 50 points was secured first because the shoulders, white lines, etc. were first recognized well. After that, because it became impossible to recognize straddling, white line, and shoulder, subtraction was sequentially performed, and by re-crossing determination, 30 points were added, further subtraction was performed, and the total score was It becomes a sawtooth change as shown in the figure. And it has shown that 30 points are subtracted at the time of the approach by reaching the driving | running route without a white line.
自信度演算手段43bは、得点積算手段43aにより積算される総得点に基づいて表2に示す自信度換算テーブルから自信度を演算する。
従って、この例の場合も、自信度は、走行状態にある車において、常時、決定された自信度が保持されることとなる。
The confidence level calculation means 43b calculates the confidence level from the confidence level conversion table shown in Table 2 based on the total score accumulated by the score accumulation means 43a.
Accordingly, also in this example, the confidence level is always maintained in the vehicle in the running state.
車間状態確認手段11は、カメラ8等から得られる撮像情報に基づいて、自車Ciと他車Coとの間における、走行レーンrの関係を確認する手段である。即ち、撮像情報に現れた他車Coと白線との関係から、相互の車Cが走行している走行レーンrの状態を確認する。例えば、図11、12に示される状況では、自車Ci及び他車Coは、同一の白線対Mp内に存在する撮像が得られるため、同一走行レーンrにいることが確認できる。一方、図8(b)に示す撮像が得られた場合、自車Ciに対して右側に位置する白線(破線)を越えて、他車Coが撮影されているため、他車Coが左側の走行レーンrにいることが確認できる。
よって、他車Coの自信度が、自車Ciの自信度より高い場合に、他車Coが認識している走行レーンrの情報と、この車間状態確認手段11により得られる情報を利用して、現在の自車Ciの走行レーンrを補正・決定できる。
The inter-vehicle
Therefore, when the confidence level of the other vehicle Co is higher than the confidence level of the own vehicle Ci, the information on the traveling lane r recognized by the other vehicle Co and the information obtained by the inter-vehicle
以上が、この実施形態における演算制御装置4の構成の説明であるが、以下、図10、図11、図12に基づいて、走行レーンrの補正・決定に関して説明する。
図11と図12とは、ともに他車Coが地物Mである白線Mp(具体的には破断線)の認識を行っている状況を示しているが、図11に示す例では、地物認識が良好に行われ、他車Coの走行レーンrが良好に決定された状況を示している。従って、他車Coの自信度は10とされている。
一方、図12に示す例では、地物認識が良好に行われなかったため、走行レーンrは誤って認識されており(左レーンと認識している)、自信度が低い状況を示している。従って、他車Coの自信度は4である。
The above is the description of the configuration of the arithmetic and control unit 4 in this embodiment. Hereinafter, correction and determination of the travel lane r will be described based on FIGS. 10, 11, and 12.
11 and 12 both show a situation in which the other vehicle Co recognizes the white line Mp (specifically, the break line) that is the feature M. In the example shown in FIG. The situation is shown in which the recognition is performed well and the travel lane r of the other vehicle Co is determined well. Therefore, the confidence level of the other vehicle Co is set to 10.
On the other hand, in the example shown in FIG. 12, since the feature recognition is not performed well, the traveling lane r is erroneously recognized (recognized as the left lane), and the degree of confidence is low. Therefore, the confidence level of the other vehicle Co is 4.
この状態から、自車Ciと他車Coとの間における車車間通信を利用しての自車Ciの走行レーンrの補正・決定処理が本願に係るシステムでは実行される。
図10は、この状態における自車Ciにおける処理フローを示したものである。
以下、このフローに従って、説明を進める。
処理の開始に伴って他車Co(前方車両)の情報を取得する(ステップ11)。このとき取得される情報には、他車Coの識別番号、車種、通信形態等が含まれる。他車Coの情報の取得ができず、他車Coの認識が行えない場合(ステップ12:no)は、情報取得を繰り返す。情報の取得ができ、通信を確立できた場合(ステップ12:yes)は、他車Coの自信度を取得する(ステップ13)。
そして、自信度比較部44で、他車Coと自車Ciとの自信度を比較する(ステップ14)。比較の結果、他車Coの自信度が自車Ciの自信度より高い場合(ステップ14:yes)は、他車Coの走行レーンrの情報に基づいて自車Ciの走行レーンrを補正する処理に移る。
From this state, the correction / determination process of the travel lane r of the host vehicle Ci using inter-vehicle communication between the host vehicle Ci and the other vehicle Co is executed in the system according to the present application.
FIG. 10 shows a processing flow in the vehicle Ci in this state.
Hereinafter, the description will proceed according to this flow.
Accompanying the start of the process, information on another vehicle Co (front vehicle) is acquired (step 11). The information acquired at this time includes an identification number of another vehicle Co, a vehicle type, a communication form, and the like. When the information on the other vehicle Co cannot be acquired and the other vehicle Co cannot be recognized (step 12: no), the information acquisition is repeated. If the information can be acquired and communication can be established (step 12: yes), the confidence level of the other vehicle Co is acquired (step 13).
Then, the confidence
一方、比較の結果、他車Coの自信度が自車の自信度より低い場合(ステップ14:no)は、ステップ11に戻り、他車Coの自信度が自車Ciの自信度を上回るまで、ステップ11〜14の処理を繰り返すこととなる。この状況が、図12に示される状況であり、この図では、後続車である自車Ciの自位置が補正され、自信度8が変更されることはない。
On the other hand, as a result of comparison, if the confidence level of the other vehicle Co is lower than the confidence level of the own vehicle (step 14: no), the process returns to step 11 until the confidence level of the other vehicle Co exceeds the confidence level of the own vehicle Ci. The processes of
図11に示すように、自車Ciの自信度が他車Coの自信度より低い場合の処理は、以下の処理を順次おこなう。即ち、他車Co(前方車両)の走行レーンrの情報を取得する(ステップ15)。そして、車間状態確認手段11により、他車Coと自車Ciとの走行レーンrの関係を検出する(ステップ16)。図11に示す例では、他車Coと自車Ciとは同一の走行レーンrを走行していることが撮像情報から確認される。引き続いて、このようにして得られる他車Coの走行レーンrから自車Ciの走行レーンrを求め、他車情報依存補正手段42bが、得られた走行レーンCiを現在の走行レーンrとして自車Ciの走行レーンrを補正する(ステップ17)。この補正が良好に完了した場合は、走行レーンrの補正処理を完了し(ステップ18:yes)、何らかの理由で完了できなかった場合は、ステップ15に戻って処理を実行する。完了した場合、自車Coの自位置認識の自信度は、他車の自信度に置換する。
この状況が図11に示した状況であり、自車Coの自信度が3から10に変更されている。
As shown in FIG. 11, the processing in the case where the confidence level of the own vehicle Ci is lower than the confidence level of the other vehicle Co is performed sequentially as follows. That is, information on the traveling lane r of the other vehicle Co (the vehicle ahead) is acquired (step 15). Then, the inter-vehicle state confirmation means 11 detects the relationship of the travel lane r between the other vehicle Co and the host vehicle Ci (step 16). In the example shown in FIG. 11, it is confirmed from the imaging information that the other vehicle Co and the host vehicle Ci are traveling on the same travel lane r. Subsequently, the travel lane r of the own vehicle Ci is obtained from the travel lane r of the other vehicle Co obtained in this way, and the other vehicle information dependent correction means 42b automatically determines the obtained travel lane Ci as the current travel lane r. The travel lane r of the car Ci is corrected (step 17). When this correction is completed satisfactorily, the correction process for the driving lane r is completed (step 18: yes), and when it cannot be completed for some reason, the process returns to step 15 to execute the process. When completed, the self-recognition degree of the own vehicle Co is replaced with the confidence degree of the other vehicle.
This situation is the situation shown in FIG. 11, and the confidence level of the own vehicle Co is changed from 3 to 10.
3 第三実施の形態
この実施の形態は、認識対象となる自位置が走行路自体である例である。
この実施形態のシステム形態を図13に示した。
本システムから得られる自位置に関する情報である認識走行路に関する情報は、ナビゲーション装置本体2あるいは走行制御装置3に送られて、的確なナビゲーション、走行制御に使用される。
3 Third Embodiment This embodiment is an example in which the position to be recognized is the traveling road itself.
The system configuration of this embodiment is shown in FIG.
Information on the recognized travel path, which is information on the own position obtained from this system, is sent to the
この例にあっても、自位置認識システム1は、システム本体となる演算制御装置4と、この演算制御装置4に接続された附属機器とを備えて構成される。
Even in this example, the local
演算制御装置4には、先の例と同様に、自律航法センサ5、GPS受信機6、前方カメラ8a及び後方カメラ8bが接続されており、それぞれの機器からの検出情報が入力される。車車間通信モジュール9が接続されていることも先の例と同様である。
As in the previous example, the
第一の実施形態では、自車と他車との車間距離を検出するための車間距離検出モジュール10が設けられていたが、本例にあっては、この装置10に加えて、第二の実施形態と同様に、制御演算装置4内に、前方カメラ8a等の撮像装置からの情報である撮像情報から、画像認識により自車Ciと他車Coとの位置関係である車間状態を確認する車間状態確認手段11が備えられている。
In the first embodiment, the inter-vehicle
演算制御装置4には、記憶手段としてのデータベースDBが備えられており、このデータベースDBには、地図データベースDBmと自信度演算データベースDBcが備えられている。
地図データベースDBmは、図3に示すように階層化された構成を採用されており、道路ネットワークレイヤL1、道路形状レイヤL2、地物レイヤL3が格納されている。
The arithmetic and control unit 4 is provided with a database DB as storage means, and this database DB is provided with a map database DBm and a confidence level calculation database DBc.
The map database DBm has a hierarchical structure as shown in FIG. 3 and stores a road network layer L1, a road shape layer L2, and a feature layer L3.
この地図データベースDBmを使用することで、上記の自律航法センサ5からの走行軌跡あるいはGPS情報から求まる現在の位置(緯度・経度)に基づいて、現在の自車Ciの走行路Rに沿った位置を地図上でマッチングすることができる。
さらに、この地図データベースDBmには、走行路自体の識別情報(例えば走行路名)が格納されており、第一の実施の形態で説明したように、走行路R上での、その走行路に沿った自位置が決定できた段階で、現在走行中と認識している走行路R(この走行路が、本願にいう認識走行路である)を認識できるようにされている。この走行路R自体の認識に関しては、第五自位置認識手段41eにおいて説明する。
By using this map database DBm, based on the current position (latitude / longitude) obtained from the traveling locus from the
Further, the map database DBm stores identification information (for example, the name of the travel path) of the travel path itself, and as described in the first embodiment, the travel path R on the travel path R At the stage where the own position along the road has been determined, it is possible to recognize the travel route R recognized as currently traveling (this travel route is the recognized travel route in the present application). The recognition of the travel path R itself will be described in the fifth self-position recognition means 41e.
自信度演算データベースDBcは、先の例と同様に、得点データベースDBc1及び自信度換算データベースDBc2を備えて構成されている。
得点データベースDBc1は、以下の表4に示すように、自位置の認識のタイミングで、加算又は減算される得点(表4左欄に示す)と、その得点の事例要因(表4右欄に示す)の関係を纏めたデータベースである。得点の加算及び減算は、左欄に示されるプラスマイナスに依存することとなる。但し、この例では、自位置は走行路自体であるため、事例に対応する総得点の加算・減算に関して、実質上、自車が走行していると認識している走行路に変更の可能性がない状態(例えば、分岐・合流等に到達していない)では、加算・減算は行わない。即ち、現実の走行路変更を行ったと認識した場合、あるいは、分岐を通過する等、走行路に変更の可能性があった場合に、単一回の加算・減算を行う。
Similar to the previous example, the confidence calculation database DBc includes a score database DBc1 and a confidence conversion database DBc2.
As shown in Table 4 below, the score database DBc1 is a score that is added or subtracted at the timing of recognition of its own position (shown in the left column of Table 4), and case factors of the score (shown in the right column of Table 4) ). The score addition and subtraction will depend on the plus or minus shown in the left column. However, in this example, the vehicle's own position is the road itself, so the addition / subtraction of the total score corresponding to the case may be changed to a road that the vehicle is actually aware of. In a state where there is no error (for example, branching / merging has not been reached), addition / subtraction is not performed. That is, when it is recognized that the actual travel route has been changed, or when there is a possibility of change in the travel route, such as passing through a branch, addition / subtraction is performed once.
表4に示す事例要因に関して例示的に説明しておくと、「一本道にマッチングしており、近くに並走路がない」場合に、得点が50点加算されることを示している。これは、マッチングが確実に行われているため、正確に自車が走行している走行路自体が認識できる状況にあるためである。
一方、「並走路がある道を走行」している場合は、並走路に離間状態で、得点が加算されることを示している。並走路が近くにあるほうが、加算点は低くなり、事実上、並走路が20m以内にある場合は、加算される得点はなくなる。
さらに、「上下道のような直近に並走路がある」場合は、10点減点されることを示している。また「分岐直後」には、得点が10点減算される。
その他、それぞれに状況に応じて、得点の加算及び減算を行うように得点が決定されているのは、先の例と同様である。
Explaining about the case factors shown in Table 4 exemplarily, it shows that 50 points are added in the case of “matching on a single road and no parallel running road nearby”. This is because the matching is performed reliably, so that the traveling path on which the host vehicle is traveling can be accurately recognized.
On the other hand, in the case of “running on a road with a parallel road”, it indicates that a score is added in a separated state on the parallel road. The closer the parallel road is, the lower the added points. In fact, when the parallel road is within 20 m, there is no score to be added.
Furthermore, it is shown that 10 points are deducted in the case of “the parallel running road is near the top and bottom roads”. In addition, 10 points are subtracted immediately after “branch”.
In addition, as in the previous example, the score is determined so that the score is added and subtracted depending on the situation.
自信度換算データベースDBc2の構造は先に示した表2と同様であり、その使用形態も同様である。 The structure of the confidence level conversion database DBc2 is the same as that of Table 2 shown above, and the usage pattern is also the same.
以上が、この例において、演算制御装置4に接続されている機器およびその機能の説明であるが、以下に演算制御装置4内の構成に関して説明する。
図13からも判明するように、この装置4内にも、自位置認識部41、自位置決定部42、自信度決定部43及び自信度比較部44が設けられている。
The above is the description of the equipment connected to the arithmetic control device 4 and the function thereof in this example. The configuration within the arithmetic control device 4 will be described below.
As can be seen from FIG. 13, a self-
自位置認識部41は、演算制御装置4に送られてくる情報から自位置(走行路自体である認識走行路)の認識をも実行する機能部位であり、自位置決定部42は、これまで認識されていた自位置を補正して、現在の自位置として最も確からしさの高い走行路をも決定する機能部位である。
一方、自信度決定部43は、上記のようにして決定される認識走行路に関する自信度をも演算する機能部であり、自信度比較部44は、車車間通信モジュール10を介して送られてくる、他車Coの自信度と現在の自車Ciの自信度とを比較し、その比較結果に基づいて、自位置決定部43において、他車情報依存の補正を行うか否かの判定情報をも得る機能部である。
The own
On the other hand, the confidence
この例にあっては、自位置認識部41には、先に説明した、第一自位置認識手段41a、第二自位置認識手段41b及び第三自位置認識手段41cの3種の認識手段が備えられているほか、第五自位置認識手段41eが備えられている。
第一、第二、第三自位置認識手段41a,41b,41cの機能は、走行路Rにおける走行方向に沿った自位置を認識する上で、先の第一実施の形態の場合と同様であり、説明を省略する。
In this example, the self-
The functions of the first, second, and third self-position recognition means 41a, 41b, and 41c are the same as those in the first embodiment in recognizing the self-position along the running direction on the running path R. Yes, the description is omitted.
第五自位置認識手段41eは、現在、走行している走行路Rを認識する機能部である。この手段41eにおいては、自位置決定部42において、走行路Rに沿った自位置が逐次決定されているため、その決定において自車が走行していると認識している走行路自体を認識走行路とする。この走行路の認識で使用する識別情報は、例えば、先に説明した各走行路単位でデータベースに登録されている走行路名である。
The fifth own position recognizing means 41e is a functional unit that recognizes the currently traveling road R. In this means 41e, the own
この例にあっても、自位置決定部42には、自車情報依存の自位置補正を行う自車情報依存補正手段42aと、他車情報にも基づいた自位置補正を行う他車情報依存補正手段42bが設けられている。走行路Rに沿った自位置に決定は、第一の実施の形態と同様に行われるため、以下の説明では、走行路の決定に関してのみ説明する。
Even in this example, the own
自車情報依存補正手段42bは、過去に決定された認識走行路Rに対して、新たな認識走行路Rが自位置認識部で認識された場合は、新たな認識走行路Rに現在の認識走行路を補正する。この例では、自位置認識部41に備えられる第五自位置認識手段41eによる認識結果が、認識走行路Rの補正・決定に、実質上、そのまま使用される。
このようにすることで、常時、逐次的に、自車側で得られる情報から、自車の認識走行路が順次、決定される。
The own vehicle information dependence correction means 42b, when a new recognized traveling path R is recognized by the own position recognition unit with respect to the recognized traveling path R determined in the past, is recognized as a new recognized traveling path R. Correct the road. In this example, the recognition result by the fifth self-position recognition means 41e provided in the self-
By doing in this way, the recognition traveling path of the own vehicle is sequentially determined from the information obtained on the own vehicle side sequentially and continuously.
他車情報依存補正手段42bは、自車情報に基づいて決定された走行路Rに対して、他車Coの認識走行路(自位置)が受信され、他車Coの認識走行路についての自信度が高いことを条件として、他車Coの認識走行路から自車の走行路を補正・決定する。
この他車情報依存補正手段42bへは、図13に示すように、他車Coの認識走行路の情報と、車間状態確認手段11から自車Ciと他車Coとが実際に走行している走行路間に関する関係情報が送られてくる。そして、この手段42bでは、他車Coの認識走行路を基準として、自車Ciの認識走行路を決定する。例えば、前方カメラ8で得られた撮像画像より、他車Coが自車Ciと同一の走行路Rを走行していることが確認された状況で、他車Coが保有している認識走行路の情報が、自車情報依存補正手段42aにより決定された認識走行路に対して優先するものとされ、他車情報依存補正手段42bにより決定された走行路が、現在の認識走行路として決定される。
The other vehicle information
As shown in FIG. 13, the other vehicle information
この例にあっても、自信度決定部43には、得点積算手段43aと自信度演算手段43bが備えられている。
得点積算手段43aは、自位置決定部42において認識走行路の補正・決定が行われ、自車が分岐に到達する毎に、その時点の状況を判定し、状況が得点に加算・減算に相当する状況である場合には、表4に示した得点表に従って、得点の加算・減算を実行し、これを総得点として積算する。この例の場合も、総得点には、その上限値と下限値とを設けている。
Even in this example, the confidence
The score integrating means 43a corrects / determines the recognized traveling path in the own
この積算状況を、図14に基づいて説明する。
この図は、走行路R1,R2が合流する状態であることを示しており、図上、下側に位置する第一走行路R1は、一本道から合流点RMに到達している。上側に位置する第二走行路R2は、左上方向から第一走行路R1との合流点RMまで、順次、分岐を繰り返している。これら分岐路を上から順に、RD1,RD2、RD3と図示している。
さらに、分岐路RD1,RD2、RD3間及び、分岐路RD3と合流点RMより下手側の第一走行路R1の距離は、20m以内としている。
This integration state will be described with reference to FIG.
This figure shows that the traveling paths R1 and R2 are in a joined state, and the first traveling path R1 located on the lower side in the figure reaches the joining point RM from a single road. The second traveling path R2 located on the upper side repeats branching sequentially from the upper left direction to the junction RM with the first traveling path R1. These branch paths are illustrated as RD1, RD2, and RD3 in order from the top.
Further, the distance between the branch roads RD1, RD2, and RD3 and the distance between the branch road RD3 and the first travel path R1 on the lower side of the junction RM is set to be within 20 m.
この場合における総得点の変化を、図上の対応部位に示した。
第一走行路R1に関しては、一本道であることから、この走行路R1を走行している車の総得点は50点とされる。一方、第二走行路R2に関しては、左上側において一本道であったため総得点が50点であったのが、分岐RDの繰り返しに伴って、20点まで自信度が低下して、合流点RMに到達する結果となっている。
The change in the total score in this case is shown in the corresponding part on the figure.
Since the first traveling road R1 is a single road, the total score of a vehicle traveling on the traveling road R1 is 50 points. On the other hand, regarding the second traveling route R2, the total score was 50 because it was a single road on the upper left side, but the confidence decreased to 20 points as the branch RD was repeated, and the confluence RM It is the result to reach.
自信度演算手段43bは、得点積算手段43aにより積算される総得点に基づいて表2に示す自信度換算テーブルから自信度を演算する。
従って、この例の場合も、自信度は、走行状態にある車において、常時、決定された自信度が保持されることとなる。
The confidence level calculation means 43b calculates the confidence level from the confidence level conversion table shown in Table 2 based on the total score accumulated by the score accumulation means 43a.
Accordingly, also in this example, the confidence level is always maintained in the vehicle in the running state.
車間状態確認手段11は、カメラ8等から得られる撮像情報に基づいて、画像認識により自車Ciと他車Coとの間における例えば、実際に走行している走行路Rの関係を確認する。例えば、撮像情報に現れた他車Coと路肩或いは白線との関係から、相互の車Ci、Coが走行している走行路Rの状態を確認することができる。先に示した図5、図6に示される状況では、自車Ci及び他車Coは、同一の白線対内に存在する撮像が得られるため、同一走行路にいることが確認できる。
よって、他車Coの自信度が、自車Ciの自信度より高い場合に、他車Coが認識している走行路の情報と、この車間状態確認手段11により得られる情報を利用して現在の自車の走行路を補正・決定できる。
The inter-vehicle
Therefore, when the confidence level of the other vehicle Co is higher than the confidence level of the own vehicle Ci, the information on the travel route recognized by the other vehicle Co and the information obtained by the inter-vehicle
この例の場合、第二の実施形態における走行レーンに関する情報が、認識走行路に関する情報となり、第二の実施形態と同様なシーケンスを経ることで、自車Ciと他車Coとの自信度の比較を行い、認識走行路の補正・決定において、他車Coの認識走行路を使用するか、自車Ciの認識走行路を使用するかの判断を行い、他車Coの自信度が高い場合に、他車Coの認識走行路に基づいて自車Ciの認識走行路を補正・決定することができる。 In the case of this example, the information on the travel lane in the second embodiment becomes information on the recognized travel route, and the degree of confidence between the host vehicle Ci and the other vehicle Co is obtained through a sequence similar to the second embodiment. When a comparison is made and it is determined whether the recognition travel path of the other vehicle Co is used or the recognition travel path of the host vehicle Ci is used in the correction / determination of the recognition travel path. In addition, the recognized travel path of the host vehicle Ci can be corrected and determined based on the recognized travel path of the other vehicle Co.
この状態を示したのが、図14、図15であり、合流点RMの走行下手側において、先行車Cfと後行車Cbとの間で、認識走行路の補正・決定を行う状況を示している。
この状況では、後行車Cbが第二走行路R2から第一走行路R1に合流した状態で、後行車Cbの自信度が分岐の存在で低下する(図15の上側箱内参照)。
後続車Cbとしては、実線で合流点RM下手側に、破線で分岐路RD3上に図示するように、第一走行路R1に進入したのか、第三分岐路RD3に進入したのかが、確定できない状況である。
この状況においても、先行車Cfと後行車Cbとの間で自信度の比較を実行し、先行車Cfの自信度が高い場合は、同一の走行路R1を走行していることが確認できたことを条件として、後行車Cbの認識走行路を先行車Cbの認識走行路として精度の高いものとできる。
FIG. 14 and FIG. 15 show this state, and show the situation where the recognized traveling path is corrected and determined between the preceding vehicle Cf and the following vehicle Cb on the lower driving side of the junction RM. Yes.
In this situation, the degree of confidence of the following vehicle Cb decreases due to the presence of the branch in the state in which the following vehicle Cb merges from the second traveling route R2 to the first traveling route R1 (see the upper box in FIG. 15).
As for the following vehicle Cb, it is not possible to determine whether the vehicle has entered the first traveling road R1 or the third branch road RD3 as shown on the branch road RD3 by the broken line on the lower side of the confluence RM on the solid line. Is the situation.
Even in this situation, a comparison of confidence levels was performed between the preceding vehicle Cf and the following vehicle Cb, and when the confidence level of the preceding vehicle Cf was high, it was confirmed that the vehicle was traveling on the same road R1. As a condition, the recognition travel path of the following vehicle Cb can be made highly accurate as the recognition travel path of the preceding vehicle Cb.
一方、図14に破線で示すように、後行車Cbが、分岐路RD3に進入している状況では、車間状態確認手段11が、先行車Cfが斜め前の並走路である第一走行路R1を走行していることを確認することで、後行車Cbが分岐後に並行路RD3を走行している状況を確認できる。
〔別実施の形態〕
(1) 上記の実施の形態では、走行路に沿った自位置の認識を実行する自位置認識手段として、3種の手段41a、41b、43cの全てを有する構成に関して説明したが、何れか一種以上を有する構成であってもよい。自位置認識手段を単一しか有しない場合は、自車情報依存補正手段は、備える必要がない。但し、本願の趣旨から、他車情報依存補正手段は必然的に備えられることとなる。
(2) 自信度の演算に関しては、表1、3、4に示すような事象要因に伴って、得点を積算して、総得点から、自信度を演算するものとしたが、このような手法を採ることなく、例えば自位置を決定する方式に基づいて、自信度を演算・決定するものとしてもよく、任意の手法で自信度を得ることができる。
(3) 上記の実施の形態では、走行路に沿った方向での自位置の認識・決定の後、その場所での地図情報を利用した走行レーンの認識・決定、或いは、認識走行路の認識・決定を行うものとしたが、走行レーンの履歴、認識走行路の履歴等を利用して、走行レーンのみを単独で、あるいは、認識走行路を単独で認識・決定するものとしてもよい。
(4) 上記の実施の形態にあっては、車車間通信は、車車間で直接行われる例を示したが、通信は最終的に、送信車両から受信車両へ行われればよく、例えば、通信センター等を介する間接的な形態で行われてもよい。
On the other hand, as shown by a broken line in FIG. 14, in the situation where the following vehicle Cb enters the branch road RD3, the inter-vehicle state confirmation means 11 determines that the first traveling path R1 in which the preceding vehicle Cf is a parallel traveling path diagonally forward. By confirming that the vehicle is traveling, it is possible to confirm the situation in which the following vehicle Cb is traveling on the parallel road RD3 after branching.
[Another embodiment]
(1) In the above embodiment, the configuration having all of the three types of
(2) Concerning the calculation of confidence level, the score is integrated according to the event factors as shown in Tables 1, 3, and 4, and the confidence level is calculated from the total score. For example, the confidence level may be calculated and determined based on, for example, a method of determining the own position, and the confidence level can be obtained by an arbitrary method.
(3) In the above embodiment, after recognizing / determining its own position in the direction along the travel route, recognition / determination of the travel lane using map information at that location, or recognition of the recognized travel route Although the determination is made, the travel lane history, the recognized travel route history, and the like may be used to recognize and determine only the travel lane alone or the recognized travel route alone.
(4) In the above embodiment, an example in which vehicle-to-vehicle communication is directly performed between vehicles has been described. However, communication may be finally performed from a transmitting vehicle to a receiving vehicle. It may be performed in an indirect form via a center or the like.
他車の有する自位置に関する情報に基づいて、自位置を認識するシステムにおいて、位置精度が高く、認識される自位置の確からしさを高く維持できる自位置認識システムを得ることができた。 In the system for recognizing the own position based on the information related to the own position of the other vehicle, it is possible to obtain a self-position recognition system that has high positional accuracy and can maintain the probability of the recognized self-position.
1 自位置認識システム
4 演算制御装置
5 自律航法センサ
6 GPS受信機
8 カメラ(撮像手段)
9 車車間通信モジュール(車車間通信手段)
10 車間距離検出モジュール(位置関係検出手段)
11 車間状態確認手段(位置関係検出手段)
41 自位置認識部
42 自位置決定部
43 自信度決定部
44 自信度比較部(自信度比較手段)
Ci 自車
Co 他車
DB データベース
DBm 地図データベース
DBc 自信度演算データベース
1 Local Position Recognition System 4
9 Vehicle-to-vehicle communication module (vehicle-to-vehicle communication means)
10 Inter-vehicle distance detection module (positional relationship detection means)
11 Inter-vehicle state confirmation means (position relation detection means)
41 Self
Ci own car Co other car DB database DBm map database DBc confidence calculation database
Claims (12)
車両間で情報通信を行う車車間通信手段を備える自位置認識システムであって、
各車両に、前記自位置の確からしさの指標である自信度を演算する自信度演算手段を備え、
前記車車間通信手段を介して、送信車両から受信車両に、送信車両の自位置及び自信度を送信可能に構成されるとともに、前記受信車両に対する送信車両の相対位置関係を検出する位置関係検出手段を備え、
前記車車間通信手段を介して送られてくる送信車両の自信度と、受信車両が認識している自信度とを比較する自信度比較手段を備え、
前記送信車両の自信度が、受信車両の自信度より高い場合に、前記補正手段が、送信車両の自位置及び前記相対位置関係に基づいて自位置の補正を行い、
前記自位置が走行レーン単位で認識され、前記自信度が自車が走行していると認識している認識走行レーンの確からしさを示す指標であり、前記相対位置関係が、車両間における各車両が走行している走行レーン間の関係であり、
前記送信車両が自車の周囲を走行している周囲車両で、前記受信車両が自車であり、前記周囲車両が認識している認識走行レーンと、前記自車が走行している走行レーンと前記周囲車両が走行している走行レーンとの関係に基づいて、自位置を補正する自位置認識システム。 Each vehicle includes own position recognition means for recognizing the own position, and correction means for correcting the own position recognized by the own position recognition means,
A self-position recognition system comprising vehicle-to-vehicle communication means for performing information communication between vehicles,
Each vehicle is provided with a confidence level calculating means for calculating a confidence level that is an index of the probability of the own position,
A positional relationship detecting unit configured to transmit the own position and the degree of confidence of the transmitting vehicle from the transmitting vehicle to the receiving vehicle via the inter-vehicle communication unit, and detecting a relative positional relationship of the transmitting vehicle with respect to the receiving vehicle. With
Comprising confidence degree comparison means for comparing the confidence level of the transmitting vehicle sent via the inter-vehicle communication means and the confidence level recognized by the receiving vehicle,
Confidence of the transmission vehicle is higher than the confidence level of the receiving vehicle, wherein the correction means have lines to correct the current position based on the vehicle position and the relative positional relationship of the transmission vehicle,
The own position is recognized in units of driving lanes, and the degree of confidence is an index indicating the probability of a recognized driving lane in which the own vehicle is driving, and the relative positional relationship is determined by each vehicle between vehicles. Is the relationship between the driving lanes
The transmission vehicle is a surrounding vehicle traveling around the vehicle, the receiving vehicle is the vehicle, a recognition traveling lane recognized by the surrounding vehicle, and a traveling lane in which the vehicle is traveling A self-position recognition system that corrects the self -position based on a relationship with a travel lane in which the surrounding vehicle is traveling .
車両間で情報通信を行う車車間通信手段を備える自位置認識システムであって、 A self-position recognition system comprising vehicle-to-vehicle communication means for performing information communication between vehicles,
各車両に、前記自位置の確からしさの指標である自信度を演算する自信度演算手段を備え、 Each vehicle is provided with a confidence level calculating means for calculating a confidence level that is an index of the probability of the own position,
前記車車間通信手段を介して、送信車両から受信車両に、送信車両の自位置及び自信度を送信可能に構成されるとともに、前記受信車両に対する送信車両の相対位置関係を検出する位置関係検出手段を備え、 A positional relationship detecting unit configured to transmit the own position and the degree of confidence of the transmitting vehicle from the transmitting vehicle to the receiving vehicle via the inter-vehicle communication unit, and detecting a relative positional relationship of the transmitting vehicle with respect to the receiving vehicle. With
前記車車間通信手段を介して送られてくる送信車両の自信度と、受信車両が認識している自信度とを比較する自信度比較手段を備え、 Comprising confidence degree comparison means for comparing the confidence level of the transmitting vehicle sent via the inter-vehicle communication means and the confidence level recognized by the receiving vehicle,
前記送信車両の自信度が、受信車両の自信度より高い場合に、前記補正手段が、送信車両の自位置及び前記相対位置関係に基づいて自位置の補正を行い、 When the confidence level of the transmitting vehicle is higher than the confidence level of the receiving vehicle, the correction means corrects the own position based on the own position of the transmitting vehicle and the relative positional relationship,
前記自位置が走行路単位で認識され、前記自信度が自車が走行していると認識している認識走行路の確からしさを示す指標であり、前記相対位置関係が、車両間における各車両が走行している走行路間の関係であり、 The self-position is recognized on a road-by-road basis, and the degree of confidence is an index indicating the certainty of the recognized road that the car is running, and the relative positional relationship is determined by each vehicle between vehicles. Is the relationship between the traveling roads,
前記送信車両が自車の周囲を走行している周囲車両で、前記受信車両が自車であり、前記周囲車両が認識している認識走行路と、前記自車が走行している走行路と前記周囲車両が走行している走行路との関係に基づいて、自位置を補正する自位置認識システム。 The transmitting vehicle is a surrounding vehicle traveling around the own vehicle, the receiving vehicle is the own vehicle, the recognized traveling path recognized by the surrounding vehicle, and the traveling path on which the own vehicle is traveling A self-position recognition system that corrects the self-position based on a relationship with a travel path on which the surrounding vehicle is traveling.
車両間で情報通信を行う自位置認識方法であって、
各車両で、前記自位置の確からしさの指標である自信度を演算する自信度演算工程を実行し、
送信車両から受信車両に送信車両の自位置及び自信度を送信し、前記受信車両に対する送信車両の相対位置関係を検出する位置関係検出工程を実行し、
前記送られてくる送信車両の自信度と、受信車両が認識している自信度とを比較する自信度比較工程を実行し、
前記送信車両の自信度が、受信車両の自信度より高い場合に、前記自位置補正工程において、送信車両の自位置及び前記相対位置関係に基づいて自位置の補正を行い、
前記自位置が走行レーン単位で認識され、前記自信度が自車が走行していると認識している認識走行レーンの確からしさを示す指標であり、前記相対位置関係が、車両間における各車両が走行している走行レーン間の関係であり、
前記送信車両が自車の周囲を走行している周囲車両で、前記受信車両が自車であり、前記周囲車両が認識している認識走行レーンと、前記自車が走行している走行レーンと前記周囲車両が走行している走行レーンとの関係に基づいて、自位置を補正する自位置認識方法。 In each vehicle, execute a self-position recognition process for recognizing the self-position and a self-position correction process for correcting the self-position recognized in the self-position recognition process.
A self-localization method for performing information communication between vehicles,
In each vehicle, execute a confidence level calculation step of calculating a confidence level, which is an index of the accuracy of the position of the vehicle,
Transmitting the own position and confidence of the transmitting vehicle from the transmitting vehicle to the receiving vehicle, and performing a positional relationship detection step of detecting a relative positional relationship of the transmitting vehicle with respect to the receiving vehicle;
Performing a confidence level comparison step of comparing the confidence level of the transmitted vehicle and the confidence level recognized by the receiving vehicle;
Confidence of the transmission vehicle is higher than the confidence level of the receiving vehicle, in the current position correction step, have lines to correct the current position based on the vehicle position and the relative positional relationship of the transmission vehicle,
The own position is recognized in units of driving lanes, and the degree of confidence is an index indicating the probability of a recognized driving lane in which the own vehicle is driving, and the relative positional relationship is determined by each vehicle between vehicles. Is the relationship between the driving lanes
The transmission vehicle is a surrounding vehicle traveling around the vehicle, the receiving vehicle is the vehicle, a recognition traveling lane recognized by the surrounding vehicle, and a traveling lane in which the vehicle is traveling A self position recognition method for correcting the self position based on a relationship with a travel lane in which the surrounding vehicle is traveling .
車両間で情報通信を行う自位置認識方法であって、 A self-localization method for performing information communication between vehicles,
各車両で、前記自位置の確からしさの指標である自信度を演算する自信度演算工程を実行し、 In each vehicle, execute a confidence level calculation step of calculating a confidence level, which is an index of the accuracy of the position of the vehicle,
送信車両から受信車両に送信車両の自位置及び自信度を送信し、前記受信車両に対する送信車両の相対位置関係を検出する位置関係検出工程を実行し、 Transmitting the own position and confidence of the transmitting vehicle from the transmitting vehicle to the receiving vehicle, and performing a positional relationship detection step of detecting a relative positional relationship of the transmitting vehicle with respect to the receiving vehicle;
前記送られてくる送信車両の自信度と、受信車両が認識している自信度とを比較する自信度比較工程を実行し、 Performing a confidence level comparison step of comparing the confidence level of the transmitted vehicle and the confidence level recognized by the receiving vehicle;
前記送信車両の自信度が、受信車両の自信度より高い場合に、前記自位置補正工程において、送信車両の自位置及び前記相対位置関係に基づいて自位置の補正を行い、 When the confidence level of the transmitting vehicle is higher than the confidence level of the receiving vehicle, in the own position correction step, the own position is corrected based on the own position of the transmitting vehicle and the relative positional relationship,
前記自位置が走行路単位で認識され、前記自信度が自車が走行していると認識している認識走行路の確からしさを示す指標であり、前記相対位置関係が、車両間における各車両が走行している走行路間の関係であり、 The self-position is recognized on a road-by-road basis, and the degree of confidence is an index indicating the certainty of the recognized road that the car is running, and the relative positional relationship is determined by each vehicle between vehicles. Is the relationship between the traveling roads,
前記送信車両が自車の周囲を走行している周囲車両で、前記受信車両が自車であり、前記周囲車両が認識している認識走行路と、前記自車が走行している走行路と前記周囲車両が走行している走行路との関係に基づいて、自位置を補正する自位置認識方法。 The transmitting vehicle is a surrounding vehicle traveling around the own vehicle, the receiving vehicle is the own vehicle, the recognized traveling path recognized by the surrounding vehicle, and the traveling path on which the own vehicle is traveling A self-position recognition method for correcting the self-position based on a relationship with a travel path on which the surrounding vehicle is traveling.
前記自位置の確からしさの指標である自信度を求める自信度演算手段を備え、
前記車車間通信手段を介して、受信車両に、自車の自位置及び自信度を送信可能に構成され、
前記自位置が走行レーン単位で認識され、前記自信度が自車が走行していると認識している認識走行レーンの確からしさを示す指標である自位置認識用送信システム。 A self-position recognition means for recognizing the self-position, a correction means for correcting the self-position recognized by the self-position recognition means, and a vehicle-to-vehicle communication means for performing information communication between vehicles;
Comprising a confidence level calculating means for obtaining a confidence level that is an index of the probability of the self-position,
Via the vehicle-to-vehicle communication means, the receiving vehicle is configured to be able to transmit its own position and confidence level ,
A transmission system for recognizing a self position, wherein the self position is recognized in units of travel lanes, and the confidence level is an index indicating the probability of a recognized travel lane in which the self vehicle is traveling .
前記自位置の確からしさの指標である自信度を求める自信度演算手段を備え、 Comprising a confidence level calculating means for obtaining a confidence level that is an index of the probability of the self-position,
前記車車間通信手段を介して、受信車両に、自車の自位置及び自信度を送信可能に構成され、 Via the vehicle-to-vehicle communication means, the receiving vehicle is configured to be able to transmit its own position and confidence level,
前記自位置が走行路単位で認識され、前記自信度が自車が走行していると認識している認識走行路の確からしさを示す指標である自位置認識用送信システム。 A transmission system for recognizing a self position, wherein the self position is recognized in units of a travel path, and the degree of confidence is an index indicating a probability of a recognized travel path in which the self vehicle is traveling.
前記自位置の確からしさの指標である自信度を求める自信度演算手段を備え、
前記車車間通信手段を介して、送信車両から送られてくる送信車両の自位置及び自信度を受信可能に構成されるとともに、自車に対する送信車両の相対位置関係を検出する位置関係検出手段を備え、
前記車車間通信手段を介して送られてくる送信車両の自信度と、自車が認識している自信度とを比較する自信度比較手段を備え、
前記送信車両の自信度が、自車の自信度より高い場合に、前記補正手段が、送信車両の自位置及び前記相対位置関係に基づいて自位置の補正を行い、
前記自位置が走行レーン単位で認識され、前記自信度が自車が走行していると認識している認識走行レーンの確からしさを示す指標であり、前記相対位置関係が、車両間における各車両が走行している走行レーン間の関係であり、
前記送信車両が自車の周囲を走行している周囲車両で、前記周囲車両が認識している認識走行レーンと、前記自車が走行している走行レーンと前記周囲車両が走行している走行レーンとの関係に基づいて、自位置を補正する自位置認識用受信システム。 A self-position recognition means for recognizing the self-position, a correction means for correcting the self-position recognized by the self-position recognition means, and a vehicle-to-vehicle communication means for performing information communication between vehicles;
Comprising a confidence level calculating means for obtaining a confidence level that is an index of the probability of the self-position,
A positional relationship detecting unit configured to be able to receive the own position and the degree of confidence of the transmitting vehicle transmitted from the transmitting vehicle via the inter-vehicle communication unit, and to detect a relative positional relationship of the transmitting vehicle with respect to the own vehicle. Prepared,
Comprising a confidence level comparison means for comparing the confidence level of the transmission vehicle sent through the vehicle-to-vehicle communication means and the confidence level recognized by the own vehicle;
Confidence of the transmission vehicle is higher than the confidence of the vehicle, wherein the correction means have lines to correct the current position based on the vehicle position and the relative positional relationship of the transmission vehicle,
The own position is recognized in units of driving lanes, and the degree of confidence is an index indicating the probability of a recognized driving lane in which the own vehicle is driving, and the relative positional relationship is determined by each vehicle between vehicles. Is the relationship between the driving lanes
The surrounding vehicle in which the transmitting vehicle is traveling around the vehicle, the recognized traveling lane recognized by the surrounding vehicle, the traveling lane in which the vehicle is traveling, and the traveling in which the surrounding vehicle is traveling A reception system for recognizing a self position based on the relationship with the lane .
前記自位置の確からしさの指標である自信度を求める自信度演算手段を備え、 Comprising a confidence level calculating means for obtaining a confidence level that is an index of the probability of the self-position,
前記車車間通信手段を介して、送信車両から送られてくる送信車両の自位置及び自信度を受信可能に構成されるとともに、自車に対する送信車両の相対位置関係を検出する位置関係検出手段を備え、 A positional relationship detecting unit configured to be able to receive the own position and the degree of confidence of the transmitting vehicle transmitted from the transmitting vehicle via the inter-vehicle communication unit, and to detect a relative positional relationship of the transmitting vehicle with respect to the own vehicle. Prepared,
前記車車間通信手段を介して送られてくる送信車両の自信度と、自車が認識している自信度とを比較する自信度比較手段を備え、 Comprising a confidence level comparison means for comparing the confidence level of the transmission vehicle sent through the vehicle-to-vehicle communication means and the confidence level recognized by the own vehicle;
前記送信車両の自信度が、自車の自信度より高い場合に、前記補正手段が、送信車両の自位置及び前記相対位置関係に基づいて自位置の補正を行い、 When the confidence level of the transmission vehicle is higher than the confidence level of the own vehicle, the correction means corrects the own position based on the own position of the transmission vehicle and the relative positional relationship,
前記自位置が走行路単位で認識され、前記自信度が自車が走行していると認識している認識走行路の確からしさを示す指標であり、前記相対位置関係が、車両間における各車両が走行している走行路間の関係であり、 The self-position is recognized on a road-by-road basis, and the degree of confidence is an index indicating the certainty of the recognized road that the car is running, and the relative positional relationship is determined by each vehicle between vehicles. Is the relationship between the traveling roads,
前記送信車両が自車の周囲を走行している周囲車両で、前記周囲車両が認識している認識走行路と、前記自車が走行している走行路と前記周囲車両が走行している走行路との関係に基づいて、自位置を補正する自位置認識用受信システム。 The surrounding vehicle in which the transmitting vehicle is traveling around the own vehicle, the recognized traveling path recognized by the surrounding vehicle, the traveling path in which the own vehicle is traveling, and the traveling in which the surrounding vehicle is traveling A receiving system for recognizing a self position that corrects the self position based on the relationship with the road.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005377455A JP4591777B2 (en) | 2005-12-28 | 2005-12-28 | Self-recognition system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005377455A JP4591777B2 (en) | 2005-12-28 | 2005-12-28 | Self-recognition system |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2007178270A JP2007178270A (en) | 2007-07-12 |
JP4591777B2 true JP4591777B2 (en) | 2010-12-01 |
Family
ID=38303606
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2005377455A Expired - Fee Related JP4591777B2 (en) | 2005-12-28 | 2005-12-28 | Self-recognition system |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4591777B2 (en) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009058430A (en) * | 2007-08-31 | 2009-03-19 | Aisin Aw Co Ltd | Navigation apparatus and program |
JP2009251671A (en) * | 2008-04-01 | 2009-10-29 | Toyota Motor Corp | White line recognition device |
JP2010019588A (en) * | 2008-07-08 | 2010-01-28 | Nissan Motor Co Ltd | Vehicle navigation system and correction method of position information in vehicle navigation system, and information distribution server and in-vehicle navigation apparatus |
US8363104B2 (en) | 2008-09-25 | 2013-01-29 | Clarion Co., Ltd. | Lane determining device and navigation system |
JP4876147B2 (en) * | 2009-06-30 | 2012-02-15 | クラリオン株式会社 | Lane judgment device and navigation system |
JP4832489B2 (en) * | 2008-09-25 | 2011-12-07 | クラリオン株式会社 | Lane judgment device |
JP6312304B2 (en) | 2014-01-28 | 2018-04-18 | 三菱重工機械システム株式会社 | Position measuring method, self-position measuring device, and vehicle-mounted device |
JP2017117413A (en) * | 2015-12-25 | 2017-06-29 | パイオニア株式会社 | Information processing device, information processing method, and information processing program |
US10281925B2 (en) * | 2016-10-21 | 2019-05-07 | Toyota Jidosha Kabushiki Kaisha | Estimate of geographical position of a vehicle using wireless vehicle data |
KR102215325B1 (en) * | 2017-02-28 | 2021-02-15 | 현대자동차주식회사 | Apparatus and method for estimating location of vehicle and vehicle using the same |
JP6747405B2 (en) * | 2017-08-25 | 2020-08-26 | トヨタ自動車株式会社 | Own vehicle position confidence calculator |
JP6671570B1 (en) * | 2019-07-08 | 2020-03-25 | 三菱電機株式会社 | Position estimation device and position estimation method |
EP4198920A1 (en) * | 2021-12-15 | 2023-06-21 | Volvo Autonomous Solutions AB | A method and unit for evaluating a performance of an obstacle detection system |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH09245287A (en) * | 1996-03-06 | 1997-09-19 | Nissan Diesel Motor Co Ltd | Vehicle group running controller |
JP2005300415A (en) * | 2004-04-14 | 2005-10-27 | Matsushita Electric Ind Co Ltd | Correction device |
JP2006275695A (en) * | 2005-03-29 | 2006-10-12 | Clarion Co Ltd | On-vehicle information processor, method of control and program of control |
-
2005
- 2005-12-28 JP JP2005377455A patent/JP4591777B2/en not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH09245287A (en) * | 1996-03-06 | 1997-09-19 | Nissan Diesel Motor Co Ltd | Vehicle group running controller |
JP2005300415A (en) * | 2004-04-14 | 2005-10-27 | Matsushita Electric Ind Co Ltd | Correction device |
JP2006275695A (en) * | 2005-03-29 | 2006-10-12 | Clarion Co Ltd | On-vehicle information processor, method of control and program of control |
Also Published As
Publication number | Publication date |
---|---|
JP2007178270A (en) | 2007-07-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4591777B2 (en) | Self-recognition system | |
US11755024B2 (en) | Navigation by augmented path prediction | |
US11679760B2 (en) | Navigation in vehicle crossing scenarios | |
JP2007178271A (en) | Own position recognition system | |
US8085984B2 (en) | Image recognizing apparatus and method, and position determining apparatus, vehicle controlling apparatus and navigation apparatus using the image recognizing apparatus or method | |
US8134480B2 (en) | Image processing system and method | |
US8379923B2 (en) | Image recognition processing device, method, and program for processing of image information obtained by imaging the surrounding area of a vehicle | |
JP5229293B2 (en) | Vehicle driving support device | |
CN104346944B (en) | Method and apparatus for searching driving path | |
JP5747787B2 (en) | Lane recognition device | |
JP4577827B2 (en) | Next road prediction device for traveling vehicle | |
KR101704405B1 (en) | System and method for lane recognition | |
CN112400095A (en) | Method for generating driving environment information, driving control method, and driving environment information generating device | |
US10710583B2 (en) | Vehicle control apparatus | |
CN108573611B (en) | Speed limit sign fusion method and speed limit sign fusion system | |
JP2006189325A (en) | Present location information management device of vehicle | |
JP2006177862A (en) | Navigation apparatus | |
JP5382356B2 (en) | Driving assistance system | |
CN112400193B (en) | Method for generating running environment information, driving control method, and running environment information generating device | |
EP3211374A1 (en) | Travel route calculation device | |
CN107850456A (en) | Path guiding device and path guide method | |
JP2006162409A (en) | Lane determination device of crossing advancing road | |
JP2008165326A (en) | Feature recognition device, own vehicle location recognizing device, navigation device and feature recognition method | |
JP2008197004A (en) | Navigation system and navigation method | |
JP4844812B2 (en) | Inter-vehicle information communication system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20080221 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20100527 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20100603 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20100729 |
|
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: 20100819 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20100901 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130924 Year of fee payment: 3 |
|
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: 20130924 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140924 Year of fee payment: 4 |
|
LAPS | Cancellation because of no payment of annual fees |