JP4279241B2 - Vehicle control device - Google Patents
Vehicle control device Download PDFInfo
- Publication number
- JP4279241B2 JP4279241B2 JP2004327079A JP2004327079A JP4279241B2 JP 4279241 B2 JP4279241 B2 JP 4279241B2 JP 2004327079 A JP2004327079 A JP 2004327079A JP 2004327079 A JP2004327079 A JP 2004327079A JP 4279241 B2 JP4279241 B2 JP 4279241B2
- Authority
- JP
- Japan
- Prior art keywords
- branch path
- vehicle
- estimated
- road
- comparison
- 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 vehicle control device.
従来、例えば、車両の進行方向前方に複数の分岐路を検出した際に、各分岐路の道路属性(例えば、道路種別や幅員等)に応じて重み付けを行い、この重みに応じて車両が進入する分岐路を推定し、推定した分岐路に応じた車両制御を行う車両制御装置が知られている(例えば、特許文献1参照)。
また、従来、例えば、車両の進行方向前方に複数の分岐路を検出した際に、各分岐路の走行難易度を判定し、最も難易度が低い分岐路を選択し、選択した分岐路を適正に通過可能か否かを判定して、自動減速制御または警報出力制御を実行する車両制御装置が知られている(例えば、特許文献2参照)。
Conventionally, for example, when a plurality of branch roads are detected in front of the traveling direction of the vehicle, the travel difficulty of each branch road is determined, the branch road having the lowest difficulty is selected, and the selected branch road is appropriately selected. There is known a vehicle control device that determines whether or not the vehicle can pass through and executes automatic deceleration control or alarm output control (see, for example, Patent Document 2).
ところで、上記従来技術に係る装置においては、単に、各分岐路の道路属性や走行難易度に応じて自車両が進入する分岐路を推定するだけであるから、推定された分岐路と実際に進入する分岐路とが相違する場合には、例えば、推定された分岐路に応じて実行された車両制御に対して運転者が違和感を感じてしまったり、実際に進入する分岐路に対して必要とされる車両制御が実行されずに車両の走行安全性を向上させることができなくなる虞がある。
本発明は上記事情に鑑みてなされたもので、進行方向に存在する分岐路に対して自車両が進入する分岐路を推定する際に運転者の意志を適切に反映させることが可能な車両制御装置を提供することを目的としている。
By the way, in the apparatus according to the above-described prior art, the estimated branch road and the actual approach are actually entered because the vehicle merely estimates the branch road that the vehicle enters in accordance with the road attribute and the traveling difficulty of each branch road. For example, the driver may feel uncomfortable with respect to the vehicle control executed according to the estimated branch road, or may be necessary for the branch road that actually enters. There is a possibility that the traveling safety of the vehicle cannot be improved without executing the vehicle control.
The present invention has been made in view of the above circumstances, and is a vehicle control capable of appropriately reflecting a driver's will when estimating a branch road into which the host vehicle enters a branch road existing in the traveling direction. The object is to provide a device.
上記課題を解決して係る目的を達成するために、請求項1に記載の本発明の車両制御装置は、道路データを記憶する記憶手段(例えば、実施の形態での地図データ記憶部23)と、自車両の位置を検出する自車位置検出手段(例えば、実施の形態での現在位置検出部21)と、前記記憶手段が記憶した前記道路データに基づき自車両の進行方向に存在する分岐路を認識する分岐路認識手段(例えば、実施の形態での分岐路認識部65)と、予め設定した基準に基づき自車両が進入する分岐路を推定する推定手段(例えば、実施の形態での分岐路推定部66)と、前記推定手段により推定された推定分岐路に自車両が進入するための車両制御を行う制御手段(例えば、実施の形態での速度制御部41)とを備え、走行環境に基づき自車両を制御する車両制御装置であって、前記推定手段により推定された推定分岐路と、自車両が実際に進入した実分岐路とを比較する比較手段(例えば、実施の形態での分岐路比較部67)を備え、前記制御手段は、前記比較手段の比較結果において前記推定分岐路と前記実分岐路とが一致しない場合には、今回の処理での自車両の走行状態と同等の走行状態に対する前記推定手段での次回以降の推定処理において前記実分岐路を推定分岐路として推定するように前記推定手段を変更して、自車両を制御しており、前記制御手段により実行される前記推定分岐路に自車両が進入するための車両制御の実行状態を判定する状態判定手段を備え、前記比較手段は、前記状態判定手段にて前記制御手段により前記車両制御が実行されたと判定された場合に、前記推定分岐路と前記実分岐路とを比較することを特徴としている。
In order to solve the above-described problems and achieve the object, the vehicle control device according to the first aspect of the present invention includes storage means for storing road data (for example, the map
上記の車両制御装置によれば、実際に運転者が選択した実分岐路と推定分岐路とが相違する場合には、今回の処理にて選択した実分岐路を、次回以降の推定処理での推定分岐路として設定することから、推定処理を繰り返すことで推定結果に運転者の意志を的確に反映させ、推定精度を向上させることができる。
さらに、例えば進行方向に存在するカーブを適正に通過するための適正車両状態となるようにして警報の出力や自動減速を実行する制御等の車両制御が実行された場合に、実分岐路と推定分岐路とを比較することから、車両制御を実行する必要の無い状況においてまで過剰な頻度で推定分岐路と実分岐路とが比較されてしまうことを防止することができる。
According to the above vehicle control device, when the actual branch path actually selected by the driver is different from the estimated branch path, the actual branch path selected in the current process is changed to the next or subsequent estimation process. Since it is set as the estimated branch path, it is possible to accurately reflect the driver's will in the estimation result by repeating the estimation process, and to improve the estimation accuracy.
Furthermore, when a vehicle control such as an alarm output or a control for executing automatic deceleration is executed so that the vehicle is in an appropriate vehicle state for appropriately passing through a curve existing in the traveling direction, the actual branch path is estimated. By comparing with the branch path, it is possible to prevent the estimated branch path and the actual branch path from being compared with an excessive frequency even in a situation where it is not necessary to execute vehicle control.
さらに、請求項2に記載の本発明の車両制御装置は、前記比較手段の複数回に亘る比較処理の比較結果を記憶する比較結果記憶手段(例えば、実施の形態では分岐路比較部67が兼ねる)を備え、前記制御手段は、前記比較結果記憶手段に記憶された複数の比較結果において、前記推定分岐路と前記実分岐路とが一致しない比較結果の数が所定数以上となった場合に、前記推定手段を変更することを特徴としている。
Furthermore, the vehicle control apparatus according to the second aspect of the present invention is a comparison result storage unit (for example, a branch
上記の車両制御装置によれば、一致しない比較結果の数が所定数以上となった場合に推定手段を変更することから、推定処理の信頼度を向上させることができる。 According to the vehicle control device described above, since the estimation means is changed when the number of comparison results that do not match is equal to or greater than a predetermined number, the reliability of the estimation process can be improved.
さらに、請求項3に記載の本発明の車両制御装置では、前記比較結果記憶手段は前記複数の比較結果を時系列データとして記憶しており、前記制御手段は、前記比較結果記憶手段に記憶された複数の比較結果において、前記推定分岐路と前記実分岐路とが一致しない比較結果の数が時系列で連続した所定数以上となった場合に、前記推定手段を変更することを特徴としている。 Furthermore, in the vehicle control apparatus according to the third aspect of the present invention, the comparison result storage means stores the plurality of comparison results as time series data, and the control means is stored in the comparison result storage means. In the plurality of comparison results, the estimation means is changed when the number of comparison results in which the estimated branch path and the actual branch path do not match is equal to or greater than a predetermined number in time series. .
上記の車両制御装置によれば、一致しない比較結果の数が時系列で連続した所定数以上となった場合に推定手段を変更することから、推定処理の信頼度を、より一層、向上させることができる。 According to the vehicle control device described above, the estimation means is changed when the number of comparison results that do not match is equal to or greater than a predetermined number in time series, so that the reliability of the estimation process can be further improved. Can do.
以上説明したように、請求項1に記載の本発明の車両制御装置によれば、今回の処理にて選択した実分岐路を、次回以降の推定処理での推定分岐路として設定することから、推定処理を繰り返すことで推定結果に運転者の意志を的確に反映させ、推定精度を向上させることができる。
さらに、車両制御を実行する必要の無い状況においてまで過剰な頻度で推定分岐路と実分岐路とが比較されてしまうことを防止することができる。
さらに、請求項2に記載の本発明の車両制御装置によれば、一致しない比較結果の数が所定数以上となった場合に推定手段を変更することから、推定処理の信頼度を向上させることができる。
さらに、請求項3に記載の本発明の車両制御装置によれば、一致しない比較結果の数が時系列で連続した所定数以上となった場合に推定手段を変更することから、推定処理の信頼度を、より一層、向上させることができる。
As described above, according to the vehicle control device of the present invention described in
Furthermore, it is possible to prevent the estimated branch path and the actual branch path from being compared with an excessive frequency even in a situation where it is not necessary to execute vehicle control.
Furthermore, according to the vehicle control device of the present invention as set forth in claim 2, since the estimation means is changed when the number of comparison results that do not match is equal to or greater than a predetermined number, the reliability of the estimation process can be improved. Can do.
Further, according to the vehicle control device of the present invention as set forth in claim 3, the estimation means is changed when the number of comparison results that do not match is equal to or greater than a predetermined number in time series. The degree can be further improved.
以下、本発明の一実施形態に係る車両制御装置について添付図面を参照しながら説明する。 Hereinafter, a vehicle control device according to an embodiment of the present invention will be described with reference to the accompanying drawings.
図1に示すように、本実施の形態による車両制御装置10は、例えば、内燃機関11の駆動力を、オートマチックトランスミッション(AT)あるいは無段自動変速機(CVT)等のトランスミッション(T/M)12を介して車両の駆動輪に伝達する車両に搭載され、ナビゲーション装置13と、制御装置14と、ブレーキアクチュエータ15および警報装置(図示略)を具備する安全装置(図示略)とを備えて構成されている。
As shown in FIG. 1, the
ナビゲーション装置13は、例えば現在位置検出部21と、ナビゲーション処理部22と、地図データ記憶部23と、入力部24と、表示部25とを備えて構成されている。
さらに、現在位置検出部21は、例えば人工衛星を利用して車両の位置を測定するためのGPS(Global Positioning System)信号や、例えば適宜の基地局を利用してGPS信号の誤差を補正して測位精度を向上させるためのD(Differential)GPS信号等の測位信号を受信する測位信号受信部31と、水平面内での自車両の向きや鉛直方向に対する傾斜角度(例えば、車両の前後方向軸の鉛直方向に対する傾斜角度や車両重心の上下方向軸回りの回転角であるヨー角等)および傾斜角度の変化量(例えば、ヨーレート等)を検出するジャイロセンサ32と、車両の速度(車速)を検出する車速センサ33とを備えて構成され、受信した測位信号によって、あるいは、車速やヨーレート等の検出信号に基づく自律航法の算出処理によって、車両の現在位置を算出する。
The
Further, the current
地図データ記憶部23は、例えばハードディスク装置等の磁気ディスク装置や、例えばCD−ROMやCD−RやMOやDVD等の光ディスク装置等のコンピュータ読み取り可能な記憶媒体からなる。そして、地図データ記憶部23は、例えば表示部25において地図を表示するための地図データとして、例えば道路の幅員データや複数の道路の交差角度や交差点の形状や位置等の道路データを格納している。
The map
ナビゲーション処理部22は、例えば、地図データ記憶部23から取得される道路データに対して、現在位置検出部21における測位信号および自律航法の算出処理のそれぞれ、又は、何れかから得られる車両の現在位置の情報に基づいてマップマッチングを行い、位置検出の結果を補正すると共に、検出された車両の現在位置、あるいは、各種スイッチやキーボード等からなる入力部24を介して操作者により入力された適宜の車両の位置に対して、表示部25での地図表示を制御する。
また、ナビゲーション処理部22は、例えば車両の経路探索や経路誘導等の処理を実行し、地図データ記憶部23から取得される道路データと共に、例えば目的地までの経路情報や各種の付加情報を表示部25へ出力する。
For example, for the road data acquired from the map
In addition, the
制御装置14は、速度制御部41と、エンジン制御部42と、変速制御部43と、ブレーキ制御部44とを備えて構成され、さらに、速度制御部41は、カーブ認識部61と、適正車速設定部62と、比較部63と、作動部64と、分岐路認識部65と、分岐路推定部66と、分岐路比較部67とを備えて構成されている。
The
カーブ認識部61は、地図データ記憶部23に記憶された道路データを取得し、この道路データに基づいて自車両の進行方向の道路形状として道路上に存在するカーブを検出する。
例えばカーブ認識部61は、道路データの基礎となるノードつまり道路形状を把握するための点(例えば、図2に示す白抜き丸および黒丸)と、リンクつまり各ノードを結ぶ線(例えば、図2に示す白抜き丸および黒丸を結ぶ線)とに基づいて、カーブの形状を認識する。そして、例えばカーブの径や曲率および極性、カーブの長さ(カーブの深さ)、カーブの通過に要する旋回角等からなるカーブ形状値を算出し、適正車速設定部62へ出力する。
The curve recognition unit 61 acquires road data stored in the map
For example, the curve recognizing unit 61 is a node that is a basis of road data, that is, a point for grasping the road shape (for example, white circles and black circles shown in FIG. 2) and a link that connects each node (for example, FIG. 2). The shape of the curve is recognized based on the white circle and the black circle shown in FIG. Then, for example, a curve shape value including a curve diameter, a curvature and a polarity, a curve length (curve depth), a turning angle required for passing through the curve, and the like is calculated and output to the appropriate vehicle
適正車速設定部62は、カーブ認識部61にて認識されたカーブ形状値に基づいて、このカーブを適正に通過可能な車両の速度(適正速度VS)を算出する。そして、適正車速設定部62は設定した適正速度VSのデータを比較部63へ出力する。
ここで、適正車速設定部62は、カーブ通過時に車両の横方向に発生する加速度(横加速度)を算出する横加速度算出部62aを備えている。すなわち、先ず、横加速度算出部62aは、カーブ認識部61にて認識されたカーブの形状に基づいて、このカーブを適正に通過する際に許容される横加速度を算出する。次に、適正車速設定部62は、この横加速度を車両に発生させる車両の速度を算出し、この速度を適正速度VSとして設定する。
なお、カーブ通過時に自車両に許容される横加速度は、路面状況、タイヤの状況、積載の状態等により変化するため、これらを更に考慮して適正速度VSを設定するようにしてもよい。
また、認識されたカーブの形状の手前に上り勾配または下り勾配が存在する場合には、勾配の大きさに応じて適正速度VSが設定されるようになっている。
Based on the curve shape value recognized by the curve recognition unit 61, the appropriate vehicle
Here, the appropriate vehicle
Note that the lateral acceleration allowed for the host vehicle when passing the curve changes depending on the road surface condition, the tire condition, the loading condition, and the like. Therefore, the appropriate speed VS may be set in consideration of these factors.
In addition, when there is an ascending or descending slope before the recognized curve shape, the appropriate speed VS is set according to the magnitude of the slope.
比較部63は、現在位置検出部21の車速センサ33にて検出した車両の速度(現在速度)VPと、適正車速設定部62にて設定した適正速度VSとを比較して、この比較結果を作動部64へ出力する。
作動部64は、比較部63での比較結果に基づいてエンジン制御部42および変速制御部43およびブレーキ制御部44の作動を制御する。例えば、比較部63での比較結果において、車速センサ33にて検出した現在速度VPと適正車速設定部62にて設定した適正速度VSとが異なる場合、例えば検出された車両の現在速度VPが適正速度VSよりも高い状態等のように車両が適正車両状態にない場合には、所定期間に亘って、警報装置を作動させて運転者の注意を喚起したり、ブレーキ制御部44を介してブレーキアクチュエータ15を作動させて自動的に車両を減速させる。
The
The operating
作動部64にて警報装置およびブレーキアクチュエータ15等からなる安全装置を作動させるタイミングは、車両がカーブ認識部61にて認識したカーブの入口位置に到達するまでに、現在速度VPから適正速度VSまで減速する際に要する時間または距離等に基づいて設定される。
例えば図2に示すように、車両Aが速度V1(例えば、速度V1>適正速度VS)で走行している場合に、進行方向前方に存在するカーブCを適正に通過するためには、カーブCの入口位置CSにて車両の速度が適正速度VSとなるように設定する。
このとき、例えば所定の減速度GS(例えば、0.2G=0.2×9.8m/s2)にて、現在の速度V1(例えば、100km/h)から適正速度VS(例えば、40km/h)まで減速する場合には、減速に要する時間TはT=(V1−VS)/GSにより求められる。そして、この時間Tに基づいて、減速に要する距離つまり減速必要距離L0が算出され、カーブCの入口位置CSから、減速必要距離L0だけ手前の減速開始位置C0(図2に示す黒丸C0)が設定される。
The operating
For example, as shown in FIG. 2, when the vehicle A is traveling at a speed V1 (for example, speed V1> appropriate speed VS), in order to properly pass the curve C existing forward in the traveling direction, the curve C The vehicle speed is set to the appropriate speed VS at the entrance position CS.
At this time, for example, at a predetermined deceleration GS (for example, 0.2 G = 0.2 × 9.8 m / s 2 ), the current speed V1 (for example, 100 km / h) to the appropriate speed VS (for example, 40 km / h). In the case of deceleration to h), the time T required for deceleration is obtained by T = (V1−VS) / GS. Then, based on this time T, the distance required for deceleration, that is, the required deceleration distance L0 is calculated, and the deceleration start position C0 (black circle C0 shown in FIG. 2) just before the required deceleration distance L0 from the entrance position CS of the curve C is calculated. Is set.
さらに、例えば、警報を発して運転者に注意を促してから、実際に運転者が反応してブレーキを踏み込むまでの反応時間(例えば、約0.5s)と、運転者がブレーキを踏み込んでから実際にブレーキが効き始めるまでの空走時間(例えば、約0.3s)とを考慮して反応空走距離ΔL0を算出する。これにより、減速開始位置C0(図2に示す黒丸C0)から反応空走距離ΔL0だけ手前の警報開始位置CWが設定される。
すなわち、車両AがカーブCの手前に設定される警報開始位置CWに到達した時点、つまり車両Aの現在位置とカーブCの入口位置CSとの間の距離(減速対象地点間距離Ln)が、下記数式(1)に示すように設定される警報必要距離LWに等しくなった時点で警報を発する。
Furthermore, for example, a reaction time (for example, about 0.5 s) from when an alarm is issued to alert the driver until the driver actually reacts and depresses the brake, and after the driver depresses the brake. The reaction idling distance ΔL0 is calculated in consideration of the idling time (for example, about 0.3 s) until the brake actually starts to work. As a result, the alarm start position CW is set by the reaction idling distance ΔL0 from the deceleration start position C0 (black circle C0 shown in FIG. 2).
That is, when the vehicle A reaches the alarm start position CW set before the curve C, that is, the distance between the current position of the vehicle A and the entrance position CS of the curve C (distance Ln between deceleration target points) An alarm is issued when the required alarm distance LW is set as shown in the following formula (1).
また、速度制御部41には、車速センサ33から出力される検出信号に加えて、運転者によるアクセルペダルの操作量に係るアクセル開度を検出するアクセル開度センサ51と、運転者によるブレーキペダルの操作量を検出するブレーキペダルセンサ52と、スロットル開度を検出するスロットル開度センサ53とから出力される各検出信号が入力されている。
In addition to the detection signal output from the
分岐路認識部65は、地図データ記憶部23に記憶された道路データを取得し、この道路データに基づいて自車両の進行方向の道路形状として道路上に存在する分岐路を検出する。
分岐路推定部66は、分岐路認識部65にて検出した複数の分岐路のうち自車両が進入する分岐路を、例えば地図データ記憶部23に記憶された道路データおよび分岐路比較部67に記憶された比較結果のデータに基づき推定する。
例えば、分岐路推定部66は、道路データに含まれる道路種別(国道、県道、市道等)や路線に応じて推定分岐路を推定しており、例えば図3および図4に示すように、県道R0を走行中の自車両Pの進行方向に分岐点Bから分岐する2つの分岐路として、県道R1と市道R2とが存在する場合には、同等の道路種別である県道R1を推定分岐路として推定するようになっている。
分岐路比較部67は、例えば現在位置の時間変化やジャイロセンサ22の検出結果等により算出した自車両の進行軌跡等に基づき、自車両が実際に進入した実分岐路を検知し、この実分岐路と、分岐路推定部66にて推定された推定分岐路とを比較し、この比較結果を累積的に記憶する。
The branch
The branch
For example, the branch
The branch
そして、作動部64は、分岐路比較部67での比較結果において、推定分岐路と実分岐路とが一致しない場合には、今回の処理での自車両の走行状態と同等の走行状態に対する分岐路推定部66での次回以降の推定処理において、今回の処理での実分岐路を次回以降の推定分岐路として推定するように分岐路推定部66の処理内容を変更する。
ここで、作動部64は、例えば分岐路比較部67に時系列データとして記憶された複数の比較結果のデータに対し、推定分岐路と前記実分岐路とが一致しない比較結果の数が所定数以上となった場合、あるいは、推定分岐路と前記実分岐路とが一致しない比較結果の数が時系列で連続した所定数以上となった場合に、今回の処理での自車両の走行状態と同等の走行状態に対する分岐路推定部66での次回以降の推定処理において、今回の処理での実分岐路を次回以降の推定分岐路として推定する。
When the estimated branch road and the actual branch road do not coincide with each other in the comparison result of the branch
Here, for example, with respect to a plurality of comparison result data stored as time series data in the branch
本実施の形態による車両制御装置10は上記構成を備えており、次に、この車両制御装置10の動作について添付図面を参照しながら説明する。
The
先ず、以下に、進行方向に存在するカーブに対して安全装置として、例えば警報装置を作動させるか否かを判定する処理について説明する。
例えば図5に示すステップS01においては、安全装置の作動対象となる地点(警報対象地点)、つまりカーブ認識部61にて認識したカーブの入口位置CSを推定する。
次に、ステップS02においては、現在位置検出部21にて検出した自車両の現在位置から安全装置の作動対象となる地点(例えば、カーブの入口位置CS)までの距離、つまり警報対象地点間距離Lnを算出する。
First, a process for determining whether or not to activate, for example, an alarm device as a safety device for a curve existing in the traveling direction will be described below.
For example, in step S01 shown in FIG. 5, a point (alarm target point) that is the operation target of the safety device, that is, the entrance position CS of the curve recognized by the curve recognition unit 61 is estimated.
Next, in step S02, the distance from the current position of the host vehicle detected by the current
次に、ステップS03においては、上記数式(1)に基づいて、警報必要距離LWを算出する。
次に、ステップS04においては、警報対象地点間距離Lnが警報必要距離LWよりも小さいか否かを判定する。
この判定結果が「YES」の場合には、ステップS05に進み、ステップS05においては、安全装置の作動(例えば、警報の出力)が必要であると判断して、一連の処理を終了する。
一方、この判定結果が「NO」の場合には、ステップS06に進み、ステップS06においては、安全装置の作動(例えば、警報の出力)が不必要であると判断して、一連の処理を終了する。
Next, in step S03, the alarm required distance LW is calculated based on the above formula (1).
Next, in step S04, it is determined whether the distance Ln between warning target points is smaller than the warning required distance LW.
When the determination result is “YES”, the process proceeds to step S05, and in step S05, it is determined that the operation of the safety device (for example, output of an alarm) is necessary, and the series of processes is ended.
On the other hand, if this determination is “NO”, the flow proceeds to step S 06, and in step S 06, it is determined that the operation of the safety device (for example, output of an alarm) is unnecessary, and the series of processing ends. To do.
次に、以下に、進行方向に存在する複数の分岐路から推定分岐路を推定すると共に、推定分岐路と実分岐路との比較結果に応じて推定処理を変更する処理について説明する。
先ず、図6に示すステップS11においては、後述する分岐路推定処理を実行する。
次に、ステップS12においては、地図データ記憶部23に格納された道路データに基づいて、進行方向にカーブ形状が存在するか否かを判定する。
この判定結果が「NO」の場合には、一連の処理を終了する。
一方、この判定結果が「YES」の場合には、ステップS13に進む。
そして、ステップS13においては、ステップS11にて推定した推定分岐路上にカーブが存在するか否かを判定する。
この判定結果が「NO」の場合には、一連の処理を終了する。
一方、この判定結果が「YES」の場合には、ステップS14に進む。
Next, a process for estimating an estimated branch path from a plurality of branch paths existing in the traveling direction and changing the estimation process according to a comparison result between the estimated branch path and the actual branch path will be described.
First, in step S11 shown in FIG. 6, a branch path estimation process to be described later is executed.
Next, in step S12, based on the road data stored in the map
When the determination result is “NO”, the series of processes is terminated.
On the other hand, if the determination is “YES”, the flow proceeds to step S13.
In step S13, it is determined whether or not a curve exists on the estimated branch path estimated in step S11.
When the determination result is “NO”, the series of processes is terminated.
On the other hand, if the determination is “YES”, the flow proceeds to step S14.
そして、ステップS14においては、安全装置の作動状態、例えば減速制御の作動中であるか否かを判定する。
この判定結果が「NO」の場合には、一連の処理を終了する。
一方、この判定結果が「YES」の場合には、ステップS15に進む。
そして、ステップS15においては、自車両が作動対象とされる分岐点を通過したか否かを判定する。
ステップS15の判定結果が「NO」の場合には、一連の処理を終了する。
一方、ステップS15の判定結果が「YES」の場合には、ステップS16に進む。
そして、ステップS16においては、例えば現在位置の時間変化やジャイロセンサ22の検出結果等により算出した自車両の進行軌跡等に基づき、自車両が実際に進入した実分岐路を検知し、この実分岐路と推定分岐路とが異なるか否かを判定し、この判定結果を記憶する。
ステップS16の判定結果が「NO」の場合、つまり実分岐路と推定分岐路とが同等である場合には、一連の処理を終了する。
一方、ステップS16の判定結果が「YES」の場合には、ステップS17に進む。
In step S14, it is determined whether or not the operating state of the safety device, for example, deceleration control is in operation.
When the determination result is “NO”, the series of processes is terminated.
On the other hand, if the determination is “YES”, the flow proceeds to step S15.
In step S15, it is determined whether or not the host vehicle has passed a branch point to be actuated.
If the determination result of step S15 is “NO”, the series of processing is terminated.
On the other hand, if the determination result of step S15 is “YES”, the process proceeds to step S16.
In step S16, the actual branch path on which the host vehicle has actually entered is detected based on, for example, the travel locus of the host vehicle calculated from the time change of the current position, the detection result of the
If the determination result in step S16 is “NO”, that is, if the actual branch path and the estimated branch path are equivalent, the series of processing ends.
On the other hand, if the determination result of step S16 is “YES”, the process proceeds to step S17.
そして、ステップS17においては、学習回数mに「1」を加算して得た値を、新たに学習回数mとして更新設定する。
そして、ステップS18においては、学習回数mが所定値#Mよりも大きいか否かを判定する。
この判定結果が「NO」の場合には、一連の処理を終了する。
一方、この判定結果が「YES」の場合には、ステップS19に進む。
そして、ステップS19においては、今回の処理での自車両の走行状態と同等の走行状態に対する次回以降の推定処理において、今回の処理での実分岐路を次回以降の推定分岐路として推定するようにステップS11の処理内容を変更し、一連の処理を終了する。
In step S17, a value obtained by adding “1” to the learning number m is newly updated and set as the learning number m.
In step S18, it is determined whether or not the learning count m is greater than a predetermined value #M.
When the determination result is “NO”, the series of processes is terminated.
On the other hand, if the determination is “YES”, the flow proceeds to step S19.
In step S19, in the next and subsequent estimation processes for the traveling state equivalent to the traveling state of the host vehicle in the current process, the actual branch path in the current process is estimated as the estimated branch path from the next time. The processing content in step S11 is changed, and the series of processing ends.
例えば図3および図4に示すように、県道R0を走行中の自車両Pに対して同等の道路種別である県道R1を推定分岐路として推定している状態で、実分岐路として市道R2が選択された場合には、今回の処理での自車両の走行状態(例えば、県道R0での進行方向)と同等の走行状態に対して、次回以降の推定処理で市道R2が推定分岐路として推定されるように変更される。 For example, as shown in FIGS. 3 and 4, the prefectural road R1 that is the equivalent road type for the host vehicle P traveling on the prefectural road R0 is estimated as the estimated branch road, and the city road R2 is used as the actual branch road. Is selected, the city road R2 is estimated to be the estimated branch road in the estimation process from the next time on, for the traveling state equivalent to the traveling state of the host vehicle in the current process (for example, the traveling direction on the prefectural road R0). To be estimated as
以下に、上述したステップS11の分岐路推定処理について説明する。
先ず、図7に示すステップS21においては、各種の変数を初期化する。
次に、ステップS22においては、ナビゲーション装置13による経路誘導の実行中であるか否かを判定する。
この判定結果が「YES」の場合には、後述するステップS24に進む。
一方、この判定結果が「NO」の場合には、ステップS23に進む。
そして、ステップS23においては、自車両が誘導経路に沿って走行中であるか否かを判定する。
ステップS23の判定結果が「YES」の場合には、一連の処理を終了する。
一方、ステップS23の判定結果が「NO」の場合には、ステップS24に進む。
Below, the branch path estimation process of step S11 mentioned above is demonstrated.
First, in step S21 shown in FIG. 7, various variables are initialized.
Next, in step S22, it is determined whether route guidance by the
If this determination is “YES”, the flow proceeds to step
On the other hand, if this determination is “NO”, the flow proceeds to step S23.
In step S23, it is determined whether or not the host vehicle is traveling along the guidance route.
If the determination result of step S23 is “YES”, the series of processing ends.
On the other hand, if the determination result of step S23 is “NO”, the process proceeds to step S24.
そして、ステップS24においては、走行中の道路の種別および路線を認識しているか否かを判定する。
この判定結果が「NO」の場合には、一連の処理を終了する。
一方、この判定結果が「YES」の場合には、ステップS25に進む。
そして、ステップS25においては、例えば地図データ記憶部23に格納された道路データに基づいて、走行中の道路の進行方向前方に分岐路が存在するか否かを判定する。
ステップS25の判定結果が「NO」の場合には、一連の処理を終了する。
一方、ステップS25の判定結果が「YES」の場合には、ステップS26に進む。
In step S24, it is determined whether or not the type and route of the running road are recognized.
When the determination result is “NO”, the series of processes is terminated.
On the other hand, if this determination is “YES”, the flow proceeds to step S25.
In step S25, for example, based on the road data stored in the map
If the determination result in step S25 is “NO”, the series of processes is terminated.
On the other hand, if the determination result of step S25 is “YES”, the process proceeds to step S26.
そして、ステップS26においては、走行中の道路の種別よりも上位種別の分岐路(例えば、走行中の県道に対する国道の分岐路等)が存在しないか否かを判定する。
この判定結果が「NO」の場合には、推定分岐路の信頼度が低下する虞があると判断して、一連の処理を終了する。
一方、この判定結果が「YES」の場合には、ステップS27に進む。
そして、ステップS27においては、走行中の道路と同等の種別および同等の路線の分岐路(候補分岐路)が存在するか否かを判定する。
ステップS27の判定結果が「NO」の場合には、推定分岐路の信頼度が低下する虞があると判断して、一連の処理を終了する。
一方、ステップS27の判定結果が「YES」の場合には、ステップS28に進む。
そして、ステップS28においては、走行中の道路と同等の種別および同等の路線の分岐路(候補分岐路)が存在するか否かを判定する。
ステップS27の判定結果が「NO」の場合には、一連の処理を終了する。
一方、ステップS27の判定結果が「YES」の場合には、ステップS28に進む。
In step S26, it is determined whether or not there is a branch road of a higher class than the type of road being traveled (for example, a branch road of a national road for a prefectural road being traveled).
If the determination result is “NO”, it is determined that the reliability of the estimated branch path may be lowered, and the series of processes is terminated.
On the other hand, if this determination is “YES”, the flow proceeds to step S27.
In step S27, it is determined whether or not there is a branch road (candidate branch road) of the same type and the same route as the traveling road.
If the determination result of step S27 is “NO”, it is determined that the reliability of the estimated branch path may be lowered, and the series of processes is terminated.
On the other hand, if the determination result of step S27 is “YES”, the process proceeds to step S28.
In step S28, it is determined whether there is a branch road (candidate branch road) of the same type and the same route as the traveling road.
If the determination result of step S27 is “NO”, the series of processing is terminated.
On the other hand, if the determination result of step S27 is “YES”, the process proceeds to step S28.
そして、ステップS28においては、候補分岐路の数がひとつであるか否かを判定する。
この判定結果が「NO」の場合には、一連の処理を終了する。
一方、この判定結果が「YES」の場合には、ステップS29に進む。
そして、ステップS29においては、所定領域内での複数の分岐点のうち、候補分岐路が存在する分岐点数nに「1」を加算して得た値を、新たに候補分岐路が存在する分岐点数nとして更新設定する。
そして、ステップS30においては、現在位置から第n番目の候補分岐路の終点位置までの距離Lが所定距離#L(例えば、800m等)よりも大きいか否かを判定する。
この判定結果が「NO」の場合には、上述したステップS25に戻る。
一方、この判定結果が「YES」の場合には、一連の処理を終了する。
In step S28, it is determined whether the number of candidate branch paths is one.
When the determination result is “NO”, the series of processes is terminated.
On the other hand, if this determination is “YES”, the flow proceeds to step S29.
In step S29, a value obtained by adding “1” to the number n of branch points where a candidate branch path is present among a plurality of branch points in the predetermined region is used as a branch having a new candidate branch path. The update is set as the score n.
In step S30, it is determined whether the distance L from the current position to the end point position of the nth candidate branch path is greater than a predetermined distance #L (for example, 800 m).
If this determination is “NO”, the flow returns to step
On the other hand, if the determination result is “YES”, the series of processing ends.
上述したように、本実施の形態による車両制御装置10によれば、実際に運転者が選択した実分岐路と推定分岐路とが相違する比較結果の数が所定数以上となった場合に推定手段を変更し、今回の処理にて選択した実分岐路を、次回以降の推定処理での推定分岐路として設定することから、推定処理を繰り返すことで推定結果に運転者の意志を的確に反映させ、推定精度および推定処理に対する信頼度を向上させることができる。
As described above, according to the
なお、本実施の形態においては、道路種別および路線に応じて推定分岐路を推定したが、これに限定されず、例えば道路の幅員や回転半径や交差角等のその他の道路形状に応じて推定してもよい。 In the present embodiment, the estimated branch road is estimated according to the road type and route, but is not limited to this, and is estimated according to other road shapes such as road width, turning radius, intersection angle, and the like. May be.
10 車両制御装置
21 現在位置検出部(自車位置検出手段)
23 地図データ記憶部(記憶手段)
41 速度制御部(制御手段)
65 分岐路認識部(分岐路認識手段)
66 分岐路推定部(推定手段)
67 分岐路比較部(比較手段、比較結果記憶手段)
ステップS14 状態判定手段
10
23 Map data storage unit (storage means)
41 Speed control unit (control means)
65 Branch recognition unit (branch recognition means)
66 Branch estimator (estimator)
67 Branch comparison unit (comparison means, comparison result storage means)
Step S14 State determination means
Claims (3)
自車両の位置を検出する自車位置検出手段と、
前記記憶手段が記憶した前記道路データに基づき自車両の進行方向に存在する分岐路を認識する分岐路認識手段と、
予め設定した基準に基づき自車両が進入する分岐路を推定する推定手段と、
前記推定手段により推定された推定分岐路に自車両が進入するための車両制御を行う制御手段とを備え、走行環境に基づき自車両を制御する車両制御装置であって、
前記推定手段により推定された推定分岐路と、自車両が実際に進入した実分岐路とを比較する比較手段を備え、
前記制御手段は、前記比較手段の比較結果において前記推定分岐路と前記実分岐路とが一致しない場合には、今回の処理での自車両の走行状態と同等の走行状態に対する前記推定手段での次回以降の推定処理において前記実分岐路を推定分岐路として推定するように前記推定手段を変更して、自車両を制御しており、
前記制御手段により実行される前記推定分岐路に自車両が進入するための車両制御の実行状態を判定する状態判定手段を備え、
前記比較手段は、前記状態判定手段にて前記制御手段により前記車両制御が実行されたと判定された場合に、前記推定分岐路と前記実分岐路とを比較することを特徴とする車両制御装置。 Storage means for storing road data;
Own vehicle position detecting means for detecting the position of the own vehicle;
Branch road recognition means for recognizing a branch road existing in the traveling direction of the host vehicle based on the road data stored by the storage means;
An estimation means for estimating a branch road into which the host vehicle enters based on a preset criterion;
A vehicle control device for controlling the host vehicle based on a traveling environment, comprising: a control unit that performs vehicle control for the host vehicle to enter the estimated branch path estimated by the estimating unit;
Comparing means for comparing the estimated branch path estimated by the estimating means with the actual branch path on which the host vehicle actually entered,
If the estimated branch road and the actual branch road do not coincide with each other in the comparison result of the comparison means, the control means uses the estimation means for the traveling state equivalent to the traveling state of the host vehicle in the current process. The estimation means is changed so as to estimate the actual branch path as an estimated branch path in the estimation process after the next time, and the vehicle is controlled .
A state determination unit that determines a vehicle control execution state for the host vehicle to enter the estimated branch path that is executed by the control unit;
The comparison unit compares the estimated branch path with the actual branch path when the state determination unit determines that the vehicle control is executed by the control unit.
前記制御手段は、前記比較結果記憶手段に記憶された複数の比較結果において、前記推定分岐路と前記実分岐路とが一致しない比較結果の数が所定数以上となった場合に、前記推定手段を変更することを特徴とする請求項1に記載の車両制御装置。 A comparison result storage means for storing a comparison result of a comparison process over a plurality of times of the comparison means;
When the number of comparison results in which the estimated branch path and the actual branch path do not match among a plurality of comparison results stored in the comparison result storage means is equal to or greater than a predetermined number, the control means The vehicle control device according to claim 1, wherein:
前記制御手段は、前記比較結果記憶手段に記憶された複数の比較結果において、前記推定分岐路と前記実分岐路とが一致しない比較結果の数が時系列で連続した所定数以上となった場合に、前記推定手段を変更することを特徴とする請求項2に記載の車両制御装置。 The comparison result storage means stores the plurality of comparison results as time series data,
In the case where the number of comparison results in which the estimated branch path and the actual branch path do not match among the plurality of comparison results stored in the comparison result storage section is equal to or greater than a predetermined number that is continuous in time series. The vehicle control apparatus according to claim 2, wherein the estimation unit is changed.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004327079A JP4279241B2 (en) | 2004-11-10 | 2004-11-10 | Vehicle control device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004327079A JP4279241B2 (en) | 2004-11-10 | 2004-11-10 | Vehicle control device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2006137259A JP2006137259A (en) | 2006-06-01 |
JP4279241B2 true JP4279241B2 (en) | 2009-06-17 |
Family
ID=36618345
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2004327079A Expired - Fee Related JP4279241B2 (en) | 2004-11-10 | 2004-11-10 | Vehicle control device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4279241B2 (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11100794B2 (en) | 2019-04-15 | 2021-08-24 | Here Global B.V. | Autonomous driving and slowdown patterns |
-
2004
- 2004-11-10 JP JP2004327079A patent/JP4279241B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2006137259A (en) | 2006-06-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US7650217B2 (en) | Adaptive cruise control system and navigation system's media with vehicle control information included | |
US8204665B2 (en) | Vehicle controller, control method, and computer program | |
JP2017013749A (en) | Automatic driving vehicle control device | |
JP4795069B2 (en) | Vehicle travel safety device | |
CN109795491A (en) | Drive assistance device | |
JP4874725B2 (en) | Deceleration intention determination device for vehicle and travel control device | |
JP4860391B2 (en) | Vehicle travel safety device | |
JP4149429B2 (en) | Vehicle travel safety device | |
JP4979644B2 (en) | Navigation device and vehicle travel safety device | |
JP5130154B2 (en) | Travel control device | |
JP2000025538A (en) | Traveling control device for vehicle | |
JP4191126B2 (en) | Vehicle travel safety device having a constant speed travel control device | |
JP2006123586A (en) | Vehicular running safety device equipped with controller for constant speed running | |
JP4754443B2 (en) | Vehicle travel safety device | |
JP4339228B2 (en) | Vehicle travel safety device | |
JP4335116B2 (en) | Vehicle travel safety device | |
JP4279241B2 (en) | Vehicle control device | |
JP4279242B2 (en) | Vehicle control device | |
JP2007186097A (en) | Vehicle travel controller | |
JP4327070B2 (en) | Vehicle travel safety device | |
JP4290635B2 (en) | Vehicle travel safety device having a constant speed travel control device | |
JP4302612B2 (en) | Vehicle travel safety device | |
JP2006143051A (en) | Vehicle control device | |
JP4818970B2 (en) | Vehicle travel safety device | |
JP4842059B2 (en) | Vehicle travel safety device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20061128 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20081023 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20081028 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20081210 |
|
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: 20090303 |
|
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: 20090311 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120319 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: 20120319 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130319 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130319 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140319 Year of fee payment: 5 |
|
LAPS | Cancellation because of no payment of annual fees |