JP6477377B2 - Vehicle control apparatus and vehicle control method - Google Patents
Vehicle control apparatus and vehicle control method Download PDFInfo
- Publication number
- JP6477377B2 JP6477377B2 JP2015181858A JP2015181858A JP6477377B2 JP 6477377 B2 JP6477377 B2 JP 6477377B2 JP 2015181858 A JP2015181858 A JP 2015181858A JP 2015181858 A JP2015181858 A JP 2015181858A JP 6477377 B2 JP6477377 B2 JP 6477377B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- lateral distance
- locus
- trajectory
- travel
- 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.)
- Active
Links
Images
Landscapes
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Controls For Constant Speed Travelling (AREA)
Description
本発明は、車両制御装置、及び車両制御方法に関するものである。 The present invention relates to a vehicle control device and a vehicle control method.
自車の進行方向前方に存在する他車の位置を検出し、自車に対する他車の相対位置を用いて、追従制御の対象とすべき他車であるか否かを判定する技術が提案されている。 A technique has been proposed in which the position of another vehicle existing in the forward direction of the host vehicle is detected, and the relative position of the other vehicle with respect to the host vehicle is used to determine whether or not the other vehicle is to be subject to follow-up control. ing.
例えば、特許文献1に記載のものでは、自車の進行方向前方を走行する先行車の走行軌跡と、自車と並行して走行する並走車の走行軌跡とが並行である場合には、先行車を追従するようにしている。また、それら走行軌跡が並行でなくなった場合には、先行車を追従しないようにしている。この場合、先行車が車線変更を行った場合に先行車の走行軌跡と並走車の走行軌跡は並行でなくなることから、車線変更を行った先行車を追従することを回避するようにしている。
For example, in the one described in
ところで、特許文献1に記載のものでは、走行軌跡が自車の走行位置にまで延びている状態で、自車の前方を走行する先行車を追従対象として判定することが可能となっている。このため、走行軌跡が自車にまで延びていない場合には、走行軌跡が自車にまで延びることを待つ必要があり、追従制御の開始に遅れが生じる。この点において、他車を追従対象として判別する車両制御装置及び車両制御方法として技術改善の余地があると考えられる。
By the way, in the thing of
本発明は上記事情を鑑みてなされたものであり、その主たる目的は、いち早く追従すべき他車を判定して追従制御を開始することができる車両制御装置及び車両制御方法を提供することにある。 The present invention has been made in view of the above circumstances, and a main object of the present invention is to provide a vehicle control device and a vehicle control method capable of determining another vehicle to be followed immediately and starting the follow-up control. .
以下、上記課題を解決するための手段、及びその作用効果について説明する。 Hereinafter, means for solving the above-described problems and the effects thereof will be described.
本発明における車両制御装置及び車両制御方法は、自車の前方を走行する他車を追従対象として自車の追従制御を実施する車両制御装置であって、他車の走行位置を所定の取得周期で取得し、他車の走行経路に沿った複数の走行位置から他車の走行軌跡を生成する軌跡生成部と、自車の進行方向に直交する方向における自車から走行軌跡までの距離である横距離を算出する横距離算出部と、他車の走行軌跡のうち自車が追従すべき追従軌跡を判定するとともに、その追従軌跡が自車まで延びているか否かを判定する軌跡判定部と、追従軌跡が自車まで延びていると判定した場合に、自車の現在位置における軌跡位置での横距離を第1横距離として取得する第1横距離取得部と、追従軌跡が自車まで延びていないと判定した場合に、追従軌跡におけるいずれかの位置での横距離を第2横距離として取得する第2横距離取得部と、第1横距離又は第2横距離に基づいて、追従制御を実施する追従制御部と、を備えることを特徴とする。 A vehicle control device and a vehicle control method according to the present invention are vehicle control devices that perform tracking control of a host vehicle with another vehicle traveling in front of the host vehicle as a tracking target, and determine the travel position of the other vehicle in a predetermined acquisition cycle. The distance from the own vehicle to the travel locus in a direction orthogonal to the traveling direction of the own vehicle, and a locus generation unit that generates a travel locus of the other vehicle from a plurality of travel positions along the travel route of the other vehicle. A lateral distance calculation unit that calculates a lateral distance, a trajectory determination unit that determines a tracking trajectory that the own vehicle should follow among the travel trajectories of other vehicles, and determines whether the following trajectory extends to the own vehicle A first lateral distance acquisition unit that acquires the lateral distance at the trajectory position at the current position of the host vehicle as the first lateral distance when it is determined that the tracking trajectory extends to the host vehicle; If it is determined that it has not extended, A second lateral distance acquisition unit that acquires a lateral distance at any position as a second lateral distance, and a tracking control unit that performs tracking control based on the first lateral distance or the second lateral distance. It is characterized by that.
上記構成によれば、自車の前方に他車が走行している場合には、他車の走行位置からその他車の走行経路に沿った走行軌跡が生成される。また、他車の走行軌跡のうち自車が追従すべき追従軌跡が判定されるとともに、その追従軌跡が自車まで延びているか否かが判定される。このとき、追従軌跡が自車まで延びていると判定された場合には、自車の現在位置における軌跡位置での横距離が第1横距離として算出される。また、追従軌跡が自車まで延びていないと判定された場合には、追従軌跡におけるいずれかの位置で横距離が第2横距離として算出される。これら第1横距離又は第2横距離の軌跡位置から追従軌跡に沿って追従対象となる他車を追従する自車の追従制御が行われる。この場合、自車近傍に走行軌跡が延びていなくても、追従すべき他車を判定することができる。その結果、いち早く追従すべき他車を判定して追従制御を開始することができる。 According to the above configuration, when another vehicle is traveling ahead of the host vehicle, a travel locus along the travel route of the other vehicle is generated from the travel position of the other vehicle. In addition, a follow-up locus that the own vehicle should follow is determined from the travel locus of the other vehicle, and it is determined whether the follow-up locus extends to the own vehicle. At this time, when it is determined that the tracking locus extends to the own vehicle, the lateral distance at the locus position at the current position of the own vehicle is calculated as the first lateral distance. If it is determined that the tracking locus does not extend to the host vehicle, the lateral distance is calculated as the second lateral distance at any position in the tracking locus. Follow-up control of the own vehicle that follows the other vehicle to be followed from the locus position of the first lateral distance or the second lateral distance along the follow-up locus is performed. In this case, even if the traveling locus does not extend in the vicinity of the own vehicle, the other vehicle to be followed can be determined. As a result, it is possible to determine the other vehicle that should follow quickly and start the follow-up control.
以下、車両制御装置を具体化した実施形態について、図面を参照しつつ説明する。本実施形態に係る車両制御装置は自車に搭載されており、自車の前方を走行する他車を追従対象として、その追従対象を追従する自車の追従制御を実施するものである。当該車両制御装置は、ACC(Adaptive Cruise Control)機能を有し、自車の車速、及び自車と追従対象となる他車との車間距離を制御する。まずは、本実施形態の車両制御システムの概略構成について図1を用いて説明する。 Hereinafter, an embodiment in which a vehicle control device is embodied will be described with reference to the drawings. The vehicle control device according to the present embodiment is mounted on the own vehicle, and performs follow-up control of the own vehicle that follows the follow target, with another vehicle traveling in front of the own vehicle as the follow target. The vehicle control device has an ACC (Adaptive Cruise Control) function, and controls the vehicle speed of the host vehicle and the inter-vehicle distance between the host vehicle and another vehicle to be followed. First, a schematic configuration of the vehicle control system of the present embodiment will be described with reference to FIG.
図1において、車両制御装置である車両制御ECU10には、車両に備えられた測距装置としてのレーダ装置21が接続されており、レーダ装置21から車両制御ECU10に検知情報が入力される。
In FIG. 1, a vehicle control ECU 10 that is a vehicle control device is connected to a
レーダ装置21は、送信波として電磁波を送信し、その反射波を受信することで物体を検出する探知装置であり、本実施形態ではミリ波レーダで構成されている。レーダ装置21は、自車の前部に取り付けられており、光軸を中心に車両前方に向かって所定角度の範囲に亘って広がる領域をレーダ信号により走査する。この走査では、自車から200m程度までの範囲に存在する物体を検知する。そして、自車前方に向けて電磁波を送信してから反射波を受信するまでの時間に基づき測距データを作成し、その作成した測距データを車両制御ECU10に逐次出力する。測距データには、自車に対する物体の位置及び速度に関する検知情報が含まれている。
The
車両制御ECU10は、CPU、ROM、RAM、I/O等を備えたコンピュータである。この車両制御ECU10は、CPUが、ROMにインストールされているプログラムを実行することにより、車両の運転制御に関する各種制御を実施する。この場合、自車前方を走行する他車を追従対象として追従制御を行うべく、エンジン31やブレーキ装置32、操舵装置33を制御対象とする制御信号を適宜出力する。
The
また、車両制御ECU10は、追従制御を行うための機能として、自車の前方を走行する他車を追従対象として判定する制御を行う。具体的には、車両制御ECU10は、軌跡生成部11、距離算出部12、軌跡判定部13、横距離取得部14、追従制御部15の各機能を実現する。
Moreover, vehicle control ECU10 performs control which determines the other vehicle which drive | works ahead of the own vehicle as a tracking object as a function for performing tracking control. Specifically, the vehicle control ECU 10 implements the functions of the trajectory generation unit 11, the
軌跡生成部11は、レーダ装置21から他車の走行位置を所定周期で取得し、その走行位置により他車の走行軌跡を生成する。なお、レーダ装置21と図示しない撮像装置と情報を取得して他車のフュージョン物標を所定周期で生成し、そのフュージョン物標により他車の走行軌跡を生成してもよい。
The trajectory generation unit 11 acquires the travel position of the other vehicle from the
距離算出部12は、自車の進行方向に直交する方向において、自車の現在位置と走行軌跡を形成している各軌跡点との間の距離である横距離を軌跡点毎に算出する。また、距離算出部12は、レーダ装置21から取得した他車の現在位置に基づいて、自車の進行方向における自車の現在位置から他車の現在位置までの距離である縦距離を算出する。
The
軌跡判定部13は、他車の走行軌跡のうち自車が追従すべき追従軌跡か否かを判定する。具体的には、まず、軌跡判定部13は、横距離が、現在から所定期間だけ遡った過去まで、所定範囲内に入る走行軌跡である場合には、追従軌跡と判定する。この場合、例えば、現在から所定期間だけ遡った過去まで、横距離が所定範囲内に入っており、それ以前は、横距離が所定範囲外である場合、その走行軌跡のうち所定期間の部分が追従軌跡となる。なお、所定範囲は車両の車幅方向を中心にした車線幅以内の大きさ(例えば、−1.5〜+1.5m)に設定されているとよい。また、軌跡判定部13は、横距離が上記の所定期間だけ所定範囲内に入っている走行軌跡が複数である場合に、それらの走行軌跡のうち、縦距離が最も小さい他車からの走行軌跡を追従軌跡と判定する。
The
横距離取得部14は、自車の現在位置まで延びている追従軌跡において、距離算出部12により算出された自車の現在位置とその追従軌跡を形成している各軌跡点との間の各横距離のうち、自車の現在位置での横距離を取得する。なお、軌跡点は所定周期で取得されており、そのうち自車に最も近い軌跡点を用いて自車の現在位置での横距離を取得するとよい。すなわち、自車に対して横並びになっている軌跡点で横距離を取得する。
The lateral
追従制御部15は、追従軌跡に沿って、追従対象である他車との縦距離を一定に保つべく、エンジン31及びブレーキ装置32、操舵装置33へ制御指令を送信する。具体的には、追従対象である他車との車間距離が小さくなる場合には、エンジン31のトルクを減少させる指令を送信して減速を行う。追従対象である他車との車間距離が大きくなる場合には、エンジン31のトルクを増加させる指令を送信して加速を行う。加えて、追従対象である他車との車間距離が急激に小さくなる場合には、エンジン31へ燃料噴射量をゼロとする指令を送信するとともに、ブレーキ装置32を作動させる指令を行う。また、自車の走行経路が追従対象である他車の追従軌跡に重なるように、操舵装置33へ制御指令を送信して、自車の進路を制御する。具体的には、運転者による操舵操作を支援したり、運転者により操舵操作が行われていなければの自動操舵を行ったりする。
The follow-up
ところで、追従軌跡が自車にまで延びていない場合には、自車の現在位置での横距離を取得することができない。この場合、追従軌跡が自車の現在位置にまで延びるまでは追従制御が開始されないため、追従制御の開始が遅れることが懸念される。 By the way, when the tracking locus does not extend to the own vehicle, the lateral distance at the current position of the own vehicle cannot be acquired. In this case, since the tracking control is not started until the tracking locus extends to the current position of the host vehicle, there is a concern that the start of the tracking control is delayed.
そこで、本実施形態では、追従軌跡が自車まで延びていない場合、その追従軌跡において自車に最も近い軌跡端位置の軌跡点で横距離を取得して、追従制御を開始する。具体的には、軌跡判定部13は、他車の走行軌跡のうち自車が追従すべき追従軌跡であるか否かを判定することに加えて、追従軌跡であることを判定した場合にその追従軌跡が自車まで延びているか否かを判定する。軌跡判定部13により追従軌跡が自車まで延びている判定された場合は、横距離取得部14は、その追従軌跡において、距離算出部12により算出された各軌跡点での横距離のうち、自車の現在位置に対して横並びになっている軌跡点での横距離を第1横距離として取得する。一方、軌跡判定部13により追従軌跡が自車まで延びていないと判定された場合は、横距離取得部14は、その追従軌跡において、距離算出部12により算出された各軌跡点での横距離のうち、自車に最も近い軌跡端位置の軌跡点での横距離を第2横距離として取得する。そして、追従制御部15は、これら第1,第2横距離に基づいて追従制御を開始する。
Therefore, in the present embodiment, when the tracking locus does not extend to the own vehicle, the lateral distance is acquired from the locus point of the locus end position closest to the own vehicle in the following locus, and the tracking control is started. Specifically, the
追従軌跡についての判定と横距離取得について、図2を用いて説明する。図2では、自車40の進行方向前方に縦距離が異なる2台の他車41,42が走行しており、他車41が他車42よりも自車40側を走行している。なお、レーダ装置21の検知領域は他車41,42の後部に達している。また、他車41の走行軌跡T1は自車40にまで延びておらず、他車42の走行軌跡T2は自車40にまで延びている。
The determination of the tracking locus and the lateral distance acquisition will be described with reference to FIG. In FIG. 2, two
図2において、軌跡判定部13は、走行軌跡T1,T2における横距離W1,W2が現在から所定期間だけ遡った過去まで、所定範囲D内に入っていることを判定する。また、軌跡判定部13は、他車41,42との縦距離L1,L2のうち、縦距離が小さい他車41からの走行軌跡T1を追従軌跡と判定する。
In FIG. 2, the
また加えて、軌跡判定部13は、その追従軌跡が自車40まで延びていないことを判定すると、横距離取得部14は、その追従軌跡において、自車基準の座標系で自車40に最も近い軌跡端位置の軌跡点P1での横距離を第2横距離として取得する。
In addition, when the
ここで、自車の車線変更時に、車線変更先である隣車線において、自車の前方を他車が走行している状況や、自車が走行する自車線に隣車線を走行している他車が車線変更して自車の前方を走行(割り込み走行)する状況が発生することが考えられる。この場合においても、自車の車線変更後の当初や、他車の割り込み後の当初には、自車の前方を走行する他車からの追従軌跡が自車にまで延びていないことが考えられる。 Here, when changing the lane of the own vehicle, in the adjacent lane to which the lane is changed, the situation in which another vehicle is traveling in front of the own vehicle, the other lane in which the own vehicle is traveling, It is conceivable that a situation occurs where the vehicle changes lanes and travels in front of the host vehicle (interrupt traveling). Even in this case, at the beginning after the lane change of the own vehicle or after the interruption of the other vehicle, it is considered that the tracking locus from the other vehicle traveling in front of the own vehicle does not extend to the own vehicle. .
自車の車線変更時と他車の割り込み時における軌跡判定と横距離取得について図3を用いて説明する。図3(a)は自車40の車線変更時において車線変更先である隣車線に先行車として他車41が走行している状況を示し、図3(b)は隣車線を走行している他車41が自車線へ車線変更して、自車40の前方に割り込む状況を示している。
The trajectory determination and lateral distance acquisition when the lane of the own vehicle is changed and when another vehicle is interrupted will be described with reference to FIG. FIG. 3A shows a situation where another
図3(a)に示すように、自車40の進路が、他車41が走行している隣車線側に変化することで、他車41の走行軌跡T3に対して自車40が近づき、他車41の走行軌跡T3の横距離が所定範囲Dに入る。この自車40の車線変更以降、自車40は他車41の後方で他車41が走行している車線と同一車線を走行することで、軌跡判定部13は、他車41の走行軌跡T3のうち横距離が所定範囲D内に入っている範囲Fを追従軌跡と判定する。このとき、自車40の車線変更の開始当初では、追従軌跡が自車40まで延びていない。この場合、軌跡判定部13は、追従軌跡が自車40まで延びていないと判定するとともに、横距離取得部14は追従軌跡における軌跡端位置の軌跡点P2での横距離である第2横距離を取得する。
As shown in FIG. 3A, the course of the
図3(b)に示すように、他車41の進路が、自車40が走行している自車線側に変化することで、自車40に対して他車41の走行軌跡T4が近づき、他車41の走行軌跡T4における各軌跡点での横距離が所定範囲D内に入る。この他車41の割り込み以降、他車41は自車40の前方で自車線を走行することで、軌跡判定部13は、他車41の走行軌跡T4のうち横距離が所定範囲D内に入っている範囲Fを追従軌跡と判定する。他車41の車線変更の開始当初では、追従軌跡が自車40まで延びていない。この場合、図3(a)と同様に、軌跡判定部13は、追従軌跡が自車40まで延びていないと判定するとともに、横距離取得部14は追従軌跡における軌跡端位置の軌跡点P3での横距離である第2横距離を取得する。
As shown in FIG. 3 (b), the travel track T4 of the
次に、車両制御ECU10により実施される追従制御処理について、図4のフローチャートを用いて説明する。本処理は、車両制御ECU10により所定周期で繰り返し実施される。
Next, the follow-up control process performed by the
まず、ステップS11では、レーダ装置21により自車の前方を走行する他車の走行位置を所定の取得周期で取得する。ここで、走行位置を取得する取得周期は可変に設定される。具体的には、走行位置の取得を開始してからの取得回数が少ない場合には、取得周期を小さく設定する。この場合、他車と自車との車間距離が小さい状況で走行軌跡の生成が開始される場合、その走行軌跡が自車にまで延びる時間が短いことで、取得回数が少なくなるため、取得周期は小さく設定される。なお、他車の複数の走行位置について横方向のばらつきが大きい場合に、取得周期を小さくしてもよい。
First, in step S11, the
ステップS12でYESである場合は、ステップS13に進み、他車の走行位置に基づいて他車の走行軌跡を生成する。続くステップS14では、他車の走行軌跡のうち自車が追従すべく追従軌跡があるか否かを判定する。この場合、他車の走行軌跡のうち、縦距離が最も小さく、かつ横距離が所定範囲内に入っている走行軌跡を、自車が追従すべく追従軌跡と判定する。 If “YES” in the step S12, the process proceeds to a step S13 to generate a travel locus of the other vehicle based on the travel position of the other vehicle. In the subsequent step S14, it is determined whether or not there is a follow-up locus for the own vehicle to follow in the travel locus of the other vehicle. In this case, among the travel tracks of the other vehicles, the travel track having the shortest vertical distance and the lateral distance within a predetermined range is determined as a tracking track so that the host vehicle can follow.
ステップS14でYESである場合は、ステップS15に進み、追従軌跡が自車まで延びているか否かを判定する。一方、ステップS12,S14のいずれかでNOである場合は、そのまま本処理を終了する。 When YES is determined in the step S14, the process proceeds to a step S15, and it is determined whether or not the tracking locus extends to the own vehicle. On the other hand, if the answer is NO in either step S12 or S14, the process is terminated.
ステップS15でYESである場合は、ステップS16に進み、自車の現在位置における軌跡位置での横距離を第1横距離として取得する。一方、ステップS15でNOである場合は、ステップS17に進み、追従軌跡の軌跡端位置での横距離を第2横距離として取得する。 If YES in step S15, the process proceeds to step S16, and the lateral distance at the locus position at the current position of the host vehicle is acquired as the first lateral distance. On the other hand, if NO in step S15, the process proceeds to step S17, and the lateral distance at the locus end position of the tracking locus is acquired as the second lateral distance.
ステップS16,S17で第1横距離又は第2横距離を取得した後、ステップS18に進み、第1横距離又は第2横距離に基づいて、他車を追従対象として自車の追従制御を開始させ、本処理を終了する。 After acquiring the first lateral distance or the second lateral distance in steps S16 and S17, the process proceeds to step S18, and based on the first lateral distance or the second lateral distance, the follow-up control of the own vehicle is started with the other vehicle as the follow-up target. To end this processing.
以上、詳述した本実施形態によれば、以下の優れた効果が得られる。 As mentioned above, according to this embodiment explained in full detail, the following outstanding effects are acquired.
自車前方の他車の追従軌跡が自車まで延びていると判定された場合には、自車の現在位置における軌跡位置での横距離が第1横距離として算出される。また、追従軌跡が自車まで延びていないと判定された場合には、追従軌跡におけるいずれかの位置で横距離が第2横距離として算出される。この場合、自車近傍に走行軌跡が延びていなくても、追従すべき他車を判定することができる。その結果、いち早く追従すべき他車を判定して追従制御を開始することができる。 When it is determined that the following locus of the other vehicle ahead of the own vehicle extends to the own vehicle, the lateral distance at the locus position at the current position of the own vehicle is calculated as the first lateral distance. If it is determined that the tracking locus does not extend to the host vehicle, the lateral distance is calculated as the second lateral distance at any position in the tracking locus. In this case, even if the traveling locus does not extend in the vicinity of the own vehicle, the other vehicle to be followed can be determined. As a result, it is possible to determine the other vehicle that should follow quickly and start the follow-up control.
走行軌跡のうち横距離が所定範囲内に入っている範囲を追従軌跡と判定する構成にした。この場合、走行軌跡の軌跡端位置又は自車の現在位置における軌跡位置での横距離が所定範囲外であっても、現在から過去に遡って横距離が所定範囲内から所定範囲外へ出た時点における軌跡位置での横距離を第2横距離として取得することができる。このため、横距離が所定範囲内に入っている範囲があれば、その範囲の走行軌跡を追従軌跡として判定することができる。この場合、自車が車線変更を行った場合や自車の進行方向前方を他車が割り込んだ場合でも、他車の走行軌跡のうち追従軌跡と判定することできる。その結果、自車が隣車線に車線変更した場合や自車の進行方向前方に他車が割り込んだ場合であっても、自車の進行方向前方を走行する他車を追従対象とすることができる。 The range in which the lateral distance is within the predetermined range in the traveling locus is determined as the tracking locus. In this case, even if the lateral distance at the trajectory end position of the traveling trajectory or the trajectory position at the current position of the host vehicle is outside the predetermined range, the lateral distance goes back from the predetermined range to outside the predetermined range from the present to the past. The lateral distance at the locus position at the time can be acquired as the second lateral distance. For this reason, if there is a range in which the lateral distance is within the predetermined range, the traveling locus in that range can be determined as the tracking locus. In this case, even when the own vehicle changes lanes or when another vehicle interrupts the front in the traveling direction of the own vehicle, it can be determined as a tracking locus among the traveling tracks of the other vehicle. As a result, even when the vehicle changes to the next lane or when another vehicle interrupts the front of the own vehicle, the other vehicle traveling in the front of the own vehicle may be subject to tracking. it can.
他車の走行軌跡のうち、縦距離が最も小さく、かつ横距離が所定範囲内に入っている走行軌跡を、自車が追従すべく追従軌跡と判定する構成にした。この場合、例えば、片側複数車線の道路において、自車線より遠方の車線を走行する他車が追従対象として判定されることが抑制される。また、横距離が所定範囲内となる走行軌跡が複数ある場合であっても、他車との縦距離が最も小さい他車からの走行軌跡が追従軌跡と判定されるため、自車の進行方向における他車の走行順序を加味して、追従すべき他車を判定することができる。 Among the traveling tracks of other vehicles, the traveling track having the shortest vertical distance and the lateral distance within a predetermined range is determined as a tracking track so that the own vehicle can follow. In this case, for example, it is suppressed that the other vehicle that travels in the lane farther than the own lane is determined as the tracking target on the road of one side multiple lanes. In addition, even when there are a plurality of travel loci whose lateral distance is within the predetermined range, the travel trajectory from the other vehicle having the smallest vertical distance to the other vehicle is determined as the follow-up trajectory. The other vehicle to be tracked can be determined in consideration of the traveling order of the other vehicle.
走行位置の取得回数が少ない場合や時系列で記憶されている複数の走行位置のばらつきが大きい場合、それらの走行位置に基づいて生成される走行軌跡の信頼性は低いと考えられる。この点、走行位置の取得を開始してからの取得回数、又は取得した複数の走行位置のばらつきに基づいて、取得周期を可変に設定する構成にした。このため、上記により走行軌跡の信頼性が低下する状況では、取得周期を小さくすることで走行位置の取得回数が増加され、走行軌跡の信頼性を高めることができる。その結果、追従対象とする他車を正確に判定することができる。 When the number of travel position acquisitions is small or when the variation of a plurality of travel positions stored in time series is large, it is considered that the reliability of the travel locus generated based on these travel positions is low. In this regard, the acquisition cycle is variably set based on the number of acquisitions since the start of the acquisition of the travel position or the variation of the acquired plurality of travel positions. For this reason, in the situation where the reliability of the travel locus is lowered as described above, the number of times of acquisition of the travel position is increased by reducing the acquisition cycle, and the reliability of the travel locus can be improved. As a result, the other vehicle to be tracked can be accurately determined.
(他実施例)
上記の実施形態を例えば次のように変更してもよい。
(Other examples)
The above embodiment may be modified as follows, for example.
・自車40の進行方向前方における自車40の現在位置からの予測経路Cを算出し、その予測経路Cを用いて第2横距離を算出するようにしてもよい。すなわち、図5に示すように、予測経路Cに直交する方向における他車41の走行軌跡T4から予測経路Cまでの距離である予測横距離W3を算出する。そして、その走行軌跡T4のうち横距離が所定範囲内に入っている範囲Fの追従軌跡において、その追従軌跡におけるいずれかの位置での予測横距離W3を第2横距離として算出する。この場合、自車40にヨーレートセンサを設け、そのヨーレートセンサにより検出されたヨー角と車速センサにより検出された車速とから自車40が走行している車線の曲率(推定R)を算出し、その推定Rから予測経路Cを算出するとよい。なお、推定Rの算出方法はこれに限定されず、例えば撮像装置から画像データを取得し、その画像データを用いて算出してもよいし、操舵角センサにより検出された操舵角と車速センサにより検出された車速とから算出してもよい。また、推定Rから予測経路Cを算出することに限らず、自車40にナビゲーションシステムを設け、そのナビゲーションシステムにより算出される自車40の予測経路Cを用いてもよい。
The predicted route C from the current position of the
上記構成によれば、自車の予測経路を算出するとともに、予測経路に直交する方向における走行軌跡の軌跡端位置から予測経路までの距離を第2横距離として算出する構成にした。この場合、自車の進路変更先の他車を追従対象として判定する際に、自車の予測進路を加味して好適に行うことができる。 According to the said structure, while calculating the predicted path | route of the own vehicle, it was set as the structure which calculates the distance from the locus | trajectory edge position of the driving | running | working locus | trajectory in the direction orthogonal to a predicted path | route as a 2nd lateral distance. In this case, when determining the other vehicle whose route has been changed as the subject to be tracked, it can be suitably performed in consideration of the predicted route of the vehicle.
・第2横距離は、追従軌跡における軌跡端位置の軌跡点での横距離に限らず、追従軌跡において他車の現在位置から軌跡端位置までのいずれかの軌跡点での横距離であってもよい。 The second lateral distance is not limited to the lateral distance at the trajectory point of the trajectory end position in the following trajectory, and is the lateral distance at any trajectory point from the current position of the other vehicle to the trajectory end position in the following trajectory. Also good.
・追従軌跡を判定する上で、横距離の所定範囲を例示したが、その範囲は例示した値に限らない。また、その所定範囲を可変に設定してもよい。例えば、自車が備えるカーナビゲーション装置等が備える地図情報から車線幅又は道路の種別を取得し、それらに基づいて所定範囲を設定してもよい。 In determining the tracking locus, the predetermined range of the lateral distance is exemplified, but the range is not limited to the exemplified value. Further, the predetermined range may be set variably. For example, a lane width or a road type may be acquired from map information provided in a car navigation device provided in the host vehicle, and a predetermined range may be set based on the lane width or road type.
・測距装置としてレーダ装置21を用いる構成としたが、これに限らず、ロケータや画像センサ、ライダ等、任意の構成を用いることが可能である。なお、画像センサはステレオカメラ等の複眼カメラであるとよい。
Although the
・縦距離が最も小さい他車を追従対象として判定していたが、縦距離ではなく相対距離が最も小さいものを選択してもよい。 -Although the other vehicle with the shortest vertical distance is determined as the tracking target, the vehicle with the shortest relative distance may be selected instead of the vertical distance.
実施形態では、車両制御ECU10にACCの機能を実行させるものとしたが、車両制御ECU10の機能はACCに限られない。自車40の車線変更時に運転者に警告を発したり車線変更を制限したりするLCS(Lane Change Support)、渋滞時の低速運転を自動化するTJA(Traffic Jam Assist)、先行車との車間距離が縮まった場合にブレーキ等を作動させて衝突を回避したり衝突被害を軽減したりするPCS(Pre Crash Safety)等の機能を実行させてもよい。また、実施形態では、車両制御ECU10が搭載される車両を運転者が運転するものとしたが、車両制御ECU10に自動運転機能を持たせたり、自動運転機能を備える車両に実施形態に係る車両制御ECU10を搭載したりしてもよい。
In the embodiment, the
10…車両制御ECU(車両制御装置)11…軌跡生成部、12…距離算出部(横距離算出部)、13…軌跡判定部、14…横距離取得部(第1横距離取得部,第2横距離取得部)、15…追従制御部、40…自車、41,42…他車。
DESCRIPTION OF
Claims (6)
前記他車の走行位置を所定の取得周期で取得し、前記他車の走行経路に沿った複数の前記走行位置から前記他車の走行軌跡を生成する軌跡生成部(11)と、
前記自車の進行方向に直交する方向における前記自車から前記走行軌跡までの距離である横距離を算出する横距離算出部(12)と、
前記他車の走行軌跡のうち前記自車が追従すべき追従軌跡を判定するとともに、その追従軌跡が前記自車まで延びているか否かを判定する軌跡判定部(13)と、
前記追従軌跡が前記自車まで延びていると判定した場合に、前記自車の現在位置における軌跡位置での前記横距離を第1横距離として取得する第1横距離取得部(14)と、
前記追従軌跡が前記自車まで延びていないと判定した場合に、前記追従軌跡におけるいずれかの位置での前記横距離を第2横距離として取得する第2横距離取得部(14)と、
前記第1横距離又は前記第2横距離に基づいて、前記追従制御を実施する追従制御部(15)と、
を備えることを特徴とする車両制御装置。 A vehicle control device (10) that performs follow-up control of the own vehicle with other vehicles (41, 42) traveling in front of the own vehicle (40) as follow-up targets,
A trajectory generator (11) that acquires a travel position of the other vehicle at a predetermined acquisition cycle, and generates a travel locus of the other vehicle from a plurality of the travel positions along a travel route of the other vehicle;
A lateral distance calculation unit (12) that calculates a lateral distance that is a distance from the host vehicle to the travel locus in a direction orthogonal to the traveling direction of the host vehicle;
A trajectory determination unit (13) for determining a tracking trajectory that the host vehicle should follow in the traveling trajectory of the other vehicle, and determining whether the tracking trajectory extends to the host vehicle;
A first lateral distance acquisition unit (14) that acquires, as a first lateral distance, the lateral distance at the trajectory position at the current position of the host vehicle when it is determined that the following track extends to the host vehicle;
A second lateral distance acquisition unit (14) that acquires, as a second lateral distance, the lateral distance at any position in the following locus when it is determined that the following locus does not extend to the host vehicle;
A follow-up control unit (15) for performing the follow-up control based on the first lateral distance or the second lateral distance;
A vehicle control device comprising:
前記軌跡判定部は、前記横距離が前記所定範囲内に入っている前記走行軌跡が複数ある場合は、当該走行軌跡において前記縦距離が最も小さい前記他車からの前記走行軌跡を前記追従軌跡と判定する請求項2に記載の車両制御装置。 A longitudinal distance calculation unit (12) that calculates a longitudinal distance that is a distance from the own vehicle to the other vehicle in the traveling direction of the own vehicle;
When there are a plurality of travel loci in which the lateral distance is within the predetermined range, the trajectory determination unit determines the travel trajectory from the other vehicle having the smallest vertical distance in the travel trajectory as the follow-up trajectory. The vehicle control device according to claim 2 for determination.
前記横距離算出部は、前記予測経路に直交する方向における前記走行軌跡から前記予測経路までの距離である予測横距離を算出し、
前記第2横距離取得部は、前記追従軌跡におけるいずれかの位置での前記予測横距離を前記第2横距離として算出する請求項1乃至4のいずれか1項に記載の車両制御装置。 A route calculation unit (12) for calculating a predicted route from the current traveling position of the host vehicle in the forward direction of the host vehicle;
The lateral distance calculation unit calculates a predicted lateral distance that is a distance from the travel locus to the predicted route in a direction orthogonal to the predicted route,
5. The vehicle control device according to claim 1, wherein the second lateral distance acquisition unit calculates the predicted lateral distance at any position in the tracking locus as the second lateral distance.
前記他車の走行位置を所定の取得周期で取得し、前記他車の走行経路に沿った複数の前記走行位置から前記他車の走行軌跡を生成するステップと、
前記自車の進行方向に直交する方向における前記自車から前記走行軌跡までの距離である横距離を算出するステップと、
前記他車の走行軌跡のうち前記自車が追従すべき追従軌跡を判定するとともに、その追従軌跡が前記自車まで延びているか否かを判定するステップと、
前記追従軌跡が前記自車まで延びていると判定した場合に、前記自車の現在位置における軌跡位置での前記横距離を第1横距離として取得するステップと、
前記追従軌跡が前記自車まで延びていないと判定した場合に、前記追従軌跡におけるいずれかの位置で前記横距離を第2横距離として取得するステップと、
前記第1横距離又は前記第2横距離に基づいて、前記追従制御を実施するステップと、
を実行する車両制御方法。 A vehicle control method executed by a vehicle control device (10) that performs follow-up control of the own vehicle with another vehicle (41, 42) traveling in front of the own vehicle (40) as a follow-up target,
Acquiring a travel position of the other vehicle at a predetermined acquisition cycle, and generating a travel locus of the other vehicle from a plurality of the travel positions along a travel route of the other vehicle;
Calculating a lateral distance that is a distance from the host vehicle to the travel locus in a direction orthogonal to the traveling direction of the host vehicle;
A step of determining a follow-up locus to be followed by the own vehicle among the travel locus of the other vehicle and determining whether the follow-up locus extends to the own vehicle;
When it is determined that the tracking locus extends to the vehicle, the lateral distance at the locus position at the current position of the vehicle is obtained as a first lateral distance;
Obtaining the lateral distance as a second lateral distance at any position in the following locus when it is determined that the following locus does not extend to the host vehicle;
Performing the follow-up control based on the first lateral distance or the second lateral distance;
A vehicle control method for executing.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2015181858A JP6477377B2 (en) | 2015-09-15 | 2015-09-15 | Vehicle control apparatus and vehicle control method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2015181858A JP6477377B2 (en) | 2015-09-15 | 2015-09-15 | Vehicle control apparatus and vehicle control method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2017056785A JP2017056785A (en) | 2017-03-23 |
| JP6477377B2 true JP6477377B2 (en) | 2019-03-06 |
Family
ID=58389249
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2015181858A Active JP6477377B2 (en) | 2015-09-15 | 2015-09-15 | Vehicle control apparatus and vehicle control method |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP6477377B2 (en) |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP6595647B2 (en) * | 2018-03-15 | 2019-10-23 | 本田技研工業株式会社 | Travel control device, vehicle, and travel control method |
| CN115202273B (en) * | 2022-08-29 | 2024-07-26 | 中国人民解放军国防科技大学 | Induction wire vehicle controller and control method thereof |
| CN115973162B (en) * | 2023-02-14 | 2024-05-31 | 吉咖智能机器人有限公司 | Method, device, electronic device and medium for determining vehicle driving track |
Family Cites Families (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP4555699B2 (en) * | 2005-02-01 | 2010-10-06 | 本田技研工業株式会社 | Leading vehicle recognition device |
| JP5234429B2 (en) * | 2009-03-31 | 2013-07-10 | 株式会社エクォス・リサーチ | Vehicle control apparatus, vehicle, and vehicle control program |
| US9275549B2 (en) * | 2012-11-28 | 2016-03-01 | Denso Corporation | Vehicle pseudo-travel locus generator |
-
2015
- 2015-09-15 JP JP2015181858A patent/JP6477377B2/en active Active
Also Published As
| Publication number | Publication date |
|---|---|
| JP2017056785A (en) | 2017-03-23 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP6507839B2 (en) | Vehicle travel control device | |
| US10486698B2 (en) | Vehicle cruise control device and cruise control method | |
| US10345443B2 (en) | Vehicle cruise control apparatus and vehicle cruise control method | |
| JP5977270B2 (en) | Vehicle control apparatus and program | |
| US10661794B2 (en) | Driving assistance device | |
| US10780884B2 (en) | Vehicle cruise control apparatus and vehicle cruise control method | |
| US10384681B2 (en) | Vehicle cruise control device and cruise control method | |
| JP6237694B2 (en) | Travel control device | |
| US8880319B2 (en) | Driving control apparatus mounted on vehicle to avoid collision with preceding vehicle | |
| CN107004367B (en) | Vehicle travel control device and travel control method | |
| JP6363516B2 (en) | Vehicle travel control device | |
| US10787170B2 (en) | Vehicle control method and apparatus | |
| JP6321373B2 (en) | Course estimation device and program | |
| JP6497284B2 (en) | Vehicle control apparatus and vehicle control method | |
| JP6544168B2 (en) | Vehicle control device and vehicle control method | |
| JP5947279B2 (en) | Course estimation device and program | |
| JP6658674B2 (en) | Driving support system | |
| US20230227025A1 (en) | Vehicle drive assist apparatus | |
| JP2017076234A (en) | Driving support device and driving support method | |
| JP2017151726A (en) | Collision predicting device | |
| JP4518080B2 (en) | Perimeter monitoring device | |
| JP6477377B2 (en) | Vehicle control apparatus and vehicle control method | |
| JP4946212B2 (en) | Driving support device | |
| JP6480101B2 (en) | Vehicle control device | |
| JP6525405B1 (en) | Vehicle control device |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20171115 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20180723 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20180731 |
|
| 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: 20190108 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20190121 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 6477377 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |