JP5267215B2 - Vehicle driving support device and vehicle driving support method - Google Patents
Vehicle driving support device and vehicle driving support method Download PDFInfo
- Publication number
- JP5267215B2 JP5267215B2 JP2009049281A JP2009049281A JP5267215B2 JP 5267215 B2 JP5267215 B2 JP 5267215B2 JP 2009049281 A JP2009049281 A JP 2009049281A JP 2009049281 A JP2009049281 A JP 2009049281A JP 5267215 B2 JP5267215 B2 JP 5267215B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- state
- travel route
- target travel
- driver
- 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
- 238000000034 method Methods 0.000 title claims abstract description 76
- 238000001514 detection method Methods 0.000 claims abstract description 146
- 238000004364 calculation method Methods 0.000 claims abstract description 124
- 230000008859 change Effects 0.000 claims abstract description 28
- 238000011156 evaluation Methods 0.000 claims description 66
- 238000005259 measurement Methods 0.000 claims description 17
- 230000008569 process Effects 0.000 description 48
- 238000012545 processing Methods 0.000 description 44
- 230000006870 function Effects 0.000 description 31
- 238000010586 diagram Methods 0.000 description 19
- 230000001133 acceleration Effects 0.000 description 12
- 230000006399 behavior Effects 0.000 description 12
- 230000004913 activation Effects 0.000 description 10
- 230000007704 transition Effects 0.000 description 10
- 230000000694 effects Effects 0.000 description 9
- 230000014509 gene expression Effects 0.000 description 7
- 238000012937 correction Methods 0.000 description 4
- 230000007423 decrease Effects 0.000 description 4
- 238000009472 formulation Methods 0.000 description 4
- 239000000203 mixture Substances 0.000 description 4
- 238000006243 chemical reaction Methods 0.000 description 3
- 230000007246 mechanism Effects 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 230000010485 coping Effects 0.000 description 1
- 239000013078 crystal Substances 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000002441 reversible effect Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
- 230000002123 temporal effect Effects 0.000 description 1
Images
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
- Power Steering Mechanism (AREA)
- Traffic Control Systems (AREA)
Abstract
Description
本発明は、運転者の運転操作を支援する車両用運転支援装置および車両用運転支援方法に関する。 The present invention relates to a driving support device for a vehicle and a driving support method for a vehicle that support a driver's driving operation.
近年、操舵操作や制動操作などの運転者の運転操作を支援する運転支援装置を車両に搭載する例が増加しつつある。この種の車両用走行支援装置として、目標走行軌跡に沿って車両を誘導するとともに、目標位置の変更や目標軌跡と実走行軌跡との誤差拡大に目標軌跡を再計算することによって対処するという技術提案も既に存在している(例えば、特許文献1参照)。特許文献1における提案では、目標軌跡の再計算が必要と一旦判断した状態においても、特定の操舵状態にあるときには、目標軌跡の再計算を敢て実行しないというものである。ここに、特定の操舵状態とは、センサ誤差や操舵遅れによる誤差が大きくなりやすい車両において、その車両の操舵状態が切り増し方向の操舵から切り戻し方向の操舵に切り替わったような状態である。上述のような特定の操舵状態にあるときには、目標軌跡の再計算をしないことにより目標軌跡の計算精度を高めるようにしている。
In recent years, an example in which a driving support device that supports a driver's driving operation such as a steering operation or a braking operation is mounted on a vehicle is increasing. As this type of vehicle travel support device, a technique for guiding a vehicle along a target travel locus and coping with changing the target position and recalculating the target locus to increase the error between the target locus and the actual travel locus Proposals already exist (see, for example, Patent Document 1). In the proposal in
特許文献1の提案では、主に駐車支援の場合など目標とする移動先の位置が固定されている場合や、目標位置が変更される場合であっても変更される頻度がさほど高くない場合を想定しており、この想定が該当する場合に限り、相応に有効であると考えられる。
しかしながら、現実に車両の走行を支援するに際しては、多くの場合、自車を取り巻く状況の時々刻々の変化に即応することが要請される。目標軌跡の再計算を短い周期で実行することが、この要請に応えるに効果的である。この場合でも、精度の良い目標軌跡が困難な局面に限り、従来技術の如く目標軌跡の再計算を停止することが考えられる。しかし、目標軌跡の再計算を停止すると、再計算を再開する時点で、それまで保持してきた目標軌跡と再計算の結果得られる目標軌跡との乖離が大きくなる蓋然性が高い。目標軌跡の大きな変化は、必然的に走行操作支援量の急激な変化を招来し、再計算の再開時に運転者に大きな違和感を与えてしまう虞がある。
本発明は上述のような状況に鑑みてなされたものであり、走行操作支援量の急激な変化を抑制して運転者に与える違和感を緩和することが可能な車両用運転支援装置および車両用運転支援方法を提供することを目的としている。
In the proposal of
However, when actually supporting the driving of a vehicle, in many cases, it is required to respond quickly to changes in the circumstances surrounding the vehicle. In order to meet this demand, it is effective to perform recalculation of the target trajectory in a short cycle. Even in this case, it is conceivable that the recalculation of the target locus is stopped as in the prior art only in a situation where a precise target locus is difficult. However, when the recalculation of the target trajectory is stopped, there is a high probability that when the recalculation is restarted, the difference between the target trajectory held so far and the target trajectory obtained as a result of the recalculation becomes large. A large change in the target locus inevitably causes a sudden change in the amount of driving operation support, which may give the driver a great sense of discomfort when recalculation is resumed.
The present invention has been made in view of the above situation, and a vehicle driving support device and a vehicle driving capable of reducing a sense of discomfort given to the driver by suppressing a rapid change in the amount of driving operation support. The purpose is to provide support methods.
本発明の車両用運転支援装置では、目標走行経路を再計算を逐次実行して算出し、目標走行経路の再計算を実行するに際し、自車状態検出部および運転者操作状態検出部で得た現在の状態を表す現在状態検出値と、過去に算出した目標走行経路から現在時刻に対応する自車状態および運転操作状態を抽出した状態予測値との二つの状態量に選択的に基づいて、現在の目標走行経路算出に用いる初期条件を設定し、目標走行経路に相当する時系列の操作手順に沿った操作が行われるように運転者の運転操作を支援する。 In the vehicle driving support device of the present invention, the target travel route is calculated by sequentially executing recalculation, and when the target travel route is recalculated, it is obtained by the own vehicle state detection unit and the driver operation state detection unit. Based selectively on two state quantities, a current state detection value representing the current state, and a state predicted value obtained by extracting the own vehicle state and the driving operation state corresponding to the current time from the target travel route calculated in the past, The initial conditions used for the current target travel route calculation are set, and the driver's driving operation is supported so that the operation according to the time-series operation procedure corresponding to the target travel route is performed.
目標走行経路算出部で目標走行経路の再計算を繰り返すに際し、該再計算に係る初期条件として、現在状態検出値と状態予測値の二つの状態量を状況に応じて使い分けることが可能になる。このため、現在状態の検出誤差等に起因して再計算における目標走行経路の算出値が大幅に変動する虞がある場合には、誤差要因の影響を直接的には受けない状態予測値を計算の初期条件として適用することにより算出値の変動を抑制可能である。これにより、操作支援量が変動することで運転者が感じる違和感を小さくすることができる。 When the target travel route calculation unit repeats recalculation of the target travel route, it is possible to selectively use two state quantities, that is, a current state detection value and a state prediction value, as initial conditions related to the recalculation. For this reason, if there is a possibility that the calculated value of the target travel route in the recalculation may fluctuate significantly due to the detection error of the current state, etc., a predicted state value that is not directly affected by the error factor is calculated. By applying this as the initial condition, it is possible to suppress fluctuations in the calculated value. Thereby, the uncomfortable feeling felt by the driver when the operation support amount varies can be reduced.
(第1の実施の形態)
図1は本発明の第1の実施の形態としての車両用運転支援装置について説明するための模式図である。図1において、車室内前方に取り付けたカメラ1は、自車前方の道路状況を撮影し、障害物、道路境界、白線等を検出する。本例ではカメラを2台設置することにより、物体の方向だけでなく距離も検出可能にしている。一方、ホイールに取り付けたロータリーエンコーダ等による車速センサ2で、ホイールの回転に比例して発生するパルス信号を検出して車速を計測する。また、水晶振動子や半導体を用いる方式のヨーレートセンサ3を設け、車両に発生するヨーレートを検出する。更に、圧電素子等を用いた加速度センサ4により車両に発生する特定の方向の加速度を検出する。ここでは特に車両の横方向に発生する加速度を検出する構成を想定している。また、ステアリングコラム内に操舵角センサ5を設け、ステアリングホイールの回転角度を検出する。操舵トルクセンサ6を同じくステアリングコラム内に設け、運転者の操舵トルクを検出する。一方、マイクロプロセッサ70により、各種センサで検出した信号の処理と目標走行経路、すなわち目標操作量の時系列信号を算出し、モータコントローラ9を介してアシストモータ8を制御して転舵アシストトルクを操舵系に加える。
(First embodiment)
FIG. 1 is a schematic diagram for explaining a vehicle driving support apparatus according to a first embodiment of the present invention. In FIG. 1, a
図2は、図1の装置に対応する機能ブロック図である。
図2において、車速センサ2、操舵角センサ5、ヨーレートセンサ3、加速度センサ4、および、カメラ1といったセンサ群100を、図1を参照して既述のようにして車両に配してある。これらセンサ群により、本発明の実施の形態における構成要素たる自車状態検出部、運転者操作検出部、障害物検出部、および道路境界検出部を具現している。マイクロプロセッサ70は、上述のセンサ群による検出信号を受け、これら検出信号を統合的に処理して、自車両の運動状態、運転者の操作状態、障害物の位置および運動状態、および道路境界を表す各所定形式の情報を得る。
FIG. 2 is a functional block diagram corresponding to the apparatus of FIG.
In FIG. 2, a
マイクロプロセッサ70では、上述したセンサ信号処理に加えて、回避支援制御を起動するかどうかの判定および回避支援制御を起動した場合の目標操作量の算出と、目標値のアクチュエータ制御系への伝達に関する処理を実行する。マイクロプロセッサ70に格納してある制御プログラムは、いくつかの機能を実装した処理部を組み合わせた構成を有する。
In addition to the sensor signal processing described above, the
既述のセンサ群100で収集した情報を、センサ信号処理部200によって同一の座標系上に展開した形の情報へと変換すると共に、次に述べるセンサ信号処理部200の各機能部で検出および予測の処理を施して、各所定の検出値および予測値を得る。
センサ信号処理部200は上述の各機能部として、自車状態検出部210、運転者操作状態検出部220、障害物検出部260、障害物挙動予測部270、および、道路境界検出部280を含んでいる。
The information collected by the
The sensor
自車状態検出部210は自車両の走行状態を検出する。運転者操作状態検出部220は運転者の操作状態を検出する。障害物検出部260は自車前方の障害物を検出する。障害物挙動予測部270は障害物検出部260で検出した障害物の運動状態に基づいて、所定時間先までの障害物の挙動を予測する。道路境界検出部280は自車が走行可能な道路の境界を検出する。
The own vehicle
以上がセンサ信号処理部200の構成であるが、運転支援起動判定部290では、センサ信号処理部200で得た障害物情報および運転者操作情報に基づいて、回避支援制御の必要性の有無および運転者による回避操作の有無の判定を行う。この判定で、回避支援制御の必要性が高く、運転者による回避操作も行われていると判定した場合に、回避支援制御を起動する処理を行う。
The above is the configuration of the sensor
一方、初期条件設定部250では、目標走行経路を算出する際に走行経路の起点となる車両状態および障害物の状態に関する情報の初期値の設定を行う。
目標走行経路算出部230では、初期条件設定部250で設定した自車と障害物の状態、および道路境界に関する情報に基づいて、自車が道路内で障害物を回避する目標走行経路を算出する処理を実行する。目標走行経路算出部230でのこの算出処理では、目標走行経路に沿って走行するために必要な操作を表す時系列の操作手順の情報を得る。
On the other hand, the initial
The target travel
このようにして得た時系列の操作手順の情報を、運転操作支援の態様に適合する信号に変換して出力するための運転操作支援部としての指令値出力処理部240を介して、運転操作支援機構400のモータコントローラ9に供給する。従って、このモータコントローラ9を介して転舵アシストモータ8を当該運転操作支援制御の趣旨に沿うように作動させて運転者の回避操作の支援を行うことができる。
The time series operation procedure information obtained in this manner is converted into a signal suitable for the driving operation support mode and output via the command value
一方、既得の情報を評価する予想走行経路評価部310では、過去に算出した時系列の操作手順と現在のセンサ検出情報による現在状態検出値とに基づいて、走行経路の算出方法を評価する。即ち、過去に算出した時系列の操作手順を現在時刻から適用した場合にどの程度好ましい走行経路が得られるかを評価する処理を実行する。この評価結果を初期条件設定部250に伝達して目標走行経路算出の際の初期条件設定に反映させる。
On the other hand, the predicted travel
次に図面を参照してマイクロプロセッサ70における処理の詳細について説明する。
図3は、図2中のマイクロプロセッサ70における処理の詳細を表すフローチャートである。ここでは説明に具体性を持たせるために、本実施例では図4に示す場面を想定して処理内容の説明を行う。図4は自車が直線道路を走行している時に、自車前方左側に障害物を検出した場面を想定している。
Next, details of the processing in the
FIG. 3 is a flowchart showing details of processing in the
マイクロプロセッサ70は、以下に説明する一連の処理を所定の時間間隔ごとに繰り返し実行する。
ステップS301では、既述のセンサ群100で検出した信号をマイクロプロセッサ70のメモリ上に読み込み、車両の運動状態および障害物の状態を既定の座標系上の値に変換する。この座標系は適当に定めることができるが、本実施例では、図4に示すように、道路の進行方向に沿ってX軸を、X軸と垂直方向にY軸を設定する。更に、自車の現在位置をX座標の原点、道路の中心線付近にY座標の原点を置くものとして座標系を設定する。上述のように座標系を設定することにより、自車(中心点)の位置を(X,Y=x,y)といった形で表記することができるようになる。
The
In step S301, the signal detected by the
ここで、自車の運動状態を表す状態量として、ヨー角θ、車両速度ν、車体すべり角β、ヨーレートγ、前輪の転舵角δが重要な量であると考えられる。これらの物理量のうち、車両速度νに関しては非駆動輪の車輪速で近似することができるため、非駆動輪に設けた車速センサの測定値を利用することができる。一方、ヨーレートγはヨーレートセンサ3から得ることができる。車両のヨー角θは道路が直線であると仮定すれば、道路境界と自車の向いている方向とのなす角を画像処理によって推定することで取得できる。あるいは、適当な初期値を定めて、ヨーレートセンサ3の出力値を積分することによって算出してもよい。すべり角βは、車両縦方向の速度をνx、横方向の速度をνyとすれば、
Here, it is considered that the yaw angle θ, the vehicle speed ν, the vehicle slip angle β, the yaw rate γ, and the turning angle δ of the front wheels are important amounts as state quantities representing the motion state of the host vehicle. Among these physical quantities, the vehicle speed ν can be approximated by the wheel speed of the non-driving wheel, so that the measured value of the vehicle speed sensor provided on the non-driving wheel can be used. On the other hand, the yaw rate γ can be obtained from the
以上に説明した通り、上記で挙げた自車の運動状態を記述する状態量はすべてセンサの検出信号を処理することによって具体的な値を算出することができる。
また、障害物を検出している場合には、その中心点の位置座標Xp=(xp,yp)、および障害物の幅σy、奥行きσxの各値がカメラで取得した画像情報を処理することによって算出される。奥行きσxは撮影方向によっては測定が困難な場合もあるが、その場合には便宜的に幅σyと同じ値を設定しておくことにする。なお、障害物が検出されなかった場合には、障害物に関する物理量の算出は行わない。
さらに、カメラによる道路境界検出によって検出された道路の左端および右端の位置を、上記座標系上の値に変換して、それぞれY=YL、Y=YRとする。
As described above, all of the state quantities describing the motion state of the vehicle mentioned above can be calculated concrete values by processing the detection signals of the sensors.
When an obstacle is detected, the position coordinates X p = (x p , y p ) of the center point, and the values of the obstacle width σ y and depth σ x are acquired by the camera. Calculated by processing information. The depth σ x may be difficult to measure depending on the shooting direction. In this case, the same value as the width σ y is set for convenience. If no obstacle is detected, the physical quantity related to the obstacle is not calculated.
Further, the positions of the left end and the right end of the road detected by the road boundary detection by the camera are converted into values on the coordinate system, and Y = Y L and Y = Y R are set.
図4の場面において導入した座標系と物理量の例を図5に示す。
以上のように、適当な座標系を導入し、自車、障害物および道路境界に関する情報を、導入した座標系上の値として算出することがステップS301における処理である。
ステップS302では、運転支援制御起動フラグの状態によって処理を分岐する。運転支援制御が起動している場合には(ステップS302:Yes)ステップS305に処理を進める。一方、起動していない場合には(ステップS302:No)ステップS303に進む。
An example of the coordinate system and the physical quantity introduced in the scene of FIG. 4 is shown in FIG.
As described above, the processing in step S301 is to introduce an appropriate coordinate system and calculate information on the own vehicle, the obstacle, and the road boundary as a value on the introduced coordinate system.
In step S302, the process branches depending on the state of the driving support control activation flag. If the driving support control is activated (step S302: Yes), the process proceeds to step S305. On the other hand, if it is not activated (step S302: No), the process proceeds to step S303.
ステップS303では、運転支援制御を起動すべきかどうかを判定し、その判定結果によって処理を分岐する。運転支援制御を起動する条件として例えば
(1)自車前方に自車と衝突する可能性のある障害物が検出されており、衝突するまでの余裕が所定の水準以下になっている。
(2)運転者が回避操作を開始している。
という二つの条件を設定することができる。条件(1)については、次式で定義する自車と障害物とのTTC(Time to Collision)によって障害物回避に関する時間的余裕を評価することができる。
In step S303, it is determined whether or not the driving support control should be started, and the process branches depending on the determination result. As a condition for starting the driving support control, for example, (1) an obstacle that may collide with the own vehicle is detected in front of the own vehicle, and a margin until the collision is below a predetermined level.
(2) The driver has started the avoidance operation.
Two conditions can be set. For condition (1), the time margin for obstacle avoidance can be evaluated by TTC (Time to Collision) between the vehicle and the obstacle defined by the following equation.
すなわち、TTCが所定の閾値TTCthr(例えば3.0秒程度の値を設定することが考えられる)よりも小さくなった場合には、運転支援制御の必要性があると判定する。条件(2)については、操舵角θsの大きさが所定の閾値θthrよりも大きくなった場合に運転者による回避操作が行われていると判定する。すなわち、 That is, when the TTC becomes smaller than a predetermined threshold value TTC thr (for example, a value of about 3.0 seconds can be set), it is determined that the driving support control is necessary. Regarding condition (2), when the magnitude of the steering angle θ s is larger than a predetermined threshold value θ thr, it is determined that an avoidance operation by the driver is being performed. That is,
以上で説明した運転支援制御を起動する条件を充足しない場合は、そのまま処理を打ち切ることになるが、条件を充足する場合にはステップS304に処理を進める。
ステップS304では、目標走行経路の算出に先立って演算に関する設定処理を行う。この処理の詳細を説明するために、まず目標走行経路演算の定式化について説明する。
ここでは、任意の走行経路に対する数値的評価を行う評価関数を障害物位置や道路状況等に基づいて定義し、評価関数の値がもっとも良くなる走行経路を目標走行経路として算出する、という枠組みで目標走行経路の演算を行うことにする。
If the condition for starting the driving support control described above is not satisfied, the process is terminated as it is, but if the condition is satisfied, the process proceeds to step S304.
In step S304, setting processing related to calculation is performed prior to calculation of the target travel route. In order to explain the details of this process, first, the formulation of the target travel route calculation will be described.
Here, an evaluation function for performing a numerical evaluation on an arbitrary travel route is defined based on obstacle positions, road conditions, etc., and a travel route with the best evaluation function value is calculated as a target travel route. The target travel route is calculated.
自車の走行経路は自車に対してどのような操作を加えるかによって決まるので、車両の特性を反映した走行経路を算出するためには、自車に対する操作を入力とする自車の運動を記述するモデルが必要である。
車両の運動を記述するモデルとしては、四輪車両の運動を二輪車両の運動で近似する二輪モデルがよく知られている。車両速度が一定であると仮定すると、二輪モデルは以下の微分方程式で記述される。
Since the travel route of the host vehicle is determined by what operation is applied to the host vehicle, in order to calculate the travel route reflecting the characteristics of the vehicle, the motion of the host vehicle that receives the operation on the host vehicle is input. You need a model to describe.
As a model that describes the motion of a vehicle, a two-wheel model that approximates the motion of a four-wheel vehicle by the motion of a two-wheel vehicle is well known. Assuming that the vehicle speed is constant, the two-wheel model is described by the following differential equation:
ただし、m、I、If、Irはそれぞれ車両質量、車両ヨー慣性モーメント、車両重心から前輪軸までの距離、車両重心から後輪軸までの距離を表す。Yf、Yrはタイヤ横力をあらわす関数であり、それぞれ前輪すべり角βf、後輪すべり角βrの関数であると仮定している。なお、βf、βrは次式のように計算することができる。 However, m, representing I, I f, respectively I r vehicle mass, vehicle yaw inertia moment, the distance from the center of gravity of the vehicle to the front axle, the distance to the rear axle from the center of gravity of the vehicle. Y f and Y r are functions representing tire lateral force, and are assumed to be functions of a front wheel slip angle β f and a rear wheel slip angle β r , respectively. Β f and β r can be calculated as follows.
タイヤ横力関数Yf、Yrは、図6に示すような非線形関数で表現することができる。さらに、前輪の転舵角δとステアリングホイールの操舵角θSとの間には(2)式のような関係があるので、操舵角速度ωと前輪転舵角との関係は、 The tire lateral force functions Y f and Y r can be expressed by nonlinear functions as shown in FIG. Furthermore, since there is a relationship such as equation (2) between the steering angle δ of the front wheel and the steering angle θ S of the steering wheel, the relationship between the steering angular velocity ω and the front wheel steering angle is
以上、(6)〜(14)式をまとめると、操舵角速度ωを入力とする以下の微分方程式モデルが得られる。
As described above, when the equations (6) to (14) are summarized, the following differential equation model using the steering angular velocity ω as an input can be obtained.
ここで、tは現在時刻を表す変数、Tは算出する時系列の長さを表すパラメータであり、障害物回避の問題の場合、障害物の回避から元の直進走行状態に復帰するまでの一連の回避操作を終えられる程度の長さの値を設定する。また、Ψは時刻t+Tにおける車両運動状態の望ましさを評価する評価式、Lは時刻tからt+Tまでの間の各時刻における車両運動状態および操作量の望ましさを評価する評価式、τはtからt+Tまで変化する積分変数である。 Here, t is a variable representing the current time, T is a parameter representing the length of the time series to be calculated, and in the case of an obstacle avoidance problem, a series of steps from avoiding the obstacle to returning to the original straight traveling state. Set a value that is long enough to complete the avoidance operation. Ψ is an evaluation formula for evaluating the desirability of the vehicle motion state at time t + T, L is an evaluation formula for evaluating the desirability of the vehicle motion state and the operation amount at each time from time t to t + T, and τ is t Is an integral variable that changes from t to T + T.
評価式LおよびΨは、以下の要請項目を反映する評価項を組み合わせることで構成する。
(1)障害物に近付き過ぎない
(2)道路境界に近付き過ぎない
(3)操舵角速度をなるべく小さくする
(4)回避運動終端での車両ヨー角を道路進行方向に近付ける
要請項目(1)は、自車と障害物との距離が近くなれば近くなるほど値が大きくなる関数によって表現する。具体的には、例えば次式の関数を利用することができる。
The evaluation formulas L and Ψ are configured by combining evaluation terms that reflect the following required items.
(1) Don't get too close to obstacles (2) Don't get too close to road boundaries (3) Make the steering angular velocity as small as possible (4) Bring the vehicle yaw angle at the end of avoidance movement closer to the road traveling direction Request item (1) is It is expressed by a function whose value increases as the distance between the vehicle and the obstacle decreases. Specifically, for example, the following function can be used.
障害物の位置xp,ypには、障害物移動軌跡生成部で生成した移動軌跡の情報を割り当てる。
要請項目(2)は、自車と道路境界との距離が近くなれば近くなるほど値が大きくなる関数によって表現する。具体的には、例えば次式の関数を利用することができる。
Information on the movement trajectory generated by the obstacle movement trajectory generation unit is assigned to the obstacle positions x p and y p .
The request item (2) is expressed by a function that increases as the distance between the vehicle and the road boundary decreases. Specifically, for example, the following function can be used.
ただし、△は道路境界への接近の余裕幅を指定するパラメータであり、△の値が大きいほど道路境界との接近余裕を大きくとる回避経路が算出される。
評価式LPとLRは道路上に障害物と道路境界との接触リスクを反映したリスクポテンシャルを定義することになる。
LPとLRを足し合わせた関数をX―Y座標上にプロットした図を図7に示す。中央の山が障害物に対応する関数LPによって形成されたポテンシャルであり、両側の山が道路境界に対応する関数LPによって形成されたポテンシャルである。回避経路は、図7に示したリスクポテンシャル場の値の低い領域に可能な限り沿うようにして生成されることになる。
要請項目(3)は、なるべく小さな操舵速度で回避操作をとることによって効率的な回避を行うことを要請するために導入した項目である。評価式としては、例えば次式の関数を利用することができる。
However, Δ is a parameter for designating a margin of approach to the road boundary, and an avoidance route that calculates a larger margin of approach to the road boundary is calculated as the value of Δ is larger.
The evaluation formulas L P and L R define the risk potential reflecting the contact risk between the obstacle and the road boundary on the road.
FIG. 7 is a diagram in which a function obtained by adding L P and L R is plotted on the XY coordinates. The central mountain is the potential formed by the function L P corresponding to the obstacle, and the mountain on both sides is the potential formed by the function L P corresponding to the road boundary. The avoidance path is generated as much as possible along the region having a low value of the risk potential field shown in FIG.
The request item (3) is an item introduced to request efficient avoidance by taking an avoidance operation at a steering speed as small as possible. As the evaluation formula, for example, a function of the following formula can be used.
以上の三つの評価式に適当な重みをつけて足し合わせた関数を、評価式Lとして構成する。すなわち、wP、wR、wSをそれぞれ要項項目(1)、(2)、(3)に対する重みとすると、Lは、 A function obtained by adding appropriate weights to the above three evaluation expressions is configured as an evaluation expression L. That is, if w P , w R , and w S are weights for the essential items (1), (2), and (3), L is
要請項目(4)は、回避運動後の車両姿勢を立て直すために導入した要請項目である。直線道路においては、時刻t+Tにおける車両ヨー角を評価する関数として、例えば、
The requirement item (4) is a requirement item introduced for reestablishing the vehicle posture after the avoidance exercise. On a straight road, as a function for evaluating the vehicle yaw angle at time t + T, for example,
以上のように評価関数を定義すると、操舵角速度の時系列の推移態様の計算を既述の(14)式の制御対象および(15)式の評価関数で定義される最適制御問題として定式化することができる。従って、この最適制御問題を解くことによって目標とする操舵角速度の時系列の推移態様が得られる。さらに得られた操舵角速度の時系列の推移態様によって(14)式を積分すれば、目標走行経路を得ることができる。但し、ここで算出する目標走行経路は運転者の操舵操作を支援するためのものなので、入力である操舵角速度ωは、一般的な運転者が操作できる範囲に収まっていることが望まれる。この要請は、一般的な運転者が許容できる最大操舵角速度をωmaxとすると、 When the evaluation function is defined as described above, the calculation of the time-series transition mode of the steering angular velocity is formulated as the optimal control problem defined by the control object of the above-described equation (14) and the evaluation function of the equation (15). be able to. Therefore, by solving this optimal control problem, a time-series transition mode of the target steering angular velocity can be obtained. Further, if the equation (14) is integrated according to the time-series transition mode of the obtained steering angular velocity, the target travel route can be obtained. However, since the target travel route calculated here is for assisting the driver's steering operation, it is desirable that the steering angular velocity ω that is an input is within a range that can be operated by a general driver. This request is based on the assumption that the maximum steering angular speed allowable for a general driver is ω max .
以上をまとめると、目標走行経路演算を最適制御問題によって定式化して解く際には、
To summarize the above, when formulating and solving the target travel route calculation by the optimal control problem,
ステップS304では、(1)、(2)、(3)すべての設定処理が行われる。このうち、(1)、(2)については既述の通りセンサの検出情報から具体的な値を得ることができる。(3)は、設計パラメータでありその値を自由に設定することができる。遭遇した場面によって異なる値を設定することもできるし、場面によらずに一定の値を設定することもできる。すべての設定処理が終わったら、ステップS309へ進む。
ステップS309では、(14)、(15)、(23)式で定義される最適制御問題を解いて、最適な操舵角速度の時系列の推移態様を算出する。最適制御問題を解く具体的なアルゴリズムについては、いくつかの公知例が知られているので、ここでは詳細な説明を省略する。
In step S304, all setting processes (1), (2), and (3) are performed. Among these, for (1) and (2), specific values can be obtained from the detection information of the sensor as described above. (3) is a design parameter whose value can be set freely. Different values can be set depending on the scenes encountered, and a constant value can be set regardless of the scene. When all the setting processes are completed, the process proceeds to step S309.
In step S309, the optimal control problem defined by the equations (14), (15), and (23) is solved, and the time-series transition mode of the optimal steering angular velocity is calculated. Since there are some known examples of specific algorithms for solving the optimal control problem, detailed description thereof is omitted here.
以上の指令値ベクトルは、マイクロプロセッサ内のメモリに書き込んで保持する。もし、過去の演算サイクルにおいて既に指令値ベクトルが生成・保持されていた場合であっても、過去の指令値ベクトルは破棄されて最新の指令値ベクトルで上書きする。
以上の書き込み処理が終了したら、ステップS310へ進む。
ステップS310では、マイクロプロセッサ内のメモリに書き込んだ制御指令値ベクトルのうち現在時刻に対応する指令値を読み出す。現在時刻との対応をとりやすくするため、例えばマイクロプロセッサ内の指令値の時系列の推移態様を保持するメモリにシフト操作を施して、常にメモリの先頭アドレスに格納されている指令値を読み出す方式をとることが考えられる。その場合、ステップS3010を実行する前のメモリ状態が、
The above command value vector is written and held in a memory in the microprocessor. Even if the command value vector has already been generated and held in the past calculation cycle, the past command value vector is discarded and overwritten with the latest command value vector.
When the above writing process is completed, the process proceeds to step S310.
In step S310, the command value corresponding to the current time is read from the control command value vector written in the memory in the microprocessor. In order to facilitate the correspondence with the current time, for example, a shift operation is performed on the memory holding the time-series transition of the command value in the microprocessor, and the command value stored at the start address of the memory is always read. Can be considered. In that case, the memory state before executing step S3010 is
ステップS311では、ステップS310で読み出した操舵指令値に基づいて転舵アシストモータ18を駆動する指令値を算出する。操舵補助トルクの制御則としては様々な方式が考えられるが、例えば操舵指令値と実際の操舵状態との偏差をフィードバックする(28)式のような制御則を用いることができる。
In step S311, a command value for driving the steering assist
ここで、Ta *は操舵補助トルクの目標値、θsは現在の操舵角、ωは現在の操舵角速度を表す。(28)式では操舵角偏差の項と操舵角速度偏差の項の二項から制御則を構成しているが、どちらか一項だけで構成することも考えられる。操舵補助トルクと転舵アシストモータ電流iMとの間には、比例定数をKMとすると、 Here, T a * represents the target value of the steering assist torque, θ s represents the current steering angle, and ω represents the current steering angular velocity. In the equation (28), the control law is composed of two terms, ie, the steering angle deviation term and the steering angular velocity deviation term, but it is also conceivable to constitute only one of the terms. If the proportionality constant is K M between the steering assist torque and the steering assist motor current i M ,
以上、目標走行経路が初めて算出される演算周期における処理の流れを説明した。目標走行経路が算出されると、次の演算周期からはステップS302における分岐により、ステップS305の処理が行われる。
ステップS305では、目標経路を更新するための条件が成立しているかどうかを判定する。例えば、自車が障害物の後方まで進んだ場合や障害物がセンサの検出範囲外に出た場合などは、それ以上目標経路を更新する必要性が低いと判断して、ステップS312へ進む。それ以外の場合は、ステップS306へ進む。
The processing flow in the calculation cycle in which the target travel route is calculated for the first time has been described above. When the target travel route is calculated, the processing in step S305 is performed by branching in step S302 from the next calculation cycle.
In step S305, it is determined whether a condition for updating the target route is satisfied. For example, when the vehicle has traveled behind the obstacle or the obstacle has gone out of the detection range of the sensor, it is determined that there is no need to update the target route any more, and the process proceeds to step S312. Otherwise, the process proceeds to step S306.
ステップS306では、現在時刻が目標経路を更新する時刻にあたっているかどうかを判定する。目標走行経路算出部230では目標操作量を時系列で算出しており、運転操作支援部240の制御周期よりも目標走行経路算出部230の周期を長くすることができる。そうすると、運転操作支援部240の制御指令値は出力しても目標走行経路の算出は行わない制御周期が発生するので、そのような演算周期ではステップS312へ進む。目標走行経路の算出を行う演算周期にあたっている場合にはステップS307へ進む。
ステップS307では、現在マイクロプロセッサのメモリに保持されている指令値の時系列の推移態様に基づいて操作を行う場合の走行経路の予測と予測した走行経路の評価に関する処理を実行する。ステップS307は図8に示す三つの処理から構成される。
In step S306, it is determined whether or not the current time is the time for updating the target route. The target travel
In step S307, processing related to the prediction of the travel route and the evaluation of the predicted travel route when the operation is performed based on the time-series transition mode of the command value currently held in the memory of the microprocessor is executed. Step S307 includes the three processes shown in FIG.
評価方法は、(15)式の評価関数をそのまま用いて現在の評価関数値を算出する方法が考えられる他、評価関数の一部の項(例えば障害物に関する項)だけに注目して評価値を算出したり、自車と障害物との距離の最小値といった別の評価指標を用いることもできる。 As the evaluation method, a method of calculating the current evaluation function value by using the evaluation function of the formula (15) as it is can be considered, and an evaluation value paying attention to only a part of the evaluation function (for example, a term related to an obstacle) Or another evaluation index such as the minimum value of the distance between the vehicle and the obstacle can be used.
スステップS803では、ステップS802で算出された評価指標から目標経路を修正する必要性を表す指標を算出する処理が行われる。例えば、自車と障害物との距離の最小値を評価指標に用いた場合、自車と障害物の幅に対して予想される距離の最小値が十分に大きいものと想定する。この想定に該当する場合には、現在保持している操作の時系列の推移態様に基づく走行経路と当初の目標走行経路との間に誤差が生じていたとしても、障害物回避という目的を考えた場合には大きな問題にならないと考えられる。そのような場合には、目標走行経路を再計算するとしても運転者になるべく違和感を与えないように現在の操作の時系列の推移態様を踏襲するような目標走行経路となることが望ましい。他方、自車と障害物の幅に対して予想される距離の最小値が不十分な大きさまで減少している場合には、現在保持している操作の時系列の推移態様に従って操作を続けていると障害物との接触のリスクが当初の予想よりも大きくなってしまう。従って、このような場合には、目標走行経路を最新の情報に基づいて再計算することが望ましい。
そこで、0から1までの値をとる目標経路を修正する必要性を表す指標を導入し、自車と障害物との距離の最小値dminに基づいて、αを以下のように算出する。
In step S803, a process for calculating an index representing the necessity of correcting the target route from the evaluation index calculated in step S802 is performed. For example, when the minimum value of the distance between the host vehicle and the obstacle is used as the evaluation index, it is assumed that the minimum value of the distance expected for the width of the host vehicle and the obstacle is sufficiently large. If this assumption is met, the purpose of obstacle avoidance is considered even if there is an error between the travel route based on the time-series transition mode of the currently held operation and the initial target travel route. If this happens, it will not be a big problem. In such a case, it is desirable that the target travel route follow the time-series transition mode of the current operation so that the driver does not feel uncomfortable even if the target travel route is recalculated. On the other hand, if the minimum distance expected for the width of the vehicle and the obstacle has decreased to an insufficient size, continue the operation according to the time-series transition mode of the operation currently held. If so, the risk of contact with obstacles will be greater than originally expected. Therefore, in such a case, it is desirable to recalculate the target travel route based on the latest information.
Therefore, an index indicating the necessity of correcting the target route taking a value from 0 to 1 is introduced, and α is calculated as follows based on the minimum value d min of the distance between the vehicle and the obstacle.
ただし、d0は適当な距離に関する閾値である。ここでは、α=0は目標走行経路修正の必要性が低いという判定結果を意味し、α=1は目標走行経路修正の必要性が高いという判定結果を意味するものと定義する。また、指標を連続化して、 However, d 0 is a threshold for an appropriate distance. Here, α = 0 is defined as a determination result that the necessity of target travel route correction is low, and α = 1 is defined as a determination result that the necessity of target travel route correction is high. In addition, by making the index continuous,
目標走行経路の変化は(28)式のような操舵補助トルク制御を通して運転者に操舵補助トルクの変化として伝達する。従って、目標走行経路を無闇に更新してしまうと運転者に違和感を与えてしまう虞がある。一方、運転者が当初算出した目標経路に正確に追従して走行した場合には、目標走行経路を再計算しても時間の経過による目標操作時系列の算出時間区間の変化に伴う小さな変化に留まると予想される。従って、操作補助トルクの変化も小さくなるので運転者に違和感を与える虞も小さくなると期待される。 The change in the target travel route is transmitted to the driver as a change in the steering assist torque through the steering assist torque control as shown in the equation (28). Therefore, there is a possibility that the driver may feel uncomfortable if the target travel route is renewed without darkness. On the other hand, if the driver travels accurately following the target route that was originally calculated, even if the target travel route is recalculated, there will be a small change accompanying the change in the calculated time interval of the target operation time series over time. Expected to stay. Therefore, since the change in the operation assist torque is also small, it is expected that the possibility of giving the driver a sense of incongruity is small.
以上のように、2回目以降の目標経路算出においては2通りの目標経路算出方法が考えられるが、ステップS803において目標走行経路修正の必要性の評価を実施している。このため、そこでの評価結果を反映した目標走行経路とするために、時刻tにおける目標経路算出に用いる初期状態ベクトルを(32)式のように設定する。 As described above, in the second and subsequent target route calculations, there are two possible target route calculation methods. In step S803, the necessity of correcting the target travel route is evaluated. Therefore, an initial state vector used for target route calculation at time t is set as in equation (32) in order to obtain a target travel route reflecting the evaluation result.
以上の設定のもとでステップS309に進み、目標経路算出の処理が行われる。
ステップS305において目標走行経路更新条件が成立しなかった場合(ステップS305:No)、ステップS312においてマイクロプロセッサのメモリに目標操作時系列が残っているかどうかのチェックを実行する。また、ステップS306において目標経路更新時刻でないと判定した場合にも(ステップS306:No)、ステップS312においてマイクロプロセッサのメモリに目標操作時系列が残っているかどうかのチェックを実行する。目標操作量が残っている場合にはステップS310に進み、メモリの先頭アドレスに記録されている指令値の読み出しと実行の処理が行われる。目標操作量が残っていない場合には、ステップS313に進み、運転支援制御起動フラグをクリアして処理を終了する。
Under the above settings, the process proceeds to step S309, and target route calculation processing is performed.
If the target travel route update condition is not satisfied in step S305 (step S305: No), it is checked in step S312 whether the target operation time series remains in the microprocessor memory. Also, when it is determined in step S306 that it is not the target route update time (step S306: No), in step S312, it is checked whether the target operation time series remains in the microprocessor memory. If the target operation amount remains, the process proceeds to step S310, and the command value recorded at the head address of the memory is read and executed. When the target operation amount does not remain, the process proceeds to step S313, the driving support control activation flag is cleared, and the process ends.
図9は図4の場面で本実施の形態の装置が起動して運転者が右方向への回避操作を始めてから一定の時間が経過した時刻t0での状態を示している。運転支援装置からは目標操舵角速度の上限値であるωmaxでの転舵が指令され、運転者もそれに追従して操舵角速度を上げていく操作を行っている状態である。この先の操作に関しては、目標走行経路算出部230は、徐々に操舵角速度を下げて逆方向への操舵に移行することを想定した目標操舵角時系列を算出している。即ち、時刻t0は操舵角加速度がちょうど反転する場面を示している。
FIG. 9 shows a state at time t 0 when a certain period of time has elapsed since the apparatus according to the present embodiment was activated in the scene of FIG. 4 and the driver started the avoidance operation in the right direction. The driving support device is instructed to steer at ω max that is the upper limit value of the target steering angular velocity, and the driver is also performing an operation to increase the steering angular velocity following that. With respect to the previous operation, the target travel
図10は図9のような場面において、時刻t0およびその次の目標走行経路演算時刻である時刻t1で起こりうる演算結果を示している。図10左側の図では、時刻t0で想定した目標走行経路に対し、時刻t1における実車両状態が目標走行経路よりもやや左寄りにずれた状況を示している。このようなずれは運転者の操舵が目標操舵に十分に追従していない場合や車両のモデル化誤差の影響などによりしばしば起こり得るずれである。 Figure 10 is in the context, such as in FIG. 9 shows the calculation results can occur at time t 0 and time t 1 which is the next target traveling path calculation time. The diagram on the left side of FIG. 10 shows a situation in which the actual vehicle state at time t 1 is slightly shifted to the left with respect to the target travel route assumed at time t 0 . Such a deviation is a deviation that can often occur when the driver's steering does not sufficiently follow the target steering or due to the influence of a modeling error of the vehicle.
この時、時刻t1で目標走行経路が再計算されることになる。この場合、時刻t1における測定値で構成した状態ベクトルを用いて目標走行経路を算出すると、当初の目標走行経路からのずれを補正するために右方向への操舵を再度強めてから操舵角加速度を反転させるといった目標操舵時系列を得ることになる。そのため、もし運転者が時刻t0における目標操舵に沿って操舵を行っていた場合には、操舵速度目標との誤差が発生するので、それまでほとんど補助力が作用していなかった状態から急に補助力が発生するように感じる。逆に、運転者の操舵角加速度の反転操作が遅れて補助力が発生し始めていた場合には、遅れにより発生していた操舵の誤差が急に小さくなるために補助力も抜けてしまったかのように感じる。 At this time, the target travel route is recalculated at time t 1 . In this case, when the target travel route is calculated using the state vector composed of the measured values at time t 1, the steering angular acceleration is increased after the steering in the right direction is strengthened again in order to correct the deviation from the original target travel route. The target steering time series such as reversing is obtained. Therefore, if the driver steers along the target steering at time t 0 , an error from the steering speed target occurs, so suddenly from the state where almost no auxiliary force has been applied until then. It feels like auxiliary power is generated. On the other hand, if the driver's steering angular acceleration reversal operation is delayed and the assist force begins to be generated, the assist error is lost because the steering error caused by the delay suddenly decreases. feel.
図11は、このような状態が時刻t1以降も継続した場合における目標操舵角速度の経時的推移を例示する図である。図11ではセンサ検出値に基づく状態ベクトルを使い続けた場合には目標走行経路を算出するたびに目標操舵角速度が修正されるために、全体として目標操舵角速度指令値がかなり振動的になっている様子を示している。これに対して、予測状態量を用いた場合には、時間の経過による評価時間区間の遡及に伴う操作時系列の延長が行われるだけである。従って、モデル化誤差等の影響を受けることがなく、操舵指令値の出力は図示のように整ったものとなる。実際の車両挙動はモデル化誤差の影響を受けるため当初想定した目標走行経路よりも障害物寄りの経路を走行することになるが、障害物との間に十分な回避余裕が保たれているのであれば回避操作の支援としては問題はないと言える。むしろ、操舵補助トルクの変動が少ない分、運転者には違和感がなく受け入れられ易い動作になると期待される。 FIG. 11 is a diagram exemplifying a temporal transition of the target steering angular velocity when such a state continues after time t 1 . In FIG. 11, when the state vector based on the sensor detection value is continuously used, the target steering angular velocity is corrected every time the target travel route is calculated. It shows a state. On the other hand, when the predicted state quantity is used, only the operation time series is extended along with the retroactive evaluation time interval due to the passage of time. Therefore, the steering command value is output as shown in the figure without being affected by a modeling error or the like. Since actual vehicle behavior is affected by modeling errors, the vehicle will travel on a route closer to the obstacle than the originally assumed target route, but a sufficient avoidance margin is maintained between the vehicle and the obstacle. If it exists, it can be said that there is no problem as support for the avoidance operation. Rather, it is expected that the driver will be able to accept the vehicle without a sense of incongruity because the fluctuation of the steering assist torque is small.
尚、図9から図11では、主に(30)式の目標走行経路の修正必要性指標を用いることを想定した説明を行ったが、(31)式の指標を用いることも可能である。その場合、若干の操舵補助トルクの変動と引き換えに実際の走行経路が障害物寄りにずれていくことを抑える効果が期待できる。従って、違和感の抑制と回避余裕の確保との間のバランスを(31)式の指標の定義を変えることによって調整することができる。 In FIGS. 9 to 11, the description is mainly made assuming that the target travel route correction necessity index of Expression (30) is used. However, the index of Expression (31) can also be used. In that case, it is possible to expect an effect of suppressing the actual travel route from deviating toward an obstacle in exchange for a slight change in steering assist torque. Therefore, the balance between suppression of uncomfortable feeling and securing of avoidance margin can be adjusted by changing the definition of the index of the equation (31).
以上説明した本発明の第1の実施の形態では、目標走行経路算出部で目標走行経路の再計算を繰り返すに際し、該再計算に係る初期条件として、現在状態検出値と状態予測値の二つの状態量を状況に応じて使い分けることが可能になる。このため、現在状態の検出誤差等に起因して再計算における目標走行経路の算出値が大幅に変動する虞がある場合には、誤差要因の影響を直接的には受けない状態予測値を計算の初期条件として適用することにより算出値の変動を抑制可能である。これにより、操作支援量が変動することで運転者が感じる違和感を小さくすることができる。また、再計算の続行により現在状態検出値を用いた目標経路算出を再開した場合に算出される目標走行経路が大きく変化することを防止できる。このため、操作支援量が急激に変化することが少なく運転者に与える違和感を緩和できる。 In the first embodiment of the present invention described above, when the target travel route calculation unit repeats the recalculation of the target travel route, two initial conditions related to the recalculation are the current condition detection value and the state prediction value. It becomes possible to use the state quantity properly according to the situation. For this reason, if there is a possibility that the calculated value of the target travel route in the recalculation may fluctuate significantly due to the detection error of the current state, etc., a predicted state value that is not directly affected by the error factor is calculated. By applying this as the initial condition, it is possible to suppress fluctuations in the calculated value. Thereby, the uncomfortable feeling felt by the driver when the operation support amount varies can be reduced. In addition, it is possible to prevent the target travel route calculated when the target route calculation using the current state detection value is resumed by continuing the recalculation from changing greatly. For this reason, it is possible to reduce the uncomfortable feeling given to the driver because the operation support amount does not change rapidly.
(第1の実施の形態の効果)
(1)第1の実施の形態としての運転支援装置では、自車状態検出部210が自車両の走行状態を検出し、運転者操作状態検出部220で運転者の操作状態を検出する。また、目標走行経路算出部230が任意の自車状態および運転操作状態を初期条件として、所定時間先までの自車が走行すべき目標走行経路を該目標走行経路に沿って走行するために必要な操作を時系列の操作手順として所定の演算周期ごとに再計算を実行して算出する。一方、目標走行経路算出部230が目標走行経路の再計算を実行するに際し、自車状態検出部210および運転者操作状態検出部220で得た現在の状態を表す現在状態検出値を当該再計算の初期条件設定の一つの根拠とする。また、過去の演算周期において算出した目標走行経路から現在時刻に対応する自車状態および運転操作状態を抽出した状態予測値を当該再計算の初期条件設定の他の一つの根拠とする。そして、これら二つの状態量に選択的に基づいて、初期条件設定部250が目標走行経路算出部230で現在の目標走行経路算出に用いる初期条件を設定する。運転操作支援部240が目標走行経路算出部230で算出した時系列の操作手順に沿った操作が行われるように運転者の運転操作を支援する。
(Effects of the first embodiment)
(1) In the driving support apparatus as the first embodiment, the own vehicle
上記(1)の車両用運転支援装置では、目標走行経路算出部230で目標走行経路の再計算に係る初期条件設定の根拠を初期条件設定部250より選択的に設定する。即ち、現在状態検出値と状態予測値の二つの状態量に状況に応じて選択的に依拠して初期条件設定を行うことが可能になる。このため、現在状態の検出誤差等に起因して再計算における目標走行経路の算出値が大幅に変動する虞がある場合には、誤差要因の影響を直接的には受けない状態予測値を計算の初期条件として適用することにより算出値の変動を抑制可能である。これにより、操作支援量が変動することで運転者が感じる違和感を小さくすることができる。また、再計算の続行により現在状態検出値を用いた目標経路算出を再開した場合に算出される目標走行経路が大きく変化することを防止できる。このため、操作支援量が急激に変化することが少なく運転者に与える違和感を緩和できる。
In the vehicle driving support device of the above (1), the target travel
(2)上記車両用運転支援装置において、障害物検出部260が自車前方の障害物を検出する。また、初期条件設定部250が、障害物検出部260から得られる障害物測定値を含んだ当該現在状態検出値、および、過去の演算周期において測定した障害物位置を含んだ当該状態予測値との二つの状態量に選択的に基づいて、前目標走行経路算出部230における初期条件の設定を行う。
上記(2)の車両用運転支援装置では、自車前方の障害物を考慮した回避支援が可能になる。
(2) In the vehicle driving support device, the
In the vehicle driving assistance device of the above (2), avoidance assistance in consideration of obstacles ahead of the host vehicle becomes possible.
(3)上記車両用運転支援装置において、障害物検出部260が障害物の運動状態を検出する。障害物挙動予測部270が該検出した運動状態に基づいて、所定時間先までの障害物の挙動を予測する。
上記(3)の車両用運転支援装置では、動きのある障害物を効果的に回避する支援が可能になる。即ち、移動することも想定して障害物の運動状態も含め目標経路算出時の初期条件の設定を行うため、障害物の運動状態の検出精度が状況によって変化する場合でも、検出精度が操作支援量に与える影響を小さくすることができる。
(3) In the vehicle driving support apparatus, the
In the vehicle driving support device of (3) above, it is possible to support effectively avoiding a moving obstacle. In other words, since the initial conditions for calculating the target route including the movement state of the obstacle are set assuming that the vehicle will move, even if the detection accuracy of the movement state of the obstacle changes depending on the situation, the detection accuracy is operational support The influence on the amount can be reduced.
(4)上記車両用運転支援装置において、道路境界検出部280が、自車が走行可能な道路の境界を検出する。
上記(4)の車両用運転支援装置では、検出した道路境界内に収まるように目標走行経路を算出でき、道路幅が制限されている状況でも適切な目標走行経路に基づいて運転操作を支援することができる。
(4) In the vehicle driving support apparatus, the road
In the vehicle driving support device of (4) above, the target travel route can be calculated so as to be within the detected road boundary, and the driving operation is supported based on the appropriate target travel route even in a situation where the road width is limited. be able to.
(5)上記車両用運転支援装置において、運転支援起動判定部290が運転支援の必要性を判断する。そして、運転支援起動判定部290が運転支援が必要であると判定した場合に、運転操作支援部240が、運転操作の支援を実行する。
上記(5)の車両用運転支援装置では、運転支援が必要とされている場面でのみ運転者の操作に対する装置からの働きかけが行われる。このため、支援が不要な場面で運転者の操作に介入して運転者に違和感を与えることを防止することができる。
(5) In the vehicle driving assistance device, the driving assistance
In the vehicle driving support device of the above (5), the device acts on the driver's operation only in a scene where driving support is required. For this reason, it is possible to prevent the driver from feeling uncomfortable by intervening in the driver's operation in a situation where assistance is not required.
(6)上記車両用運転支援装置において、初期条件設定部250が、当該現在状態検出値と過去の演算周期において算出した当該状態予測値との何れか一方を、各成分ごとに選択して初期条件設定を行う。
上記(6)の車両用運転支援装置では、状態測定値と状態予測値をそれら両者の各成分ごとに比較して、適切な値を初期条件に設定する。このため、状態量を構成する各信号ごとに与えられた状況に適した値を選択して目標走行経路演算に適用できる。従って、各信号の性質およびその検出部の性能に合わせた最適な処理が可能になり、特定の信号の性質やその検出部の性能が、目標経路の算出結果に与える影響を適応的に低減できる。
(6) In the vehicle driving support device, the initial
In the vehicle driving support device of (6) above, the state measurement value and the state prediction value are compared for each component of both, and an appropriate value is set as the initial condition. For this reason, the value suitable for the situation given for each signal constituting the state quantity can be selected and applied to the target travel route calculation. Therefore, it is possible to perform optimum processing according to the characteristics of each signal and the performance of the detection section, and it is possible to adaptively reduce the influence of the characteristics of a specific signal and the performance of the detection section on the calculation result of the target path. .
(7)上記車両用運転支援装置において、初期条件設定部250が、当該現在状態検出値と過去の演算周期において算出された当該状態予測値との二つの状態量に、各成分ごとに適当な重みをつけた上で平均値を算出することにより初期条件設定を行う。
上記(7)の車両用運転支援装置では、目標走行経路演算の初期条件を、状態測定値と状態予測値の加重平均に基づいて算出する。これにより、二つの状態量を切り替える場合に初期条件設定を連続的に変化させることが可能になり、目標走行経路や操作支援量の変化をより滑らかにすることができる。従って、運転者により違和感なく受け入れられやすい操作支援を行うことができる。
(7) In the vehicle driving support device, the initial
In the vehicle driving support device of the above (7), the initial condition for the target travel route calculation is calculated based on the weighted average of the state measurement value and the state prediction value. As a result, when the two state quantities are switched, the initial condition setting can be continuously changed, and changes in the target travel route and the operation support amount can be made smoother. Therefore, it is possible to perform operation support that can be easily accepted by the driver without a sense of incongruity.
(8)上記車両用運転支援装置において、予想走行経路評価部310が、過去の演算周期において算出した目標走行経路に対応する時系列の操作手順を現在時刻以降も入力し続けた場合に予想される自車走行経路の妥当性に関する評価値を得る。そして、初期条件設定部250が、予想走行経路評価部310による当該評価値が低いほど現在の状態測定値を重視した初期条件を設定し、当該評価値が高いほど過去の演算周期において算出した状態予測値を重視した初期条件を設定する。
(8) In the above-described vehicle driving support device, it is expected when the predicted travel
上記(8)の車両用運転支援装置では、現在の時刻において予想される走行経路を予測・評価して、新たに検出した状態量に基づいて目標走行経路を再計算する必要性を判定しながら目標走行経路の再計算を行う。これにより、障害物回避等の本来の走行目的に大きな影響を与えない程度の目標走行経路からの逸脱に対しては、誤差要因の影響を受けにくい状態量に基づいて目標経路の再計算を行う。従って、目標走行経路が変動しにくくなり、運転者にとって自然でわかり易い操作支援を行うことができる。 In the vehicle driving support device of (8) above, while predicting / evaluating the predicted travel route at the current time, it is determined whether the target travel route needs to be recalculated based on the newly detected state quantity. Recalculate the target travel route. As a result, re-calculation of the target route is performed based on the state quantity that is not easily affected by the error factor for deviations from the target route that do not significantly affect the original driving purpose such as obstacle avoidance. . Therefore, the target travel route is less likely to fluctuate, and operation assistance that is natural and understandable for the driver can be performed.
(9)上記車両用運転支援装置において、初期条件設定部250は、現在の状態予測値と過去の演算周期において算出した状態予測値との乖離が所定値以上に大きくなった場合には、初期条件設定における加重平均演算の重みを、その後の時間の経過と共に状態予測値を重視した設定から現在の状態測定値を重視した設定へと段階的に変化させる。
上記(9)の車両用運転支援装置では、状態測定値と状態予測値との誤差が大きくなった場合に、初期条件設定を段階的に状態測定値に切り替えていく。これにより、目標走行経路からの逸脱が大きくなった場合に本来の目標走行経路への復帰を運転者に働きかける場面において、操作支援量が急激に変化することで運転者に与える違和感を緩和できる。
(9) In the vehicle driving support device, the initial
In the vehicle driving support device of (9) above, when the error between the state measurement value and the state prediction value becomes large, the initial condition setting is gradually switched to the state measurement value. Thereby, when the deviation from the target travel route becomes large, in the scene where the driver is prompted to return to the original target travel route, the uncomfortable feeling given to the driver due to a sudden change in the operation support amount can be alleviated.
(10)上記車両用運転支援装置において、運転者操作状態検出部220は、運転者の操舵操作を検出する。
上記(10)の車両用運転支援装置では、運転者の操舵操作を検出して目標走行経路の算出を行っているので、車両の横方向運動を含む走行経路の算出とそれに追従して走行するための操作の支援を行うことができる。
(10) In the vehicle driving support apparatus, the driver operation
In the vehicle driving support device of the above (10), since the driver's steering operation is detected and the target travel route is calculated, the travel route including the lateral movement of the vehicle is calculated and the vehicle travels accordingly. Operation support can be performed.
(11)上記車両用運転支援装置において、運転者操作状態検出部220は、運転者のアクセル操作およびブレーキ操作を検出する。
上記(11)の車両用運転支援装置では、運転者のアクセル操作とブレーキ操作を検出して目標走行経路の算出を行っているので、車両の加減速運動を含む走行経路の算出とそれに追従して走行するための操作の支援を行うことができる。
(11) In the vehicle driving assistance device, the driver
In the vehicle driving support device of the above (11), the driver's accelerator operation and brake operation are detected and the target travel route is calculated. Therefore, the travel route including acceleration / deceleration motion of the vehicle is calculated and followed. It is possible to assist the operation for traveling.
(12)上記車両用運転支援装置において、運転操作支援部240は、目標走行経路算出部230で算出した目標操作量と、運転者操作状態検出部220で検出した運転者操作量との偏差に基づいて、運転者の操作に対する操作補助力を制御する。
上記(12)の車両用運転支援装置では、目標走行経路算出部230で算出した目標操作量と運転者の実際の操作量との偏差を検出して、偏差に応じた操作補助力を作用させる。このため、操作補助力の作用する方向や大きさによって、必要な操作を運転者に効果的に伝達することができる。
(12) In the vehicle driving support device, the driving
In the vehicle driving support device of (12), a deviation between the target operation amount calculated by the target travel
(13)上記車両用運転支援装置において、運転操作支援部240は、目標走行経路算出部230で算出した操作量を自車の操作系を自動制御することによって実現する。
上記(13)の車両用運転支援装置では、目標走行経路算出部で算出した目標操作量を自動制御によって実現する。このため、自車を目標走行経路に確実に追従させることができる。
(13) In the vehicle driving support apparatus, the driving
In the vehicle driving support device of (13) above, the target operation amount calculated by the target travel route calculation unit is realized by automatic control. For this reason, the own vehicle can be made to follow a target driving path reliably.
(第2の実施の形態)
本発明の第2の実施の形態を、図12ないし図16を参照して以下に説明する。
図12は本発明の第2の実施の形態としての車両用運転支援装置について説明するための模式図である。また、図13は、図12の装置に対応する機能ブロック図である。
図12および図13において、既述の図1および図2との対応部は同一の符号を附して示し、それら各部の説明は既述の該当部を援用する。センサ群102については、運転者のブレーキ操作によって発生するブレーキ圧を測定するブレーキ圧センサ12が追加されている点以外は図1のセンサ群100と略同様である。
(Second Embodiment)
A second embodiment of the present invention will be described below with reference to FIGS.
FIG. 12 is a schematic diagram for explaining a vehicle driving support apparatus according to a second embodiment of the present invention. FIG. 13 is a functional block diagram corresponding to the apparatus of FIG.
12 and FIG. 13, corresponding parts to those in FIG. 1 and FIG. 2 described above are denoted by the same reference numerals, and the description of each part uses the corresponding parts described above. The
一方、第2の実施の形態では運転操作支援部として前輪操舵系の自動制御システムを備えており、このシステムに関係する要素としてクラッチ17、転舵角センサ15、転舵アシストモータ18、転舵角サーボコントローラ10を備えている。障害物の回避支援が必要であると判断した場合、クラッチ7を切ってステアリングホイールと操舵機構を切り離す。そしてマイクロプロセッサ72からの転舵角指令をもとに転舵角サーボコントローラ10が転舵角センサと転舵モータを用いて操舵系のサーボ制御を行う。これにより、車両を自動制御して回避を行うモードに移行する構成である。
On the other hand, in the second embodiment, a front wheel steering system automatic control system is provided as a driving operation support unit, and the clutch 17, the turning
図13の機能ブロック図を図2のものと比較すると、多くの点で軌を一にしているが、予測走行経路評価部310が検出情報評価部320に置き換わっている。また、出力部の処理がクラッチのオン・オフを切り替える指令を出力する処理および転舵角の目標値を出力する処理に置き換わっている点が異なっている。検出情報評価部320は、自車状態検出部210、運転者操作状態検出部220、および障害物検出部260において検出した情報の信頼度を評価する。
When the functional block diagram of FIG. 13 is compared with that of FIG. 2, the predicted travel
次に図面を参照してマイクロプロセッサ72における処理の詳細について説明する。
図14は、図13中のマイクロプロセッサ72における処理の詳細を表すフローチャートである。処理の流れ自体は図3を参照して説明した第1の実施の形態との共通部分も多いため、以下、図3との相違点を中心に具体的な処理内容を説明する。また、第2の実施の形態でも既述の図4に示す場面を想定した説明を行うが、第1の実施の形態と異なりここでは障害物が移動することも想定した処理について説明する。
Next, details of the processing in the
FIG. 14 is a flowchart showing details of processing in the
ステップS1401は第1の実施の形態とほぼ同じ処理であるが、上述した通り障害物が移動することも想定して、障害物の位置情報だけでなく速度情報も算出する処理を実行する。速度情報については、例えば一つ前のサンプリング時刻における位置検出結果と現在時刻における位置検出結果との差分をとるなどして算出することができる。
ここでは、障害物のX軸方向の速度をνp x、Y軸方向の速度をνp yと表記する。
ステップS1402およびステップS1403の処理は図3のステップS302およびステップS303の処理と同じである。
Step S1401 is almost the same process as that of the first embodiment, but the process of calculating not only the position information of the obstacle but also the speed information is executed on the assumption that the obstacle moves as described above. The speed information can be calculated, for example, by taking the difference between the position detection result at the previous sampling time and the position detection result at the current time.
Here, the speed of the X-axis direction [nu p x obstacles, the speed of the Y-axis direction is denoted by [nu p y.
The processing in steps S1402 and S1403 is the same as the processing in steps S302 and S303 in FIG.
ステップS1404では、運転支援制御の開始に伴いクラッチ17の切断を指令する制御信号を生成し、クラッチ制御系に伝達する処理を実行する。
ステップS1405では、目標走行経路演算に必要な設定を行う点は既述の第1の実施の形態におけるステップS304と同じであるが、目標走行経路演算の定式化が異なるので、それに伴なって設定内容も異なる。以下に定式化の部分も含めて説明を行う。
In step S1404, a process for generating a control signal for instructing disconnection of the clutch 17 with the start of the driving support control and transmitting the control signal to the clutch control system is executed.
In step S1405, the setting necessary for target travel route calculation is the same as step S304 in the first embodiment described above, but the formulation of the target travel route calculation is different. The contents are also different. The following description will include the formulation part.
車両モデルに関しては、本実施例でも二輪モデルを用いた定式化を行うが、第1の実施の形態と比較して、以下の二点に対応した修正が加えられる。
(1)運転者によるブレーキ操作に伴う減速挙動を考慮する。
(2)転舵角サーボ系のモデルを組み込んでいる。
このうち、(1)については(9)式を以下の(33)式で置き換える。
With respect to the vehicle model, the present embodiment is formulated using a two-wheel model, but corrections corresponding to the following two points are added as compared with the first embodiment.
(1) Consider the deceleration behavior accompanying the brake operation by the driver.
(2) A steering angle servo system model is incorporated.
Among these, for (1), the expression (9) is replaced with the following expression (33).
ただし、αはブレーキによって車体に作用している減速度である。αについては、ブレーキ圧センサで検出したブレーキ圧信号から車体に作用している減速度を推定することができるので、ここでは既知信号として扱うことができる。
また、(2)については(14)式を転舵角サーボ系を1次系モデルで近似した(34)式で置き換える。
Here, α is a deceleration acting on the vehicle body by the brake. As for α, the deceleration acting on the vehicle body can be estimated from the brake pressure signal detected by the brake pressure sensor, so that it can be treated as a known signal here.
For (2), equation (14) is replaced with equation (34) that approximates the turning angle servo system with a primary system model.
ここで、Tsは転舵角サーボ系の応答時定数、δcomは転舵角サーボ系に入力される転舵角指令値を表している。以上の置き換えを行うことにより、車両モデルは転舵角指令値δcomを入力とする Here, T s represents a response time constant of the turning angle servo system, and δ com represents a turning angle command value input to the turning angle servo system. By performing the above replacement, the vehicle model receives the turning angle command value δ com as an input.
また、転舵角指令値δcomについては、転舵角サーボ系の最大転舵角をδmaxとして、(36)式の入力制限が課せられているものとする。 In addition, regarding the turning angle command value δ com, it is assumed that the maximum turning angle of the turning angle servo system is set to δ max and the input restriction of Expression (36) is imposed.
評価関数については、第1の実施の形態における評価関数(16)式と同様の評価関数を使用する。要請項目(1)、(2)、(4)については、それぞれ(17)、(19)、(21)式をそのまま利用することができる。ただし、(17)式における障害物位置を表すxp、ypは障害物の移動を考慮しているので、 As the evaluation function, the same evaluation function as the evaluation function (16) in the first embodiment is used. For request items (1), (2), and (4), equations (17), (19), and (21) can be used as they are, respectively. However, since x p and y p representing the position of the obstacle in the equation (17) consider the movement of the obstacle,
要請項目(3)については、
(3′)転舵角指令値をなるべく小さくする
という要請項目で置き換える。この要請項目は、
Regarding request item (3),
(3 ′) Replace with a request item to make the steering angle command value as small as possible. This request item is
ステップS1410、ステップS1411については、操舵角速度の指令値時系列ではなく転舵角指令値の時系列を算出するという相違点以外は、第1の実施の形態のステップS309、ステップS310と同じである。
ステップS1412では、転舵角サーボコントローラ10に転舵角指令値を伝達するという処理を実行する。
ステップS1406、ステップS1407については、第1の実施の形態におけるステップS305、ステップS306と同じ処理である。
ステップS1408では、センサ検出情報の評価を行う。
Steps S1410 and S1411 are the same as steps S309 and S310 of the first embodiment, except that a time series of turning angle command values is calculated instead of a steering angular velocity command value time series. .
In step S1412, a process of transmitting the turning angle command value to the turning
Steps S1406 and S1407 are the same as steps S305 and S306 in the first embodiment.
In step S1408, sensor detection information is evaluated.
しかし、各センサの検出精度・信頼性は必ずしも同じではないため、センサ検出情報だけでこれらの情報の設定を行うと、検出精度・信頼性の低い検出値が目標走行経路演算に影響を与えることが懸念される。例えば、障害物の位置・移動速度に関する情報は、自車が直進状態にある場合には比較的精度の高い検出値が得られるが、自車にヨーレートが発生している旋回状態では検出精度が低下する傾向がある。そのような場合には、0から1までの値をとるセンサ検出情報の信頼性を表す指標αを導入し、自車に発生しているヨーレート検出値γによって、信頼性指標を以下のように算出する。 However, because the detection accuracy and reliability of each sensor are not necessarily the same, if these information settings are made using only sensor detection information, detection values with low detection accuracy and reliability will affect the target travel route calculation. Is concerned. For example, the information regarding the position and moving speed of an obstacle can be obtained with a relatively high detection value when the vehicle is in a straight traveling state, but the detection accuracy is high when the vehicle is turning with a yaw rate. There is a tendency to decrease. In such a case, an index α representing the reliability of the sensor detection information taking a value from 0 to 1 is introduced, and the reliability index is set as follows according to the yaw rate detection value γ generated in the host vehicle. calculate.
ただし、γ0は検出情報の信頼性を判定する閾値である。ここでは、α=0はセンサ検出情報の信頼性が低いという判定結果を意味し、α=1は信頼性が高いという判定結果を意味するものと定義する。また、指標を連続化して、 However, γ 0 is a threshold value for determining the reliability of the detection information. Here, α = 0 is defined as a determination result that the sensor detection information has low reliability, and α = 1 is defined as a determination result that the reliability is high. In addition, by making the index continuous,
ステップS1409では、第1の実施の形態のステップS308と同様に、目標走行経路の再計算のために必要な初期条件の設定が行われる。第一実施例では特に自車の状態ベクトルの設定に関する処理が中心であったが、本実施の形態では障害物の位置・運動状態の設定に関する処理を実行する。 In step S1409, as in step S308 of the first embodiment, initial conditions necessary for recalculation of the target travel route are set. In the first embodiment, the processing related to the setting of the state vector of the own vehicle is mainly performed.
以上の設定のもとでステップS1410に進み、目標経路算出の処理を実行する。
ステップS1413、ステップS1415における処理は、それぞれ第1の実施の形態におけるステップS312、ステップS313と同一の処理である。また、第2の実施の形態では運転支援制御の起動中は操舵系のクラッチ17を切り離し、運転者の操舵角と自車の前輪舵角が独立に動ける構成を採る。そして、運転者の操舵角と前輪舵角を本来の関係に復帰させた上でクラッチ17を締結する。この場合、通常の運転モードに復帰させる制御ルーチンを用意しておき、ステップS1414でその制御ルーチンを起動する処理を実行する。
Based on the above settings, the process advances to step S1410 to execute target route calculation processing.
The processes in steps S1413 and S1415 are the same processes as steps S312 and S313 in the first embodiment, respectively. Further, the second embodiment adopts a configuration in which the steering
図15は、第2の実施の形態の装置が既述の図4の場面に遭遇したときの挙動を表す図である。即ち、本装置が時刻t0において起動して運転者が右方向への回避操作を始め、時刻t1に到達した時の自車および障害物の配置、自車のヨーレートおよび障害物の横位置検出結果の履歴を示している。 FIG. 15 is a diagram illustrating the behavior when the apparatus of the second embodiment encounters the scene of FIG. 4 described above. That is, this device is activated at time t 0 and the driver starts a right avoiding operation, and when the time t 1 is reached, the arrangement of the own vehicle and the obstacle, the yaw rate of the own vehicle, and the lateral position of the obstacle A history of detection results is shown.
ここでは障害物は静止しているものとする。回避操作が始まる前の時刻t0までは、車両が直進状態にあるので自車のヨーレートはほほ0であり、障害物の横位置(y座標)の検出結果はほぼ真値と一致している。時刻t0で回避経路の算出結果を得て、回避経路に沿って走行を始めて車両にヨーレートが発生すると、障害物の横位置の検出値の誤差が次第に増加してくる。それに伴って目標走行経路も徐々に当初の目標走行経路よりも右寄りに修正される傾向を呈するような再計算結果を得ることになるが、車両に発生するヨーレートがγ0を超えるあたりから急激に検出値の誤差が大きくなってくる。 Here, the obstacle is assumed to be stationary. Until the time t 0 before the avoidance operation starts, the vehicle is in a straight traveling state, so the yaw rate of the host vehicle is almost zero, and the detection result of the lateral position (y coordinate) of the obstacle almost matches the true value. . When the calculation result of the avoidance route is obtained at time t 0 and the vehicle starts running along the avoidance route and the yaw rate is generated, the error in the detected value of the lateral position of the obstacle gradually increases. Along with this, a recalculation result will be obtained in which the target travel route tends to be gradually corrected to the right from the original target travel route, but the yaw rate generated in the vehicle suddenly increases from around γ 0. The error of the detected value becomes large.
これにより、障害物が急に右方向に移動してきているという誤まった情報が目標走行経路演算部230に伝達されることになり、それに対応して右方向に大きく回避するような目標走行経路を描くような再計算結果を得ることになる。従って、一層大きなヨーレートが発生するという悪循環に陥る可能性が出てくる。
これは、運転者に、障害物が静止しているにも関わらず車両がどんどん右方向に流れていく走行経路を辿っているに等しい感覚を覚えさせ、強い違和感を与えることになる。
Accordingly, erroneous information that the obstacle is suddenly moving in the right direction is transmitted to the target travel
This makes the driver feel a sense of discomfort equivalent to the fact that the vehicle is following a traveling route in which the vehicle is constantly flowing in the right direction even though the obstacle is stationary.
図16に、目標走行経路算出部230において算出した目標転舵角の履歴を示す。センサ情報を用いて再計算を続けた場合には、一度右に操舵した後、再度大きく右に操舵してから操舵を戻すという不自然な操舵パターンとなってしまう。一方、センサ情報を用いずに予測状態ベクトルを用いた場合には、障害物がほぼ静止状態にあることを想定して目標走行経路の再計算を実行するので、滑らかで安定した操舵パターンが得られる。
FIG. 16 shows a history of the target turning angle calculated by the target travel
(第2の実施の形態による効果)
第2の実施の形態としての車両用運転支援装置では、検出情報評価部320が、自車状態検出部210、運転者操作状態検出部220、および障害物検出部260において検出した情報の信頼度を評価する。そして、初期条件設定部250が、検出情報の信頼度が高いほど当該現在状態検出値を重視した初期条件を設定する。
上記の構成によって、検出情報の信頼度評価に応じて初期条件に用いる状態量の設定を変える。このため、信頼度の低い情報を用いることにより目標走行経路が乱れることを防止することができる。
(Effects of the second embodiment)
In the vehicle driving support device as the second embodiment, the reliability of the information detected by the detection
With the above configuration, the setting of the state quantity used for the initial condition is changed according to the reliability evaluation of the detection information. For this reason, it is possible to prevent the target travel route from being disturbed by using information with low reliability.
(第3の実施の形態)
本発明の第3の実施の形態を、図17ないし図21を参照して以下に説明する。
本第3の実施の形態では、既述の第1の実施の形態および第2の実施の形態におけるような障害物回避操作の支援ではなく、道路に沿って走行する操作の支援を想定した車両用運転支援装置を構成している。
(Third embodiment)
A third embodiment of the present invention will be described below with reference to FIGS.
In the third embodiment, the vehicle is assumed to support the operation of traveling along the road instead of the support of the obstacle avoidance operation as in the first embodiment and the second embodiment described above. A driving support device is configured.
図17は本発明の第3の実施の形態としての車両用運転支援装置について説明するための模式図である。また、図18は、図17の装置に対応する機能ブロック図である。
図17および図18において、既述の図1および図2との対応部は同一の符号を附して示し、それら各部の説明は既述の該当部に関する言及を援用する。第3の実施の形態では、人工衛星からの測位信号を受信するGPS信号受信機13と道路情報が収録された記録媒体である地図情報データベース120が追加されている。他の点では、図1および図2の第1の実施の形態と同様である。尚、後述するように、マイクロプロセッサ73における処理は図2の第1の実施の形態におけるマイクロプロセッサ70とは異なる。例えば、センサ信号処理部200の位置・方位・道路情報取得部283が、GPS信号受信機13および地図情報データベース120から受けた情報に基づいて自車の位置および進行方向ならびに道路情報を取得する。しかし他の点では、この機能ブロック図での見掛け上の差異はない。
FIG. 17 is a schematic diagram for explaining a vehicle driving support apparatus according to a third embodiment of the present invention. FIG. 18 is a functional block diagram corresponding to the apparatus of FIG.
17 and 18, the corresponding parts to those in FIGS. 1 and 2 described above are denoted by the same reference numerals, and the description of each part uses the above-mentioned reference regarding the corresponding part. In the third embodiment, a
以下、図19に示す場面を想定して、第3の実施の形態の装置における具体的な処理内容および動作について説明する。図19は、自車が道路の曲線部にさしかかった状況を示している。マイクロプロセッサにおける処理の流れは既述の図3の第1の実施の形態について説明した内容と概ね同じであるため、フローチャートとしては既述の図3を援用する。但し、各ステップにおける処理内容は第1の実施の形態とは異なる箇所があるので、以下、図3との相違点を中心に具体的な処理内容を説明する。 Hereinafter, specific processing contents and operations in the apparatus according to the third embodiment will be described assuming the scene shown in FIG. FIG. 19 shows a situation in which the vehicle is approaching a curved portion of the road. Since the flow of processing in the microprocessor is substantially the same as the contents described in the first embodiment of FIG. 3 described above, FIG. 3 described above is used as a flowchart. However, since the processing contents in each step are different from those in the first embodiment, the specific processing contents will be described below with a focus on differences from FIG.
ステップS301では、カメラ、センサ信号に加えて、GPS信号の受信と道路情報データベースとの照合に関する処理も行い、自車の道路上の位置および前方の道路形状に関する情報を取得する。またここでは座標系の設定も行うが、この第3の実施の形態でも既述の第1の実施の形態と同様に、まず直交座標系としてX軸、Y軸を設定する。本実施の形態ではこれに加えて、道路の中心線上に進行方向に沿ってs座標軸およびs座標軸と直交するr座標軸を図示のように設定する。道路の進行方向は道路情報記録部のデータを参照することによって得ることができるので、X、Y座標とs、r座標間の変換式を次式のように構成することができる。 In step S301, in addition to the camera and sensor signals, processing related to reception of GPS signals and comparison with the road information database is also performed, and information on the position of the vehicle on the road and the road shape ahead is obtained. Although the coordinate system is also set here, the X-axis and Y-axis are first set as the orthogonal coordinate system in the third embodiment as in the first embodiment described above. In this embodiment, in addition to this, the s coordinate axis and the r coordinate axis orthogonal to the s coordinate axis are set on the center line of the road along the traveling direction as shown in the figure. Since the road traveling direction can be obtained by referring to the data in the road information recording unit, the conversion formula between the X, Y coordinates and the s, r coordinates can be configured as the following formula.
ステップS302の処理では、第1の実施の形態と同様の処理に加えて、位置・方位・道路情報取得部283が、GPS信号受信機13および地図情報データベース120から受けた情報に基づいて自車の位置および進行方向ならびに道路情報を取得する。
ステップS303では運転支援の起動判定を行う。運転支援の起動条件として、例えば道路曲線部の走行の支援を目的として、現在走行中の道路または所定領域内における前方の道路の曲率が所定の値よりも大きくなっている場合に運転支援を起動するといった条件を設定することができる。或いは、道路の直線部を含むより広い場面で支援することを目的として、自車の走行速度が所定の値よりも大きくなっている場合にはすべて支援の対象とするといった条件設定も考えられる。
In the process of step S302, in addition to the process similar to the first embodiment, the position / orientation / road
In step S303, driving support activation determination is performed. As driving assistance activation conditions, for example, driving assistance is activated when the curvature of the road that is currently running or the road ahead in the predetermined area is larger than a predetermined value, for the purpose of driving assistance for the road curve portion. You can set conditions such as Alternatively, for the purpose of assisting in a wider scene including the straight portion of the road, it is possible to set conditions such that all the vehicles are supported when the traveling speed of the vehicle is higher than a predetermined value.
ステップS304では目標走行経路演算の設定処理を実行する。以下に、第3の実施の形態における目標経路演算の定式化について説明する。車両モデルについては、第1の実施の形態と同じモデルを利用することができる。評価関数については、要請項目(1)に対応する評価項は除外する。また、要請項目(2)に対応する評価項は、基本的には既述の(18)式を踏襲するが、図19のような道路曲線部分においては、道路の中心からの距離はY座標ではなく、r座標で表される。従って、(18)式に相当する評価式は次式のように表される。 In step S304, a target travel route calculation setting process is executed. Hereinafter, the formulation of the target route calculation in the third embodiment will be described. As the vehicle model, the same model as that of the first embodiment can be used. For the evaluation function, the evaluation term corresponding to the request item (1) is excluded. The evaluation term corresponding to the request item (2) basically follows the equation (18) described above, but in the road curve portion as shown in FIG. 19, the distance from the center of the road is the Y coordinate. Instead, it is expressed in r coordinates. Therefore, the evaluation formula corresponding to the formula (18) is expressed as the following formula.
ただし、γL、γRはそれぞれ道路の左端、右端のr座標値である。
(46)式のrに(45)式の変換式、r=hγ(x,y)を代入することにより、LRをx,y座標で表現した式LR(x,y)が得られるので、これを評価式として用いる。
要請項目(4)については、自車が一定速度で道路中心線に沿って走行した場合に到達するs座標値における道路進行方向を道路情報データベースから読み出してその値をθ*とすると、
Here, γ L and γ R are the r coordinate values of the left end and the right end of the road, respectively.
By substituting the conversion formula (45), r = hγ (x, y), into the r in the formula (46), the formula L R (x, y) expressing L R in the x, y coordinates is obtained. Therefore, this is used as an evaluation formula.
For request item (4), when the vehicle travels along the road centerline at a constant speed and the road traveling direction at the s coordinate value reached is read from the road information database and the value is θ * ,
以上のような設定変更を行えば、ステップS309で第1の実施の形態と同様の最適化演算に基づいて道路に沿って走行するための目標走行経路を算出することができる。
If the setting change as described above is performed, a target travel route for traveling along the road can be calculated in step S309 based on the same optimization calculation as in the first embodiment.
目標走行経路を算出した後の他のステップにおける処理は第1の実施の形態について既述の処理と同じである。但し、図19に示すような場面は、図4に代表される障害物回避の場面と比較してとり得る走行経路の自由度が高くなることを反映して、ステップS308における初期条件設定で以下で説明する処理を追加する。即ち、ステップS308の初期条件設定では、(32)式に従って、目標走行経路演算に用いられる初期条件が算出されていた。 The processing in the other steps after calculating the target travel route is the same as the processing described above for the first embodiment. However, the scene shown in FIG. 19 reflects the fact that the degree of freedom of the travel route that can be taken is higher than that of the obstacle avoidance scene represented by FIG. Add the process described in. That is, in the initial condition setting in step S308, the initial condition used for the target travel route calculation is calculated according to the equation (32).
以上で説明した目標走行経路算出演算を適用した第3の実施の形態の装置における具体的な動作について図20および図21に基づいて説明する。
図20は運転操作支援を開始した時刻t0における車両位置および目標走行経路、検出状態と予測状態との誤差が許容水準を超えた時刻tAにおける車両位置および目標走行経路を示している。ここでは、運転者は時刻t0で算出した目標走行経路よりも右側の経路を辿りながら走行している状況を考えている。その結果、時刻tAにおいて検出状態と予測状態が一致していれば目標走行経路Aが算出される状況で、実際の車両状態に対して時系列の操作手順に基づく操作を行った場合の目標走行経路は目標走行経路Bのようになる。即ち、図示のように道路の右端に近い領域を通過していく経路になる。一方、時刻tAにおいて検出状態を用いて目標走行経路を算出した場合、目標走行経路Cのように補正した目標走行経路が得られる。目標走行経路Bは評価関数の評価値を大きく悪化させるほどではないが、運転者の操作を支援する際の目標経路として用いるのに適当な走行経路であるとは言えない。しかし、直ちに目標走行経路Cに切り替えると、図21に示すように操舵角目標値に段差が生じるために、操舵補助力にも段差が生じて運転者に違和感を与えることが懸念される。そこで、(48)式、および、(49)式に示した方法によって初期状態ベクトルを段階的に検出状態に近付けるという演算方法を用いる。
以上の第3の実施の形態では、図21に示すように操舵角目標値を連続的に変えることができるので、運転者に与える違和感を抑えながら運転支援制御を継続することができる。
Specific operations in the apparatus according to the third embodiment to which the target travel route calculation calculation described above is applied will be described with reference to FIGS.
FIG. 20 shows the vehicle position and target travel route at time t 0 when the driving operation support is started, and the vehicle position and target travel route at time t A when the error between the detected state and the predicted state exceeds the allowable level. Here, a situation is considered in which the driver travels while following a route on the right side of the target travel route calculated at time t 0 . As a result, if the detected travel state matches the predicted state at time t A and the target travel route A is calculated, the target when the operation based on the time-series operation procedure is performed on the actual vehicle state The travel route is the target travel route B. That is, the route passes through a region near the right end of the road as shown. On the other hand, when the target travel route is calculated using the detection state at time t A , a corrected target travel route such as the target travel route C is obtained. Although the target travel route B does not greatly deteriorate the evaluation value of the evaluation function, it cannot be said that the target travel route B is an appropriate travel route for use as a target route when assisting the driver's operation. However, if the vehicle is immediately switched to the target travel route C, a step is generated in the steering angle target value as shown in FIG. 21, and thus there is a concern that a step also occurs in the steering assist force and gives the driver a sense of incongruity. Therefore, a calculation method is used in which the initial state vector is gradually brought close to the detected state by the methods shown in the equations (48) and (49).
In the third embodiment described above, since the steering angle target value can be continuously changed as shown in FIG. 21, the driving support control can be continued while suppressing the uncomfortable feeling given to the driver.
(第3の実施の形態による効果)
(1)第3の実施の形態としての車両用運転支援装置では、自車状態検出部210は、GPS信号および地図情報データベースの情報に基づいて自車両の走行状態を検出する。
上記(1)の車両用運転支援装置では、GPS信号および地図情報データベースの情報により、広範囲を俯瞰するようにして自車両の走行状態を認識可能であり、より適切な運転支援を行うことが可能になる。
(Effects of the third embodiment)
(1) In the vehicle driving support apparatus as the third embodiment, the host vehicle
In the vehicle driving support device of the above (1), it is possible to recognize the traveling state of the host vehicle by looking down over a wide range based on the information of the GPS signal and the map information database, and more appropriate driving support can be performed. become.
(2)上記車両用運転支援装置において、目標走行経路算出部230は、当該再計算によって得る目標走行経路に変化が生じる場合に該変化が連続的変化となる演算を行って目標走行経路に関する情報を算出する。
上記(2)の車両用運転支援装置では、目標走行経路に不連続な変化が生じないため、運転支援における操舵角目標値を連続的に変えることができるので、運転者に与える違和感を抑えながら運転支援制御を継続することができる。
(2) In the vehicle driving support device, the target travel
In the vehicle driving support device of (2), since the target travel route does not discontinuously change, the steering angle target value in driving support can be continuously changed, so that the driver feels uncomfortable. Driving support control can be continued.
(本発明の実施の形態における効果)
以上に説明した本発明の実施の形態における車両用運転支援装置による効果をその構成との関連において以下に列記する。
(1)本発明の一つの実施の形態では、自車状態検出部210が自車両の走行状態を検出し、運転者操作状態検出部220で運転者の操作状態を検出する。また、目標走行経路算出部230が任意の自車状態および運転操作状態を初期条件として、所定時間先までの自車が走行すべき目標走行経路を該目標走行経路に沿って走行するために必要な操作を時系列の操作手順として所定の演算周期ごとに再計算を実行して算出する。一方、目標走行経路算出部230が目標走行経路の再計算を実行するに際し、自車状態検出部210および運転者操作状態検出部220で得た現在の状態を表す現在状態検出値を当該再計算の初期条件設定の一つの根拠とする。また、過去の演算周期において算出した目標走行経路から現在時刻に対応する自車状態および運転操作状態を抽出した状態予測値を当該再計算の初期条件設定の他の一つの根拠とする。そして、これら二つの状態量に選択的に基づいて、初期条件設定部250が目標走行経路算出部230で現在の目標走行経路算出に用いる初期条件を設定する。運転操作支援部240が目標走行経路算出部230で算出した時系列の操作手順に沿った操作が行われるように運転者の運転操作を支援する。
(Effect in the embodiment of the present invention)
The effects of the vehicle driving support apparatus according to the embodiment of the present invention described above are listed below in relation to the configuration.
(1) In one embodiment of the present invention, the own vehicle
上記(1)の車両用運転支援装置では、目標走行経路算出部230で目標走行経路の再計算に係る初期条件設定の根拠を初期条件設定部250より選択的に設定する。即ち、現在状態検出値と状態予測値の二つの状態量に状況に応じて選択的に依拠して初期条件設定を行うことが可能になる。このため、現在状態の検出誤差等に起因して再計算における目標走行経路の算出値が大幅に変動する虞がある場合には、誤差要因の影響を直接的には受けない状態予測値を計算の初期条件として適用することにより算出値の変動を抑制可能である。これにより、操作支援量が変動することで運転者が感じる違和感を小さくすることができる。また、再計算の続行により現在状態検出値を用いた目標経路算出を再開した場合に算出される目標走行経路が大きく変化することを防止できる。このため、操作支援量が急激に変化することが少なく運転者に与える違和感を緩和できる。
In the vehicle driving support device of the above (1), the target travel
(2)上記(1)の車両用運転支援装置において更に、自車前方の障害物を検出する障害物検出部260を備え、初期条件設定部250が、障害物検出部260から得られる障害物測定値を含んだ当該現在状態検出値、および、過去の演算周期において測定した障害物位置を含んだ当該状態予測値との二つの状態量に選択的に基づいて、前目標走行経路算出部230における初期条件の設定を行う。
上記(2)の車両用運転支援装置では、上記(1)の車両用運転支援装置における効果に加えて、自車前方の障害物を考慮した回避支援が可能になる。
(2) The vehicle driving support apparatus of (1) further includes an
In the vehicle driving support device according to (2), in addition to the effects of the vehicle driving support device according to (1), avoidance support in consideration of obstacles ahead of the host vehicle is possible.
(3)上記(2)の車両用運転支援装置において更に、障害物検出部260で検出した障害物の運動状態に基づいて、障害物挙動予測部270が所定時間先までの障害物の挙動を予測する。
上記(3)の車両用運転支援装置では、上記(2)の車両用運転支援装置における効果に加えて、動きのある障害物を効果的に回避する支援が可能になる。即ち、移動することも想定して障害物の運動状態も含め目標経路算出時の初期条件の設定を行うため、障害物の運動状態の検出精度が状況によって変化する場合でも、検出精度が操作支援量に与える影響を小さくすることができる。
(3) In the vehicle driving support device of (2), the obstacle
In the vehicle driving support device according to (3), in addition to the effect of the vehicle driving support device according to (2), it is possible to support effectively avoiding a moving obstacle. In other words, since the initial conditions for calculating the target route including the movement state of the obstacle are set assuming that the vehicle will move, even if the detection accuracy of the movement state of the obstacle changes depending on the situation, the detection accuracy is operational support The influence on the amount can be reduced.
(4)上記(3)の車両用運転支援装置において更に、道路境界検出部280が、自車が走行可能な道路の境界を検出する。
上記(4)の車両用運転支援装置では、上記(3)の車両用運転支援装置における効果に加えて、検出した道路境界内に収まるように目標走行経路を算出でき、道路幅が制限されている状況でも適切な目標走行経路に基づいて運転操作を支援することができる。
(4) In the vehicle driving support apparatus of (3), the road
In the vehicle driving support device of (4) above, in addition to the effects of the vehicle driving support device of (3) above, the target travel route can be calculated so as to be within the detected road boundary, and the road width is limited. The driving operation can be supported based on an appropriate target travel route even in a situation where the vehicle is present.
(5)上記(1)〜(4)の何れか一の車両用運転支援装置において更に、運転支援起動判定部290が運転支援の必要性を判断する。そして、運転支援起動判定部290が運転支援が必要であると判定した場合に、運転操作支援部240が、運転操作の支援を実行する。
上記(5)の車両用運転支援装置では、運転支援が必要とされている場面でのみ運転者の操作に対する装置からの働きかけが行われる。このため、支援が不要な場面で運転者の操作に介入して運転者に違和感を与えることを防止することができる。
(5) In the vehicle driving assistance device according to any one of (1) to (4), the driving assistance
In the vehicle driving support device of the above (5), the device acts on the driver's operation only in a scene where driving support is required. For this reason, it is possible to prevent the driver from feeling uncomfortable by intervening in the driver's operation in a situation where assistance is not required.
(6)上記(1)〜(5)の何れか一の車両用運転支援装置において更に、初期条件設定部250が、当該現在状態検出値と過去の演算周期において算出した当該状態予測値との何れか一方を、各成分ごとに選択して初期条件設定を行う。
上記(6)の車両用運転支援装置では、状態測定値と状態予測値をそれら両者の各成分ごとに比較して、適切な値を初期条件に設定する。このため、状態量を構成する各信号ごとに与えられた状況に適した値を選択して目標走行経路演算に適用できる。従って、各信号の性質およびその検出部の性能に合わせた最適な処理が可能になり、特定の信号の性質やその検出部の性能が、目標経路の算出結果に与える影響を適応的に低減できる。
(6) In the vehicle driving support device according to any one of the above (1) to (5), the initial
In the vehicle driving support device of (6) above, the state measurement value and the state prediction value are compared for each component of both, and an appropriate value is set as the initial condition. For this reason, the value suitable for the situation given for each signal constituting the state quantity can be selected and applied to the target travel route calculation. Therefore, it is possible to perform optimum processing according to the characteristics of each signal and the performance of the detection section, and it is possible to adaptively reduce the influence of the characteristics of a specific signal and the performance of the detection section on the calculation result of the target path. .
(7)上記(1)〜(5)の何れか一の車両用運転支援装置において更に、初期条件設定部250は、当該現在状態検出値と過去の演算周期において算出された当該状態予測値との二つの状態量に、各成分ごとに適当な重みをつけた上で平均値を算出することにより初期条件設定を行う。
上記(7)の車両用運転支援装置では、目標走行経路演算の初期条件を、状態測定値と状態予測値の加重平均に基づいて算出する。これにより、二つの状態量を切り替える場合に初期条件設定を連続的に変化させることが可能になり、目標走行経路や操作支援量の変化をより滑らかにすることができる。従って、運転者により違和感なく受け入れられやすい操作支援を行うことができる。
(7) In the vehicle driving support device according to any one of (1) to (5), the initial
In the vehicle driving support device of the above (7), the initial condition for the target travel route calculation is calculated based on the weighted average of the state measurement value and the state prediction value. As a result, when the two state quantities are switched, the initial condition setting can be continuously changed, and changes in the target travel route and the operation support amount can be made smoother. Therefore, it is possible to perform operation support that can be easily accepted by the driver without a sense of incongruity.
(8)上記(6)〜(7)の何れか一の車両用運転支援装置において更に、検出情報評価部320が、自車状態検出部210、運転者操作状態検出部220、および障害物検出部260において検出した情報の信頼度を評価する。そして、初期条件設定部250が、検出情報の信頼度が高いほど当該現在状態検出値を重視した初期条件を設定する。
上記(8)の車両用運転支援装置では、検出情報の信頼度評価に応じて初期条件に用いる状態量の設定を変える。このため、信頼度の低い情報を用いることにより目標走行経路が乱れることを防止することができる。
(8) In the vehicle driving support device according to any one of (6) to (7), the detection
In the vehicle driving support device of (8), the setting of the state quantity used for the initial condition is changed according to the reliability evaluation of the detection information. For this reason, it is possible to prevent the target travel route from being disturbed by using information with low reliability.
(9)上記(6)〜(8)の何れか一の車両用運転支援装置において更に、予想走行経路評価部310が、過去の演算周期において算出した目標走行経路に対応する時系列の操作手順を現在時刻以降も入力し続けた場合に予想される自車走行経路の妥当性に関する評価値を得る。そして、初期条件設定部250が、予想走行経路評価部310による当該評価値が低いほど現在の状態測定値を重視した初期条件を設定し、当該評価値が高いほど過去の演算周期において算出した状態予測値を重視した初期条件を設定する。
(9) In the vehicle driving support device according to any one of (6) to (8), the predicted travel
上記(9)の車両用運転支援装置では、現在の時刻において予想される走行経路を予測・評価して、新たに検出した状態量に基づいて目標走行経路を再計算する必要性を判定しながら目標走行経路の再計算を行う。これにより、障害物回避等の本来の走行目的に大きな影響を与えない程度の目標走行経路からの逸脱に対しては、誤差要因の影響を受けにくい状態量に基づいて目標経路の再計算を行う。従って、目標走行経路が変動しにくくなり、運転者にとって自然でわかり易い操作支援を行うことができる。 In the vehicle driving support device of (9) above, while predicting / evaluating the predicted travel route at the current time, determining the necessity of recalculating the target travel route based on the newly detected state quantity Recalculate the target travel route. As a result, re-calculation of the target route is performed based on the state quantity that is not easily affected by the error factor for deviations from the target route that do not significantly affect the original driving purpose such as obstacle avoidance. . Therefore, the target travel route is less likely to fluctuate, and operation assistance that is natural and understandable for the driver can be performed.
(10)上記(6)〜(9)の何れか一の車両用運転支援装置において更に、初期条件設定部250は、現在の状態予測値と過去の演算周期において算出した状態予測値との乖離が所定値以上に大きくなった場合には、初期条件設定における加重平均演算の重みを、その後の時間の経過と共に状態予測値を重視した設定から現在の状態測定値を重視した設定へと段階的に変化させる。
上記(10)の車両用運転支援装置では、状態測定値と状態予測値との誤差が大きくなった場合に、初期条件設定を段階的に状態測定値に切り替えていく。これにより、目標走行経路からの逸脱が大きくなった場合に本来の目標走行経路への復帰を運転者に働きかける場面において、操作支援量が急激に変化することで運転者に与える違和感を緩和できる。
(10) In the vehicle driving support device according to any one of (6) to (9), the initial
In the vehicle driving support device of (10) above, when the error between the state measurement value and the state prediction value becomes large, the initial condition setting is gradually switched to the state measurement value. Thereby, when the deviation from the target travel route becomes large, in the scene where the driver is prompted to return to the original target travel route, the uncomfortable feeling given to the driver due to a sudden change in the operation support amount can be alleviated.
(11)上記(1)〜(10)の何れか一の車両用運転支援装置において更に、運転者操作状態検出部220は、運転者の操舵操作を検出する。
上記(11)の車両用運転支援装置では、運転者の操舵操作を検出して目標走行経路の算出を行っているので、車両の横方向運動を含む走行経路の算出とそれに追従して走行するための操作の支援を行うことができる。
(11) In the vehicle driving support device according to any one of (1) to (10), the driver operation
In the vehicle driving support device of the above (11), since the driver's steering operation is detected and the target travel route is calculated, the travel route including the lateral movement of the vehicle is calculated and the vehicle travels accordingly. Operation support can be performed.
(12)上記(1)〜(11)の何れか一の車両用運転支援装置において更に、運転者操作状態検出部220は、運転者のアクセル操作およびブレーキ操作を検出する。
上記(12)の車両用運転支援装置では、運転者のアクセル操作とブレーキ操作を検出して目標走行経路の算出を行っているので、車両の加減速運動を含む走行経路の算出とそれに追従して走行するための操作の支援を行うことができる。
(12) In the vehicle driving support device according to any one of the above (1) to (11), the driver
In the vehicle driving support device of the above (12), the driver's accelerator operation and brake operation are detected and the target travel route is calculated, so that the travel route including acceleration / deceleration motion of the vehicle is calculated and followed. It is possible to assist the operation for traveling.
(13)上記(1)〜(12)の何れか一の車両用運転支援装置において更に、運転操作支援部240は、目標走行経路算出部230で算出した目標操作量と、運転者操作状態検出部220で検出した運転者操作量との偏差に基づいて、運転者の操作に対する操作補助力を制御する。
上記(13)の車両用運転支援装置では、目標走行経路算出部230で算出した目標操作量と運転者の実際の操作量との偏差を検出して、偏差に応じた操作補助力を作用させる。このため、操作補助力の作用する方向や大きさによって、必要な操作を運転者に効果的に伝達することができる。
(13) In the vehicle driving support device according to any one of (1) to (12), the driving
In the vehicle driving support device of (13), a deviation between the target operation amount calculated by the target travel
(14)上記(1)〜(12)の何れか一の車両用運転支援装置において更に、運転操作支援部240は、目標走行経路算出部230で算出した操作量を自車の操作系を自動制御することによって実現する。
上記(14)の車両用運転支援装置では、目標走行経路算出部で算出した目標操作量を自動制御によって実現する。このため、自車を目標走行経路に確実に追従させることができる。
(14) In the vehicle driving support device according to any one of the above (1) to (12), the driving
In the vehicle driving support device of (14), the target operation amount calculated by the target travel route calculation unit is realized by automatic control. For this reason, the own vehicle can be made to follow a target driving path reliably.
(15)上記(1)〜(5)の何れか一の車両用運転支援装置において更に、自車状態検出部210は、GPS信号および地図情報データベースの情報に基づいて自車両の走行状態を検出する。
上記(15)の車両用運転支援装置では、GPS信号および地図情報データベースの情報により、広範囲を俯瞰するようにして自車両の走行状態を認識可能であり、より適切な運転支援を行うことが可能になる。
(15) In the vehicle driving support device according to any one of (1) to (5), the host vehicle
In the vehicle driving support device of the above (15), it is possible to recognize the traveling state of the host vehicle by looking down over a wide range from the information of the GPS signal and the map information database, and it is possible to perform more appropriate driving support. become.
(16)上記(1)〜(5)の何れか一の車両用運転支援装置において更に、目標走行経路算出部230は、当該再計算によって得る目標走行経路に変化が生じる場合に該変化が連続的変化となる演算を行って目標走行経路に関する情報を算出する。
上記(16)の車両用運転支援装置では、目標走行経路に不連続な変化が生じないため、運転支援における操舵角目標値を連続的に変えることができるので、運転者に与える違和感を抑えながら運転支援制御を継続することができる。
(16) In the vehicle driving support device according to any one of (1) to (5), the target travel
In the vehicle driving support device of the above (16), since a discontinuous change does not occur in the target travel route, the steering angle target value in driving support can be continuously changed, so that the driver feels uncomfortable. Driving support control can be continued.
1……………………………カメラ
2……………………………車速センサ
3……………………………ヨーレートセンサ
4……………………………加速度センサ
5……………………………操舵角センサ
6……………………………操舵トルクセンサ
8……………………………操舵アシストモータ
9……………………………モータコントローラ
10…………………………転舵角サーボコントローラ
11…………………………ブレーキ
12…………………………ブレーキ圧センサ
13…………………………GPS受信機
15…………………………転舵角センサ
17…………………………クラッチ
18…………………………転舵モータ
70,72,73…………マイクロプロセッサ
100………………………センサ群
200………………………センサ信号処理部
210………………………自車状態検出部
220………………………運転者操作状態検出部
230………………………目標走行経路算出部
240………………………運転操作支援部
250………………………初期条件設定部
260………………………障害物検出部
270………………………障害物挙動予測部
280………………………道路境界検出部
290………………………運転支援起動判定部
310………………………予測走行経路評価部
320………………………検出情報評価部
400,402,403…運転操作支援機構
1 ... ……………………
Claims (17)
運転者の操作状態を検出する運転者操作状態検出部と、
自車が走行すべき目標走行経路の算出開始時または該算出開始時以降における自車状態および運転操作状態を初期条件として、前記目標走行経路を、該目標走行経路に沿って走行するために必要な時系列の操作手順として、再計算を逐次実行して算出する目標走行経路算出部と、
前記目標走行経路算出部が目標走行経路の再計算を実行するに際し、前記自車状態検出部および前記運転者操作状態検出部で得た現在の状態を表す現在状態検出値と、過去に算出した目標走行経路から現在時刻に対応する自車状態および運転操作状態を抽出した状態予測値との二つの状態量に選択的に基づいて、前記目標走行経路算出部で現在の目標走行経路算出に用いる初期条件を設定する初期条件設定部と、
前記目標走行経路算出部で算出した時系列の操作手順に沿った操作が行われるように運転者の運転操作を支援する運転操作支援部と、
を備えていることを特徴とする車両用運転支援装置。 A vehicle state detection unit for detecting a traveling state of the vehicle;
A driver operation state detector for detecting the operation state of the driver;
Necessary to drive the target travel route along the target travel route at the start of calculation of the target travel route to be traveled by the vehicle or the initial state of the vehicle state and the driving operation state after the start of the calculation. As a simple time-series operation procedure, a target travel route calculation unit that sequentially performs recalculation and calculates,
When the target travel route calculation unit recalculates the target travel route, a current state detection value representing a current state obtained by the own vehicle state detection unit and the driver operation state detection unit, and a past calculation The target travel route calculation unit uses the target travel route calculation unit to calculate the current target travel route on the basis of two state quantities, that is, the vehicle state corresponding to the current time from the target travel route and the state predicted value obtained by extracting the driving operation state. An initial condition setting section for setting initial conditions;
A driving operation support unit that supports the driving operation of the driver so that the operation according to the time-series operation procedure calculated by the target travel route calculation unit is performed;
A vehicle driving support device comprising:
前記初期条件設定部は、前記障害物検出部から得られる障害物測定値を含んだ当該現在状態検出値、および、過去に測定した障害物位置を含んだ当該状態予測値との二つの状態量に選択的に基づいて、前記目標走行経路算出部における初期条件の設定を行うことを特徴とする請求項1に記載の車両用運転支援装置。 An obstacle detection unit for detecting an obstacle ahead of the host vehicle;
The initial condition setting unit includes two state quantities: a current state detection value including an obstacle measurement value obtained from the obstacle detection unit, and a state prediction value including an obstacle position measured in the past. The vehicle driving support device according to claim 1, wherein an initial condition is set in the target travel route calculation unit based selectively on the vehicle.
前記初期条件設定部は、前記障害物検出部から得られる障害物運動状態の測定値を含んだ当該現在状態検出値、および、前記障害物挙動予測部によって過去に算出した障害物挙動予測情報から現在時刻に対応する障害物位置および運動状態を抽出した状態量を含んだ状態予測値との二つの状態量に選択的に基づいて、前記目標走行経路算出部における初期条件の設定を行うことを特徴とする請求項2に記載の車両用運転支援装置。 An obstacle behavior prediction unit for predicting the behavior of future obstacles based on the movement state of the obstacle detected by the obstacle detection unit;
The initial condition setting unit includes the current state detection value including the measured value of the obstacle movement state obtained from the obstacle detection unit, and the obstacle behavior prediction information calculated in the past by the obstacle behavior prediction unit. Selectively setting an initial condition in the target travel route calculation unit based on two state quantities including an obstacle position corresponding to the current time and a state predicted value including a state quantity obtained by extracting an exercise state; The driving support apparatus for a vehicle according to claim 2, wherein the driving support apparatus is for a vehicle.
前記目標走行経路算出部は、検出した道路境界内に収まるように目標走行経路を算出することを特徴とする請求項1〜3の何れか一項に記載の車両用運転支援装置。 A road boundary detector for detecting a boundary of the road on which the vehicle can travel;
The vehicle driving support device according to any one of claims 1 to 3, wherein the target travel route calculation unit calculates the target travel route so as to be within the detected road boundary.
前記運転操作支援部は、前記運転支援起動判定部において運転支援が必要であると判定した場合に運転操作の支援を実行することを特徴とする請求項1〜4の何れか一項に記載の車両用運転支援装置。 It further comprises a driving support start determination unit for determining the necessity of driving support,
The said driving operation assistance part performs assistance of driving operation, when it determines with the driving assistance starting determination part requiring driving assistance, The driving | operation assistance is performed as described in any one of Claims 1-4 characterized by the above-mentioned. Vehicle driving support device.
前記初期条件設定部は、検出情報の信頼度が高いほど当該現在状態検出値を重視した初期条件を設定することを特徴とする請求項6〜7の何れか一項に記載の車両用運転支援装置。 A detection information evaluation unit for evaluating reliability of information detected in the vehicle state detection unit, driver operation state detection unit, and obstacle detection unit;
8. The vehicle driving support according to claim 6, wherein the initial condition setting unit sets an initial condition in which the current state detection value is emphasized as the reliability of the detection information is higher. apparatus.
前記初期条件設定部は、前記予想走行経路評価部による当該評価値が低いほど現在の状態測定値を重視した初期条件を設定し、当該評価値が高いほど過去に算出した状態予測値を重視した初期条件を設定することを特徴とする請求項6〜8の何れか一項に記載の車両用運転支援装置。 A predictive travel route evaluation unit for obtaining an evaluation value related to the validity of the own vehicle travel route expected when the time-series operation procedure corresponding to the target travel route calculated in the past is continuously input after the current time;
The initial condition setting unit sets an initial condition in which the current state measurement value is emphasized as the evaluation value by the predicted travel route evaluation unit is low, and the state prediction value calculated in the past is emphasized as the evaluation value is high. The vehicle driving support device according to any one of claims 6 to 8, wherein an initial condition is set.
運転者の操作状態を検出する運転者操作状態検出ステップと、
自車が走行すべき目標走行経路の算出開始時または該算出開始時以降における自車状態および運転操作状態を初期条件として、前記目標走行経路を、該目標走行経路に沿って走行するために必要な時系列の操作手順として、再計算を逐次実行して算出する目標走行経路算出ステップと、
目標走行経路算出ステップによって算出した時系列の操作手順に沿った操作が行われるように運転者の運転操作を支援する運転操作支援ステップと、
目標走行経路の再計算を実行するに際し、前記自車状態検出ステップおよび前記運転者操作状態検出ステップで得た現在の状態を表す現在状態検出値と、過去の演算周期において算出した目標走行経路から現在時刻に対応する自車状態および運転操作状態を抽出した状態予測値との二つの状態量に選択的に基づいて、前記目標走行経路算出ステップで現在の目標走行経路算出に用いる初期条件を設定する初期条件設定ステップと、
を含むことを特徴とする車両用運転支援方法。 A vehicle state detection step for detecting a traveling state of the vehicle;
A driver operation state detection step for detecting the operation state of the driver;
Necessary to drive the target travel route along the target travel route at the start of calculation of the target travel route to be traveled by the vehicle or the initial state of the vehicle state and the driving operation state after the start of the calculation. As a time series operation procedure, a target travel route calculation step for calculating by sequentially executing recalculations,
A driving operation support step for supporting the driving operation of the driver so that the operation according to the time-series operation procedure calculated by the target travel route calculating step is performed;
When recalculating the target travel route, from the current state detection value representing the current state obtained in the vehicle state detection step and the driver operation state detection step, and the target travel route calculated in the past calculation cycle The initial conditions used for the current target travel route calculation are set in the target travel route calculation step based selectively on the two state quantities of the own vehicle state corresponding to the current time and the state predicted value obtained by extracting the driving operation state. Initial condition setting step to
A vehicle driving support method comprising:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2009049281A JP5267215B2 (en) | 2009-03-03 | 2009-03-03 | Vehicle driving support device and vehicle driving support method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2009049281A JP5267215B2 (en) | 2009-03-03 | 2009-03-03 | Vehicle driving support device and vehicle driving support method |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2010202030A JP2010202030A (en) | 2010-09-16 |
JP5267215B2 true JP5267215B2 (en) | 2013-08-21 |
Family
ID=42963951
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2009049281A Expired - Fee Related JP5267215B2 (en) | 2009-03-03 | 2009-03-03 | Vehicle driving support device and vehicle driving support method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5267215B2 (en) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6131587B2 (en) * | 2012-12-12 | 2017-05-24 | 株式会社豊田中央研究所 | Route correction device |
DE102014200687A1 (en) * | 2014-01-16 | 2015-07-16 | Robert Bosch Gmbh | Method for operating a vehicle |
WO2016194168A1 (en) * | 2015-06-03 | 2016-12-08 | 日産自動車株式会社 | Travel control device and method |
DE102016205761A1 (en) * | 2016-04-07 | 2017-10-12 | Robert Bosch Gmbh | Method for operating a vehicle |
JP6664813B2 (en) * | 2016-06-15 | 2020-03-13 | 国立大学法人東京農工大学 | Driving support device and driving support method |
JP6874512B2 (en) * | 2016-10-25 | 2021-05-19 | スズキ株式会社 | Steering device for electric vehicles |
JP6572949B2 (en) * | 2017-08-30 | 2019-09-11 | マツダ株式会社 | Vehicle control device |
US11332157B2 (en) * | 2018-07-03 | 2022-05-17 | Mitsubishi Electric Corporation | Vehicle control apparatus |
JP7076348B2 (en) * | 2018-09-20 | 2022-05-27 | 日立Astemo株式会社 | Electronic control device |
KR102674597B1 (en) * | 2018-12-27 | 2024-06-14 | 현대자동차주식회사 | Vehicle and control method thereof |
JP7193408B2 (en) * | 2019-04-03 | 2022-12-20 | トヨタ自動車株式会社 | vehicle controller |
JP7380541B2 (en) * | 2020-12-22 | 2023-11-15 | トヨタ自動車株式会社 | vehicle control system |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4165168B2 (en) * | 2002-09-27 | 2008-10-15 | 日産自動車株式会社 | Driving assistance device for vehicle |
JP4097563B2 (en) * | 2003-05-16 | 2008-06-11 | トヨタ自動車株式会社 | Vehicle travel support device |
CN101171163B (en) * | 2005-08-05 | 2011-12-07 | 本田技研工业株式会社 | Vehicle control device |
JP2009018623A (en) * | 2007-07-10 | 2009-01-29 | Toyota Motor Corp | Travel controller |
-
2009
- 2009-03-03 JP JP2009049281A patent/JP5267215B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2010202030A (en) | 2010-09-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5267215B2 (en) | Vehicle driving support device and vehicle driving support method | |
CN106080598B (en) | Real-time goal pace control | |
US10345813B2 (en) | Method for the at least semi-autonomous manoeuvring of a motor vehicle, driver assistance system and motor vehicle | |
JP6055525B1 (en) | Vehicle travel control device | |
JP6082415B2 (en) | Vehicle travel control device | |
JP5463971B2 (en) | Mobile body travel route generation device | |
JP2007253745A (en) | Avoidance operation calculating device, avoidance controller, vehicle provided with each device, avoidance operation calculating method, and avoidance control method | |
US20150346723A1 (en) | Vehicle trajectory planning for autonomous vehicles | |
JP5205997B2 (en) | Driving operation support device for vehicle | |
JP6315107B2 (en) | Target route generation device and travel control device | |
JP6630443B2 (en) | Vehicle control device | |
JP5556029B2 (en) | Driving operation support device and driving operation support method | |
US20120283913A1 (en) | System and method for adjusting smoothness for lane centering steering control | |
JP6784223B2 (en) | Vehicle steering support device and steering support control method | |
CN105189255A (en) | Third order polynomial-based course prediction for driver assistance functions | |
EP2426034A2 (en) | Control system and control method for vehicles | |
JP2012216069A (en) | Vehicle and vehicle control program | |
JP4853068B2 (en) | Vehicle support control device | |
JP2018192954A (en) | Drive assisting device | |
US12030518B2 (en) | Lane changing based only on local information | |
US20160031321A1 (en) | Predicted arrival point presentation device and computer readable medium | |
JP2010162927A (en) | Vehicle driving support system | |
CN116080754B (en) | Transverse control method for autonomous driving of vehicle | |
JP2019066444A (en) | Position calculation method, vehicle control method, and position calculation device | |
JP6288305B2 (en) | Target vehicle speed generation device and travel control device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20100917 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20120131 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20130314 |
|
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: 20130409 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20130422 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 5267215 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
LAPS | Cancellation because of no payment of annual fees |